wash/mango
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

acpi: add APIC irq ack and legacy vector remapping

Browse Source
This commit is contained in:
max 🍓
2023-03-24 14:21:02 +00:00
parent cb622f5ad4
commit 864362ba82
11 changed files with 286 additions and 49 deletions
Download Patch File Download Diff File Expand all files Collapse all files

113
arch/x86_64/acpi/apic.cpp
View File

@@ -1,6 +1,8 @@
#include <socks/printk.h>
#include <socks/vm.h>
#include <socks/cpu.h>
#include <arch/acpi/io_apic.hpp>
#include <arch/acpi/local_apic.hpp>
#include <arch/acpi.h>
#include <arch/msr.h>
#include <arch/ports.h>
@@ -13,7 +15,12 @@
#define IA32_APIC_BASE_MSR_BSP 0x100
#define IA32_APIC_BASE_MSR_ENABLE 0x800
static int apic_enabled = 0;
using namespace arch::acpi;
static uint32_t *lapic_base;
static queue_t io_apics;
extern "C" {
/* defined in apic_ctrl.S */
@@ -37,16 +44,6 @@ static void disable_8259(void)
outportb(PIC2_DATA, 0xFF);
}
static uint32_t local_apic_read(uint32_t reg)
{
return READ_ONCE(lapic_base[reg >> 4]);
}
static void local_apic_write(uint32_t reg, uint32_t val)
{
}
static void *find_lapic(struct acpi_madt *madt)
{
phys_addr_t local_apic = madt->m_lapic_ptr;
@@ -82,27 +79,93 @@ kern_status_t local_apic_enable(void)
apic_set_base(apic_get_base());
lapic_base = (uint32_t *)find_lapic(madt);
local_apic lapic(lapic_base);
local_apic_write(0xF0, local_apic_read(0xF0) | 0x100);
lapic.write(0xF0, 0x1FF);
lapic.ack();
printk("acpi: enabled local APIC on core %u", this_cpu());
return KERN_OK;
}
static io_apic *get_ioapic_for_irq(unsigned int vec)
{
queue_foreach (io_apic, ioapic, &io_apics, io_entry) {
if (vec >= ioapic->io_first_irq && vec < ioapic->io_first_irq + ioapic->io_nr_irq) {
return ioapic;
}
}
return nullptr;
}
static void configure_legacy_pic(void)
{
printk("acpi: APIC unavailable, using 8259 PIC");
pit_start(1000);
pit_start(10);
}
static void ioapic_init(void)
static void ioapic_init(uintptr_t base, unsigned int int_base)
{
uint32_t *base_vaddr = (uint32_t *)vm_phys_to_virt(base);
io_apic *apic = kmalloc_object(io_apic, VM_NORMAL, base_vaddr, int_base);
printk("acpi: I/O APIC at 0x%llx; base=%u, irqs=%u", base, int_base, apic->io_nr_irq);
for (unsigned int i = 0; i < apic->io_nr_irq; i++) {
apic->map_irq(i, 32 + int_base + i);
}
queue_push_back(&io_apics, &apic->io_entry);
}
static void init_all_ioapic(void)
static void parse_legacy_irq_override(struct acpi_madt *madt)
{
ioapic_init();
unsigned char *p = (unsigned char *)madt + sizeof *madt;
unsigned char *madt_end = (unsigned char *)madt + madt->m_base.s_length;
while (p < madt_end) {
struct acpi_madt_record *rec = (struct acpi_madt_record *)p;
struct acpi_madt_irqsrc_override*irq;
io_apic *handler = nullptr;
switch (rec->r_type) {
case ACPI_MADT_IRQSRC_OVERRIDE:
irq = (struct acpi_madt_irqsrc_override *)(rec + 1);
printk("acpi: irq src=%u, dest=%u", irq->irq_srcvec, irq->irq_destvec);
handler = get_ioapic_for_irq(irq->irq_srcvec);
handler->map_irq(irq->irq_srcvec, 32 + irq->irq_destvec);
break;
default:
break;
}
p += rec->r_length;
}
}
static void init_all_ioapic(struct acpi_madt *madt)
{
unsigned char *p = (unsigned char *)madt + sizeof *madt;
unsigned char *madt_end = (unsigned char *)madt + madt->m_base.s_length;
while (p < madt_end) {
struct acpi_madt_record *rec = (struct acpi_madt_record *)p;
struct acpi_madt_ioapic *ioapic;
switch (rec->r_type) {
case ACPI_MADT_IOAPIC:
ioapic = (struct acpi_madt_ioapic *)(rec + 1);
ioapic_init(ioapic->io_address, ioapic->io_intbase);
break;
default:
break;
}
p += rec->r_length;
}
parse_legacy_irq_override(madt);
}
kern_status_t apic_init(void)
@@ -123,12 +186,30 @@ kern_status_t apic_init(void)
}
if (this_cpu() == bsp_id) {
init_all_ioapic();
init_all_ioapic(madt);
}
local_apic_enable();
disable_8259();
apic_enabled = 1;
pit_start(10);
printk("acpi: all APIC online");
return KERN_OK;
}
void irq_ack(unsigned int vec)
{
if (apic_enabled) {
local_apic lapic(lapic_base);
lapic.ack();
} else {
if (vec >= 40) {
outportb(0xA0, 0x20);
}
outportb(0x20, 0x20);
}
}

65
arch/x86_64/acpi/io_apic.cpp Normal file
View File

@@ -0,0 +1,65 @@
#include <socks/compiler.h>
#include <socks/printk.h>
#include <arch/acpi/io_apic.hpp>
#define IOAPICID 0x00
#define IOAPICVER 0x01
#define IOAPICARB 0x02
#define IOAPICREDTBL(n) (0x10 + 2 * n)
namespace arch::acpi {
io_apic::io_apic(uint32_t *base, unsigned int first_irq) : io_base(base), io_first_irq(first_irq)
{
io_nr_irq = ((read(IOAPICVER) >> 16) + 1) & 0xFF;
}
uint32_t io_apic::read(uint32_t reg)
{
*(volatile uint32_t *)(io_base) = reg & 0xFF;
return *(volatile uint32_t *)((char *)io_base + 0x10);
}
void io_apic::write(uint32_t reg, uint32_t val)
{
*(volatile uint32_t *)(io_base) = reg & 0xFF;
*(volatile uint32_t *)((char *)io_base + 0x10) = val;
}
kern_status_t io_apic::read_irq(unsigned int index, irq_entry &entry)
{
if (index >= io_nr_irq) {
return KERN_NO_ENTRY;
}
uint32_t *entry_data = (uint32_t *)&entry;
entry_data[0] = read(IOAPICREDTBL(index));
entry_data[1] = read(IOAPICREDTBL(index) + 1);
return KERN_OK;
}
void io_apic::write_irq(unsigned int index, const irq_entry &entry)
{
if (index >= io_nr_irq) {
return;
}
const uint32_t *entry_data = (const uint32_t *)&entry;
write(IOAPICREDTBL(index), entry_data[0]);
write(IOAPICREDTBL(index) + 1, entry_data[1]);
}
void io_apic::map_irq(unsigned int src, unsigned int dest)
{
io_apic::irq_entry irq{};
irq.irq_vec = dest;
irq.irq_delivery = 0;
irq.irq_destmode = 0;
irq.irq_polarity = 0;
irq.irq_triggermode = 0;
irq.irq_mask = 0;
irq.irq_dest = 0;
write_irq(src, irq);
}
}

25
arch/x86_64/acpi/local_apic.cpp Normal file
View File

@@ -0,0 +1,25 @@
#include <arch/acpi/local_apic.hpp>
#include <socks/vm.h>
#define LAPIC_REG_EOI 0xB0
namespace arch::acpi {
local_apic::local_apic(uint32_t *base) : base_(base)
{
}
uint32_t local_apic::read(uint32_t reg)
{
return *(volatile uint32_t *)((char *)base_ + reg);
}
void local_apic::write(uint32_t reg, uint32_t val)
{
*(volatile uint32_t *)((char *)base_ + reg) = val;
}
void local_apic::ack()
{
*(volatile uint32_t *)((char *)base_ + LAPIC_REG_EOI) = 0;
}
}