Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- /*
- * xapic.c
- * Advanced Programmable Interrupt Controller
- */
- #include <os/driver.h>
- #include <cpu/xapic.h>
- #include <cpu/cpu.h>
- #include <misc/mp.h>
- #include <stdio.h>
- #define DESTMODE_FIXED 0x00
- #define DESTMODE_LOW_PRIORITY 0x01
- #define DESTMODE_SMI 0x02
- #define DESTMODE_NMI 0x04
- #define DESTMODE_INIT 0x05
- #define DESTMODE_EXTERNAL 0x07
- #define BuildRedirectionEntry(DEST, DESTMODE, DISABLED, ISPCI, VECT) \
- ((uint64)( \
- (((uint64)DEST) << 56) | \
- (((uint64)DISABLED) << 16) | \
- (((ISPCI == 1) ? (uint64)((1 << 15) | (1 << 13)) : 0)) | \
- (((uint64)DESTMODE) << 11) | \
- (((uint64)VECT)) \
- ))
- // For visibility in apic.asm
- void* volatile lapicBase = NULL;
- void* volatile ioapicBase = NULL;
- static uint16 ioapicMaxRedirectTableEntry = 0;
- // volatile keyword here SHOULD keep GCC from optimizing out the access order
- static inline void XIOAPICWriteReg(const volatile void* base, uint8 offset, uint32 value) {
- *(uint32*)base = offset;
- *(uint32*)((paddr)base + 0x10) = value;
- }
- static inline uint32 XIOAPICReadReg(const volatile void* base, uint8 offset) {
- *(uint32*)base = offset;
- return *(uint32*)((paddr)base + 0x10);
- }
- static inline void XLAPICWriteReg(const volatile void* base, uint16 offset, uint32 value) {
- *(uint32*)((paddr)base + offset) = value;
- }
- static inline uint32 XLAPICReadReg(const volatile void* base, uint16 offset) {
- return *(uint32*)((paddr)base + offset);
- }
- static void XLAPICInitialize(void* lapicAddress) {
- uint32 sivr, lvttr, pcr;
- // Sanity check
- if (lapicAddress == NULL)
- return;
- // Configure local APIC
- XLAPICWriteReg(lapicAddress, LAPIC_MM_REG_TASK_PRIORITY, 0x20); // Clear task priority
- //XLAPICWriteReg(lapicAddress, LAPIC_MM_REG_LOGICAL_DESTINATION, 0x01000000); // Logical Destination
- //XLAPICWriteReg(lapicAddress, LAPIC_MM_REG_DESTINATION_FORMAT, 0xFFFFFFFF); // Destination Format Register
- // Disable timer
- lvttr = XLAPICReadReg(lapicAddress, LAPIC_MM_REG_LVT_TIMER);
- lvttr |= 0x00010000;
- XLAPICWriteReg(lapicAddress, LAPIC_MM_REG_LVT_TIMER, lvttr);
- // Disable performance counter
- pcr = XLAPICReadReg(lapicAddress, 0x340);
- pcr |= 0x00010000;
- XLAPICWriteReg(lapicAddress, 0x340, pcr);
- XLAPICWriteReg(lapicAddress, 0x350, XLAPICReadReg(lapicAddress, 0x350) | 0x00008700);
- XLAPICWriteReg(lapicAddress, 0x360, XLAPICReadReg(lapicAddress, 0x360) | 0x00000400);
- XLAPICWriteReg(lapicAddress, 0x370, XLAPICReadReg(lapicAddress, 0x370) | 0x00010000);
- // Enable local APIC
- sivr = XLAPICReadReg(lapicAddress, LAPIC_MM_REG_SPURIOUS_INTERRUPT);
- sivr = (sivr & 0xFFFFFF00) | 0x0000000F;
- sivr |= 0x00000100;
- XLAPICWriteReg(lapicAddress, LAPIC_MM_REG_SPURIOUS_INTERRUPT, sivr);
- }
- void XAPICInstallRedirectionEntry(uint16 index, uint64 value) {
- // Sanity check
- if (ioapicBase == NULL || index >= ioapicMaxRedirectTableEntry)
- return;
- kprintf("VALUE = %016X\n", value);
- // Safe gaurd entry
- XIOAPICWriteReg((const void*)ioapicBase, (index << 1) + 0x10 + 1, 0x00010000);
- // Write
- XIOAPICWriteReg((const void*)ioapicBase, (index << 1) + 0x10, value & 0x00000000FFFFFFFF);
- XIOAPICWriteReg((const void*)ioapicBase, (index << 1) + 0x10 + 1, (value & 0xFFFFFFFF00000000) >> 32);
- }
- /*
- * int APicInitializeWithMP(uint16* coreCount);
- * Arguments:
- * coreCount Core Count
- * Returns:
- * 0 Success
- * -1 No APIC detected
- * -2 No MP support
- */
- static int XAPICInitializeWithMP(uint16* coreCount) {
- size_t i, j, ioapicInitCount = 0;
- // Get configuration table
- MPConfigurationTable* configurationTable = MpGetConfigurationTable();
- if (configurationTable == NULL)
- return -2;
- if (!configurationTable->lapicAddress)
- return -1;
- // Disable PIC before we do anything
- outb(0x21, 0xFF);
- outb(0xA1, 0xFF);
- // Enable each IOAPIC -- Verify every IOAPIC has a unique id beforehand?
- j = MpGetEntryCount(configurationTable);
- // This for loop is used instead of a while() because it's more likely that an IOAPIC entry is lower in the list (saves time)
- for(i = 0; i < j; ++i) {
- MPEntry* entry;
- // Get entry
- if (!(entry = MpGetEntry(configurationTable, i)))
- continue;
- if (entry->type == MP_ET_PROCESSOR) // Processor entry
- ++*coreCount;
- else if (entry->type == MP_ET_IOAPIC) { // IOAPIC entry
- uint32 entries;
- // Only initialize a single IOAPIC and IOAPICs marked as usable
- if (ioapicInitCount > 0 || !(entry->ioapic.flags & MP_IOAPIC_FLAG_UNUSABLE))
- continue;
- kprintf("Initializing IOAPIC %i (flags = 0x%04X)\n", entry->ioapic.id, entry->ioapic.flags);
- ioapicBase = (void*)(paddr)entry->ioapic.address;
- // Grab IOAPIC redirection entries
- entries = ((XIOAPICReadReg((const void*)ioapicBase, IOAPIC_REG_VERSION) >> 16) & 0xFF) + 1;
- ioapicMaxRedirectTableEntry = entries;
- kprintf("ENTRIES = %i\n\n", entries);
- // Program first 16 entries
- if (entries >= 16) {
- XAPICInstallRedirectionEntry(INT_PIT, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 0, 0, IRQ_PIT));
- XAPICInstallRedirectionEntry(INT_KEYBOARD, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 0, 0, IRQ_KEYBOARD));
- XAPICInstallRedirectionEntry(INT_CASCADE, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 1, 0, IRQ_CASCADE));
- XAPICInstallRedirectionEntry(INT_COM1, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 0, 0, IRQ_COM1));
- XAPICInstallRedirectionEntry(INT_COM2, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 0, 0, IRQ_COM2));
- XAPICInstallRedirectionEntry(INT_LPT2, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 0, 0, IRQ_LPT2));
- XAPICInstallRedirectionEntry(INT_FLOPPY_DISK, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 0, 0, IRQ_FLOPPY_DISK));
- XAPICInstallRedirectionEntry(INT_LPT1, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 0, 0, IRQ_LPT1));
- XAPICInstallRedirectionEntry(INT_CMOS_RTC, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 0, 0, IRQ_CMOS_RTC));
- XAPICInstallRedirectionEntry(INT_MOUSE, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 0, 0, IRQ_MOUSE));
- XAPICInstallRedirectionEntry(INT_FPU, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 0, 0, IRQ_FPU));
- XAPICInstallRedirectionEntry(INT_HDD_PRIMARY, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 0, 0, IRQ_HDD_PRIMARY));
- XAPICInstallRedirectionEntry(INT_HDD_SECONDARY, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 0, 0, IRQ_HDD_SECONDARY));
- }
- // Program PCI entries
- if (entries >= 0x13) {
- // Depends on BIOS implementation, for now just disable them (Until I figure out how to detect these values safely)
- XAPICInstallRedirectionEntry(INT_PCI_A, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 1, 1, 0x00));
- XAPICInstallRedirectionEntry(INT_PCI_B, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 1, 1, 0x00));
- XAPICInstallRedirectionEntry(INT_PCI_C, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 1, 1, 0x00));
- XAPICInstallRedirectionEntry(INT_PCI_D, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 1, 1, 0x00));
- }
- // Disable last entries
- if (entries >= 0x17) {
- XAPICInstallRedirectionEntry(20, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 1, 0, 0x00));
- XAPICInstallRedirectionEntry(21, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 1, 0, 0x00));
- XAPICInstallRedirectionEntry(22, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 1, 0, 0x00));
- XAPICInstallRedirectionEntry(23, BuildRedirectionEntry(entry->ioapic.id, DESTMODE_FIXED, 1, 0, 0x00));
- }
- // Increase the number of times we've initialized an IOAPIC
- ++ioapicInitCount;
- }
- }
- // Enable Symetrical IO mode if we're not in it already
- outb(0x22, 0x70);
- outb(0x23, 0x01);
- // Configure & enable local APIC
- lapicBase = (void*)(paddr)configurationTable->lapicAddress;
- XLAPICInitialize(lapicBase);
- return (ioapicInitCount > 0) ? 0 : -1;
- }
- /*
- * int APicInitializeWithACPI(uint16* coreCount);
- * Arguments:
- * coreCount Core Count
- * Returns:
- * 0 Success
- * -1 No APIC detected
- * -2 No ACPI support
- */
- static int XAPICInitializeWithACPI(uint16* coreCount) {
- UNUSED_PARAMETER(coreCount);
- return -1;
- }
- /*
- * int APicInitialize(uint16* coreCount);
- * Arguments:
- * coreCount Core Count
- * Returns:
- * 0 Success
- * -1 No APIC detected
- * -2 MP/ACPI not supported on this system
- */
- int XAPICInitialize(uint16* coreCount) {
- size_t a, d;
- int i;
- // Check if APIC is on this machine
- CpuGetId(CPUID_GETFEATURES, &a, &d);
- if (!(d & CPUID_FEAT_EDX_APIC))
- return -1;
- // Attempt to initialize with MP
- i = XAPICInitializeWithMP(coreCount);
- // If MP initialization fails try to initialize with ACPI
- if (i != 0) {
- *coreCount = 0;
- i = XAPICInitializeWithACPI(coreCount);
- }
- return i;
- }
Advertisement
Add Comment
Please, Sign In to add comment