Sinipelto
/
banan-os
forked from Bananymous/banan-os
1
0
Fork 0
Code Pull Requests Activity

Kernel: rewrite some of APIC since it didn't work with xsdts for some reason

This commit is contained in:
Bananymous 2023-01-26 02:37:34 +02:00
parent 35d2e27292
commit e00d18029d
1 changed files with 78 additions and 74 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

122
kernel/kernel/APIC.cpp
View File

@ -16,25 +16,23 @@
// https://uefi.org/specs/ACPI/6.5/05_ACPI_Software_Programming_Model.html#multiple-apic-description-table-madt-format // https://uefi.org/specs/ACPI/6.5/05_ACPI_Software_Programming_Model.html#multiple-apic-description-table-madt-format
struct RSDPDescriptor static constexpr uint32_t RSPD_SIZE = 20;
static constexpr uint32_t RSPDv2_SIZE = 36;
struct RSDP
{ {
char signature[8]; char signature[8];
uint8_t checksum; uint8_t checksum;
char OEMID[6]; char OEMID[6];
uint8_t revision; uint8_t revision;
uint32_t rsdt_address; uint32_t rsdt_address;
uint32_t v2_length;
uint64_t v2_xsdt_address;
uint8_t v2_extended_checksum;
uint8_t v2_reserved[3];
} __attribute__ ((packed)); } __attribute__ ((packed));
struct RSDPDescriptor20 struct SDTHeader
{
RSDPDescriptor first_part;
uint32_t length;
uint64_t xsdt_address;
uint8_t extended_checksum;
uint8_t reserved[3];
} __attribute__((packed));
struct ACPISDTHeader
{ {
char signature[4]; char signature[4];
uint32_t length; uint32_t length;
@ -47,21 +45,9 @@ struct ACPISDTHeader
uint32_t creator_revision; uint32_t creator_revision;
} __attribute__((packed)); } __attribute__((packed));
struct RSDT
{
ACPISDTHeader header;
uint32_t sdt_pointer[0];
};
struct XSDT
{
ACPISDTHeader header;
uint64_t sdt_pointer[0];
};
struct MADT struct MADT
{ {
ACPISDTHeader header; SDTHeader header;
uint32_t local_apic; uint32_t local_apic;
uint32_t flags; uint32_t flags;
} __attribute__((packed)); } __attribute__((packed));
@ -122,14 +108,16 @@ union RedirectionEntry
}; };
}; };
static bool IsRSDP(const RSDPDescriptor* rsdp) static bool IsRSDP(uintptr_t rsdp_addr)
{ {
const RSDP* rsdp = (const RSDP*)rsdp_addr;
if (memcmp(rsdp->signature, "RSD PTR ", 8) != 0) if (memcmp(rsdp->signature, "RSD PTR ", 8) != 0)
return false; return false;
{ {
uint8_t checksum = 0; uint8_t checksum = 0;
for (uint32_t i = 0; i < sizeof(RSDPDescriptor); i++) for (uint32_t i = 0; i < RSPD_SIZE; i++)
checksum += ((uint8_t*)rsdp)[i]; checksum += ((uint8_t*)rsdp)[i];
if (checksum != 0) if (checksum != 0)
return false; return false;
@ -137,10 +125,9 @@ static bool IsRSDP(const RSDPDescriptor* rsdp)
if (rsdp->revision == 2) if (rsdp->revision == 2)
{ {
RSDPDescriptor20* rsdp20 = (RSDPDescriptor20*)rsdp;
uint8_t checksum = 0; uint8_t checksum = 0;
for (uint32_t i = 0; i < sizeof(RSDPDescriptor20); i++) for (uint32_t i = 0; i < RSPDv2_SIZE; i++)
checksum += ((uint8_t*)rsdp20)[i]; checksum += ((uint8_t*)rsdp)[i];
if (checksum != 0) if (checksum != 0)
return false; return false;
} }
@ -148,16 +135,16 @@ static bool IsRSDP(const RSDPDescriptor* rsdp)
return true; return true;
} }
static const RSDPDescriptor* LocateRSDP() static uintptr_t LocateRSDP()
{ {
// Look in main BIOS area below 1 MB // Look in main BIOS area below 1 MB
for (uintptr_t addr = 0x000E0000; addr < 0x000FFFFF; addr += 16) for (uintptr_t addr = 0x000E0000; addr < 0x000FFFFF; addr += 16)
if (IsRSDP((RSDPDescriptor*)addr)) if (IsRSDP(addr))
return (RSDPDescriptor*)addr; return addr;
return nullptr; return 0;
} }
static bool IsValidACPISDTHeader(const ACPISDTHeader* header) static bool IsValidSDTHeader(const SDTHeader* header)
{ {
uint8_t sum = 0; uint8_t sum = 0;
for (uint32_t i = 0; i < header->length; i++) for (uint32_t i = 0; i < header->length; i++)
@ -165,39 +152,54 @@ static bool IsValidACPISDTHeader(const ACPISDTHeader* header)
return sum == 0; return sum == 0;
} }
static const MADT* LocateMADT(const RSDPDescriptor* rsdp) uintptr_t LocateMADT(uintptr_t rsdp_addr)
{ {
uintptr_t root_addr = 0; uintptr_t entry_address_base = 0;
uintptr_t entry_address_mask = 0;
ptrdiff_t entry_pointer_size = 0;
uint32_t entry_count = 0; uint32_t entry_count = 0;
const RSDP* rsdp = (const RSDP*)rsdp_addr;
if (rsdp->revision == 2) if (rsdp->revision == 2)
{ {
const XSDT* root = (const XSDT*)((const RSDPDescriptor20*)rsdp)->xsdt_address; uintptr_t xsdt_addr = rsdp->v2_xsdt_address;
MMU::Get().AllocatePage((uintptr_t)root); MMU::Get().AllocatePage(xsdt_addr);
entry_count = (root->header.length - sizeof(root->header)) / sizeof(*root->sdt_pointer); entry_address_base = xsdt_addr + sizeof(SDTHeader);
root_addr = (uintptr_t)root; entry_address_mask = (uintptr_t)0xFFFFFFFFFFFFFFFF;
entry_count = (((const SDTHeader*)xsdt_addr)->length - sizeof(SDTHeader)) / 8;
entry_pointer_size = 8;
MMU::Get().UnAllocatePage(xsdt_addr);
} }
else else
{ {
const RSDT* root = (const RSDT*)(uintptr_t)rsdp->rsdt_address; uintptr_t rsdt_addr = rsdp->rsdt_address;
MMU::Get().AllocatePage((uintptr_t)root); MMU::Get().AllocatePage(rsdt_addr);
entry_count = (root->header.length - sizeof(root->header)) / sizeof(*root->sdt_pointer); entry_address_base = rsdt_addr + sizeof(SDTHeader);
root_addr = (uintptr_t)root; entry_address_mask = 0xFFFFFFFF;
entry_count = (((const SDTHeader*)rsdt_addr)->length - sizeof(SDTHeader)) / 4;
entry_pointer_size = 4;
MMU::Get().UnAllocatePage(rsdt_addr);
} }
BAN::ScopeGuard guard([root_addr]() { MMU::Get().UnAllocatePage(root_addr); });
for (uint32_t i = 0; i < entry_count; i++) for (uint32_t i = 0; i < entry_count; i++)
{ {
const ACPISDTHeader* header = nullptr; uintptr_t entry_addr_ptr = entry_address_base + i * entry_pointer_size;
if (rsdp->revision == 2) MMU::Get().AllocatePage(entry_addr_ptr);
header = (const ACPISDTHeader*)((const XSDT*)root_addr)->sdt_pointer[i];
else uintptr_t entry_addr = *(uintptr_t*)entry_addr_ptr & entry_address_mask;
header = (const ACPISDTHeader*)(uintptr_t)((const RSDT*)root_addr)->sdt_pointer[i]; MMU::Get().AllocatePage(entry_addr);
if (memcmp(header->signature, "APIC", 4) == 0 && IsValidACPISDTHeader(header))
return (const MADT*)header; BAN::ScopeGuard _([&]() {
MMU::Get().UnAllocatePage(entry_addr);
MMU::Get().UnAllocatePage(entry_addr_ptr);
});
const SDTHeader* entry = (const SDTHeader*)entry_addr;
if (memcmp(entry->signature, "APIC", 4) == 0 && IsValidSDTHeader(entry))
return entry_addr;
} }
return nullptr; return 0;
} }
APIC* APIC::Create() APIC* APIC::Create()
@ -210,21 +212,23 @@ APIC* APIC::Create()
return nullptr; return nullptr;
} }
const RSDPDescriptor* rsdp = LocateRSDP(); uintptr_t rsdp_addr = LocateRSDP();
if (rsdp == nullptr) if (!rsdp_addr)
{ {
dprintln("Could not locate RSDP"); dprintln("Could not locate RSDP");
return nullptr; return nullptr;
} }
const MADT* madt = LocateMADT(rsdp); uintptr_t madt_addr = LocateMADT(rsdp_addr);
if (madt == nullptr) if (!madt_addr)
{ {
dprintln("Could not find MADT in RSDP"); dprintln("Could not find MADT in RSDP");
return nullptr; return nullptr;
} }
MMU::Get().AllocatePage((uintptr_t)madt); MMU::Get().AllocatePage(madt_addr);
const MADT* madt = (const MADT*)madt_addr;
APIC* apic = new APIC; APIC* apic = new APIC;
apic->m_local_apic = madt->local_apic; apic->m_local_apic = madt->local_apic;