apic.cpp

Go to the documentation of this file.

 
#include <hardwarecommunication/apic.h>
#include <common/logger.h>
#include <hardwarecommunication/interrupts.h>
 
using namespace MaxOS;
using namespace MaxOS::hardwarecommunication;
using namespace MaxOS::system;
using namespace MaxOS::memory;
 
LocalAPIC::LocalAPIC() {
 
    // Get the APIC base address
    uint64_t msr_info = CPU::read_msr(0x1B);
    m_apic_base = msr_info & 0xFFFFF000;
 
    // Reserve the base address once
    static bool bsp_setup = false;
    if(!bsp_setup)
        PhysicalMemoryManager::s_current_manager->reserve(m_apic_base);
 
    // Check if the APIC supports x2APIC
    uint32_t ignored, xleaf, x2leaf;
    CPU::cpuid(0x01, &ignored, &ignored, &x2leaf, &xleaf);
 
    if (x2leaf & (1 << 21)) {
 
        // Enable x2APIC
        m_x2apic = true;
        msr_info |= (1 << 10);
        CPU::write_msr(0x1B, msr_info);
        Logger::DEBUG() << "CPU supports x2APIC\n";
 
    } else if (xleaf & (1 << 9)) {
 
        m_x2apic = false;
        Logger::DEBUG() << "CPU supports xAPIC\n";
 
        // Map the APIC base address to the higher half
        m_apic_base_high = (uint64_t) PhysicalMemoryManager::to_io_region(m_apic_base);
        PhysicalMemoryManager::s_current_manager->map((physical_address_t*) m_apic_base, (virtual_address_t*) m_apic_base_high, PRESENT | WRITE);
        Logger::DEBUG() << "APIC Base: phy=0x" << m_apic_base << ", virt=0x" << m_apic_base_high << "\n";
    } else {
        ASSERT(false, "CPU does not support xAPIC");
    }
 
    if (!(msr_info & (1 << 11))) {
        Logger::WARNING() << "APIC is not enabled\n";
        return;
    }
 
    // Enable the APIC
    write(0xF0, (1 << 8) | 0x100);
    bsp_setup = true;
    Logger::DEBUG() << "APIC Enabled\n";
}
 
LocalAPIC::~LocalAPIC() = default;
 
uint32_t LocalAPIC::read(uint32_t reg) const {
 
    // If x2APIC is enabled I/O is done through the MSR
    if (m_x2apic)
        return (uint32_t) CPU::read_msr((reg >> 4) + 0x800);
 
    return *(volatile uint32_t*) ((uintptr_t) m_apic_base_high + reg);
}
 
void LocalAPIC::write(uint32_t reg, uint32_t value) const {
 
    // If x2APIC is enabled I/O is done through the MSR
    if (m_x2apic){
        CPU::write_msr((reg >> 4) + 0x800, value);
        return;
    }
 
    // Default to memory I/O
    *(volatile uint32_t*) ((uintptr_t) m_apic_base_high + reg) = value;
}
 
uint32_t LocalAPIC::id() const {
 
    // Read the id
    uint32_t id = read(0x20);
 
    // Return the id
    return m_x2apic ? id : (id >> 24);
}
 
void LocalAPIC::send_eoi() const {
 
    write(0xB0, 0);
}
 
void LocalAPIC::send_init(uint8_t apic_id, bool assert) const {
 
    uint32_t icr_low = 0;
 
    // Delivery mode = INIT (101b at bits 8-10)
    icr_low |= (0b101 << 8);
 
    // Level (bit 14): 1 = assert, 0 = de-assert
    if (assert)
        icr_low |= (1 << 14);
 
    // Trigger mode: Level = 1
    icr_low |= (1 << 15);
 
    if (!m_x2apic) {
 
        // Select target core
        write(0x310, apic_id << 24);
 
        // Send INIT (Delivery mode = INIT, Level = 1)
        write(0x300, icr_low);
 
        // Wait for delivery
        while (read(0x300) & (1 << 12))
            asm volatile("pause");
 
    } else {
 
        // x2APIC
        CPU::write_msr(0x830, (uint64_t)apic_id << 32 | icr_low);
    }
}
 
void LocalAPIC::send_startup(uint8_t apic_id, uint8_t vector) const {
 
    if (!m_x2apic) {
 
        // Select target core
        write(0x310, apic_id << 24);
 
        // Send SIPI (Delivery mode = STARTUP)
        write(0x300, 0x4600 | vector);
 
        // Wait for delivery
        while (read(0x300) & (1 << 12))
            asm volatile("pause");
 
    } else {
 
        // x2APIC
        CPU::write_msr(0x831, (uint64_t)apic_id << 32 | 0x4600 | vector);
    }
 
 
}
 
IOAPIC::IOAPIC(AdvancedConfigurationAndPowerInterface* acpi)
: m_acpi(acpi)
{
 
    // Get the information about the IO APIC
    m_madt = (MADT*) m_acpi->find("APIC");
    MADTEntry* io_apic_item = get_madt_item(MADT_TYPE::IO_APIC, 0);
 
    // Get the IO APIC
    auto* io_apic = (MADT_IO_APIC*) PhysicalMemoryManager::to_io_region((uint64_t) io_apic_item + sizeof(MADTEntry));
    PhysicalMemoryManager::s_current_manager->map((physical_address_t*) io_apic_item, (virtual_address_t*) (io_apic - sizeof(MADTEntry)), PRESENT | WRITE);
 
    // Map the IO APIC address to the higher half
    m_address = io_apic->io_apic_address;
    m_address_high = (uint64_t) PhysicalMemoryManager::to_io_region(m_address);
    PhysicalMemoryManager::s_current_manager->map((physical_address_t*) m_address, (virtual_address_t*) m_address_high, PRESENT | WRITE);
    Logger::DEBUG() << "IO APIC Address: phy=0x" << m_address << ", virt=0x" << m_address_high << "\n";
 
    // Get the IO APIC version and max redirection entry
    m_version = read(0x1);
    m_max_redirect_entry = (uint8_t) (m_version >> 16);
 
    // Log the IO APIC information
    Logger::DEBUG() << "IO APIC Version: 0x" << (uint64_t) (m_version & 0xFF) << "\n";
    Logger::DEBUG() << "IO APIC Max Redirection Entry: 0x" << (uint64_t) m_max_redirect_entry << "\n";
 
    // Get the source override item
    MADTEntry* source_override_item = get_madt_item(MADT_TYPE::IO_APIC, m_override_array_size);
    uint32_t total_length = sizeof(MADT);
    while (total_length < m_madt->header.length && m_override_array_size < 0x10) { // 0x10 is the max items
 
        total_length += source_override_item->length;
 
        // If there is an override, populate the array
        if (source_override_item != nullptr && source_override_item->type == 2) {
 
            // Get the override and populate the array
            auto* override = (Override*) (source_override_item + 1);
            m_override_array[m_override_array_size].bus = override->bus;
            m_override_array[m_override_array_size].source = override->source;
            m_override_array[m_override_array_size].global_system_interrupt = override->global_system_interrupt;
            m_override_array[m_override_array_size].flags = override->flags;
            m_override_array_size++;
        }
 
        // Get the next item
        source_override_item = get_madt_item(MADT_TYPE::IO_APIC, m_override_array_size);
        if (source_override_item == nullptr)
            break;
    }
 
    Logger::DEBUG() << "IO APIC Source Overrides: 0x" << m_override_array_size << "\n";
}
 
IOAPIC::~IOAPIC() = default;
 
MADTEntry* IOAPIC::get_madt_item(MADT_TYPE type, uint8_t index) {
 
    // The item starts at the start of the MADT
    auto* item = (MADTEntry*) ((uint64_t) m_madt + sizeof(MADT));
    uint64_t total_length = 0;
    uint8_t current_index = 0;
 
    // Loop through the items
    while (total_length + sizeof(MADT) < m_madt->header.length && current_index <= index) {
 
        // Correct type
        if (item->type == (uint8_t)type) {
 
            // Correct index means found
            if (current_index == index)
                return item;
 
            // Right type wrong index so move on
            current_index++;
        }
 
        // Increment the total length
        total_length += item->length;
        item = (MADTEntry*) ((uint64_t) item + item->length);
    }
 
    // No item found
    return nullptr;
}
 
uint32_t IOAPIC::read(uint32_t reg) const {
 
    // Tell the APIC what register to read from
    *(volatile uint32_t*) (m_address_high + 0x00) = reg;
 
    // Read the value
    return *(volatile uint32_t*) (m_address_high + 0x10);
}
 
void IOAPIC::write(uint32_t reg, uint32_t value) const {
 
    // Write the register
    *(volatile uint32_t*) (m_address_high + 0x00) = reg;
 
    // Write the value
    *(volatile uint32_t*) (m_address_high + 0x10) = value;
}
 
void IOAPIC::read_redirect(uint8_t index, RedirectionEntry* entry) const {
 
    // Check bounds
    if (index < 0x10 || index > 0x3F)
        return;
 
    // Read the entry chunks into the buffer (struct is auto extracted from the raw information)
    uint32_t low = read(index);
    uint32_t high = read(index + 1);
    entry->raw = ((uint64_t) high << 32) | ((uint64_t) low);
}
 
void IOAPIC::write_redirect(uint8_t index, RedirectionEntry* entry) const {
 
    // Check bounds
    if (index < 0x10 || index > 0x3F)
        return;
 
    // Break the entry down into 32bit chunks
    auto low = (uint32_t) entry->raw;
    auto high = (uint32_t) (entry->raw >> 32);
 
    // Set the entry
    write(index, low);
    write(index + 1, high);
}
 
void IOAPIC::set_redirect(interrupt_redirect_t* redirect) {
 
    // Create the redirection entry
    RedirectionEntry entry = {};
    entry.raw = redirect->flags | (redirect->interrupt & 0xFF);
    entry.destination = redirect->destination;
    entry.mask = redirect->mask;
 
    // Check if a global system interrupt is used
    for (uint8_t i = 0; i < m_override_array_size; i++) {
 
        if (m_override_array[i].source != redirect->type)
            continue;
 
        // Set the lower 4 bits of the pin
        entry.pin_polarity = ((m_override_array[i].flags & 0b11) == 2) ? 0b1 : 0b0;
        entry.pin_polarity = (((m_override_array[i].flags >> 2) & 0b11) == 2) ? 0b1 : 0b0;
 
        // Set the trigger mode
        entry.trigger_mode = (((m_override_array[i].flags >> 2) & 0b11) == 2);
        break;
 
    }
 
    // Write the redirect
    write_redirect(redirect->index, &entry);
}
 
void IOAPIC::set_redirect_mask(uint8_t index, bool mask) {
 
    // Read the current entry
    RedirectionEntry entry = {};
    read_redirect(index, &entry);
 
    // Set the mask
    entry.mask = mask;
    write_redirect(index, &entry);
}
 
AdvancedProgrammableInterruptController::AdvancedProgrammableInterruptController(AdvancedConfigurationAndPowerInterface* acpi)
: m_pic_master_command_port(0x20),
  m_pic_master_data_port(0x21),
  m_pic_slave_command_port(0xA0),
  m_pic_slave_data_port(0xA1)
{
 
    // Register this APIC
    Logger::INFO() << "Setting up APIC\n";
    InterruptManager::active_interrupt_manager()->set_apic(this);
 
    // Init the Local APIC
    Logger::DEBUG() << "Initialising Local APIC\n";
    m_local_apic = new LocalAPIC();
 
    // Disable the legacy mode PIC
    Logger::DEBUG() << "Disabling PIC\n";
    disable_pic();
 
    // Init the IO APIC
    Logger::DEBUG() << "Initialising IO APIC\n";
    m_io_apic = new IOAPIC(acpi);
}
 
AdvancedProgrammableInterruptController::~AdvancedProgrammableInterruptController() {
 
    // Free the memory
    delete m_local_apic;
    delete m_io_apic;
}
 
void AdvancedProgrammableInterruptController::disable_pic() {
 
    // Initialise the PIC
    m_pic_master_command_port.write(0x11);
    m_pic_slave_command_port.write(0x11);
 
    // Set the offsets
    m_pic_master_data_port.write(0x20);
    m_pic_slave_data_port.write(0x28);
 
    // Set the slave/master relationships
    m_pic_master_data_port.write(0x04);
    m_pic_slave_data_port.write(0x02);
 
    // Set the modes (8086/8086)
    m_pic_master_data_port.write(0x01);
    m_pic_slave_data_port.write(0x01);
 
    // Mask the interrupts
    m_pic_master_data_port.write(0xFF);
    m_pic_slave_data_port.write(0xFF);
}
 
LocalAPIC* AdvancedProgrammableInterruptController::local_apic() const {
 
    return m_local_apic;
}
 
IOAPIC* AdvancedProgrammableInterruptController::io_apic() const {
 
    return m_io_apic;
}