RSDT read and controlled
This commit is contained in:
parent
327f63f3a9
commit
898c05588a
|
@ -73,8 +73,7 @@ struct SDTHeader {
|
||||||
|
|
||||||
//----------------------------------------------------------------------------//
|
//----------------------------------------------------------------------------//
|
||||||
|
|
||||||
void IoTestAcpi(void);
|
void IoInitAcpi(void);
|
||||||
RSDPDescriptor *IoFindRSDP(void);
|
|
||||||
|
|
||||||
//----------------------------------------------------------------------------//
|
//----------------------------------------------------------------------------//
|
||||||
|
|
||||||
|
|
|
@ -82,7 +82,7 @@ noreturn void BtStartKern(multiboot_info_t *mbInfo, uint mbMagic, void *codeSeg)
|
||||||
IoEnableKeyb();
|
IoEnableKeyb();
|
||||||
|
|
||||||
// ACPI
|
// ACPI
|
||||||
IoTestAcpi();
|
IoInitAcpi();
|
||||||
|
|
||||||
// Scheduler
|
// Scheduler
|
||||||
PsInitSched();
|
PsInitSched();
|
||||||
|
|
|
@ -27,8 +27,14 @@
|
||||||
#include <io/acpi.h>
|
#include <io/acpi.h>
|
||||||
#include <mm/paging.h>
|
#include <mm/paging.h>
|
||||||
|
|
||||||
SDTHeader *AcpiSDHeader = NULL;
|
SDTHeader *AcpiSDT = NULL;
|
||||||
|
SDTHeader *AcpiFADT = NULL;
|
||||||
|
|
||||||
|
char IoACPIVersion = 1;
|
||||||
|
|
||||||
|
//
|
||||||
|
// Returns the checksum of the given structure
|
||||||
|
//
|
||||||
static inline char DoChecksum(void *ptr, size_t size,
|
static inline char DoChecksum(void *ptr, size_t size,
|
||||||
size_t intermediateSize, ulong reason)
|
size_t intermediateSize, ulong reason)
|
||||||
{
|
{
|
||||||
|
@ -41,64 +47,10 @@ static inline char DoChecksum(void *ptr, size_t size,
|
||||||
return checksum;
|
return checksum;
|
||||||
}
|
}
|
||||||
|
|
||||||
void IoTestAcpi(void)
|
//
|
||||||
{
|
// Returns the address of the RSDP
|
||||||
uchar checksum = 0;
|
//
|
||||||
|
static inline RSDPDescriptor *IoFindRSDP()
|
||||||
if (BtFirmwareInfo.romValid)
|
|
||||||
KernLog("\tRom Table is valid at %p\n", BtFirmwareInfo.romTable);
|
|
||||||
|
|
||||||
if (BtFirmwareInfo.apmValid)
|
|
||||||
KernLog("\tApm Table is valid at %p\n", BtFirmwareInfo.apmTable);
|
|
||||||
|
|
||||||
// FIND RSDP
|
|
||||||
|
|
||||||
RSDPDescriptor *rsdp = IoFindRSDP();
|
|
||||||
if (!rsdp)
|
|
||||||
KeStartPanic("ACPI RSDP not found in memory");
|
|
||||||
|
|
||||||
// Checksum calculation
|
|
||||||
checksum = DoChecksum(rsdp, (size_t)sizeof(RSDPDescriptor),
|
|
||||||
(size_t)sizeof(struct RSDPLegacy),
|
|
||||||
!rsdp->legacy.revision
|
|
||||||
);
|
|
||||||
|
|
||||||
if (checksum)
|
|
||||||
KeStartPanic("Invalid checksum : %d vs 0", checksum);
|
|
||||||
|
|
||||||
if (rsdp->legacy.revision == 1 || rsdp->legacy.revision >= 3)
|
|
||||||
KeStartPanic("Invalid ACPI Revision : %d", rsdp->legacy.revision);
|
|
||||||
|
|
||||||
KernLog("\tACPI Root System Table (OEM %s) Revision %d at %p\n",
|
|
||||||
rsdp->legacy.OEMID,
|
|
||||||
(uint)rsdp->legacy.revision,
|
|
||||||
rsdp->legacy.rsdtAddress
|
|
||||||
);
|
|
||||||
|
|
||||||
AcpiSDHeader = (SDTHeader *)(ulong)rsdp->legacy.rsdtAddress;
|
|
||||||
|
|
||||||
if (rsdp->legacy.revision) {
|
|
||||||
KernLog("\tFound ACPI Extended System Table (OEM %s) Revision %d at %p\n",
|
|
||||||
rsdp->legacy.OEMID,
|
|
||||||
(uint)rsdp->legacy.revision,
|
|
||||||
rsdp->xsdtAddress
|
|
||||||
);
|
|
||||||
|
|
||||||
AcpiSDHeader = (SDTHeader *)rsdp->xsdtAddress;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Map the Table Header
|
|
||||||
for (ulong i = 0; i < (sizeof(AcpiSDHeader)/KPAGESIZE) + 1; i++) {
|
|
||||||
|
|
||||||
MmMapPage((void*)((ulong)(AcpiSDHeader) + i*KPAGESIZE),
|
|
||||||
(void*)((ulong)(AcpiSDHeader) + i*KPAGESIZE),
|
|
||||||
PRESENT);
|
|
||||||
}
|
|
||||||
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
RSDPDescriptor *IoFindRSDP()
|
|
||||||
{
|
{
|
||||||
char *rsdp = NULL;
|
char *rsdp = NULL;
|
||||||
|
|
||||||
|
@ -141,3 +93,108 @@ RSDPDescriptor *IoFindRSDP()
|
||||||
|
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
//
|
||||||
|
// R/XSDT Exploration
|
||||||
|
//
|
||||||
|
static inline void IoInitRXSDT(void)
|
||||||
|
{
|
||||||
|
char checksum = 1;
|
||||||
|
|
||||||
|
SDTHeader *rxsdt = AcpiSDT;
|
||||||
|
|
||||||
|
// Map the Table Header
|
||||||
|
for (ulong i = 0; i < (sizeof(SDTHeader)/KPAGESIZE) + 1; i++) {
|
||||||
|
MmMapPage((void*)((ulong)(rxsdt) + i*KPAGESIZE),
|
||||||
|
(void*)((ulong)(rxsdt) + i*KPAGESIZE),
|
||||||
|
PRESENT);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Checksum calculation
|
||||||
|
checksum = DoChecksum(rxsdt, (size_t)rxsdt->length,
|
||||||
|
0,
|
||||||
|
0
|
||||||
|
);
|
||||||
|
|
||||||
|
if (checksum)
|
||||||
|
KeStartPanic("Invalid RSDT checksum : %d vs 0", checksum);
|
||||||
|
|
||||||
|
if (IoACPIVersion == 1) {
|
||||||
|
KernLog("\tACPI Root System Table %s (%s) length %d [%p]\n",
|
||||||
|
rxsdt->signature,
|
||||||
|
rxsdt->OEMID,
|
||||||
|
rxsdt->length,
|
||||||
|
rxsdt
|
||||||
|
);
|
||||||
|
} else {
|
||||||
|
KernLog("\tACPI Extended System Table %s (%s) length %d [%p]\n",
|
||||||
|
rxsdt->signature,
|
||||||
|
rxsdt->OEMID,
|
||||||
|
rxsdt->length,
|
||||||
|
rxsdt
|
||||||
|
);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
//
|
||||||
|
// RSDP Exploration
|
||||||
|
//
|
||||||
|
static inline void IoInitRSDP(void)
|
||||||
|
{
|
||||||
|
char checksum = 1;
|
||||||
|
|
||||||
|
RSDPDescriptor *rsdp = IoFindRSDP();
|
||||||
|
if (!rsdp)
|
||||||
|
KeStartPanic("ACPI RSDP not found in memory");
|
||||||
|
|
||||||
|
// Checksum calculation
|
||||||
|
checksum = DoChecksum(rsdp, (size_t)sizeof(RSDPDescriptor),
|
||||||
|
(size_t)sizeof(struct RSDPLegacy),
|
||||||
|
!rsdp->legacy.revision
|
||||||
|
);
|
||||||
|
|
||||||
|
if (checksum)
|
||||||
|
KeStartPanic("Invalid RSDP checksum : %d vs 0", checksum);
|
||||||
|
|
||||||
|
if (rsdp->legacy.revision == 1 || rsdp->legacy.revision >= 3)
|
||||||
|
KeStartPanic("Invalid ACPI Revision : %d", rsdp->legacy.revision);
|
||||||
|
|
||||||
|
KernLog("\tACPI Revision %d (OEM %s)\n",
|
||||||
|
(uint)rsdp->legacy.revision,
|
||||||
|
rsdp->legacy.OEMID
|
||||||
|
);
|
||||||
|
|
||||||
|
AcpiSDT = (void *)(ulong)rsdp->legacy.rsdtAddress;
|
||||||
|
|
||||||
|
if (rsdp->legacy.revision) {
|
||||||
|
AcpiSDT = (void *)rsdp->xsdtAddress;
|
||||||
|
IoACPIVersion = 2;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
//
|
||||||
|
// Explore all ACPI Tables
|
||||||
|
//
|
||||||
|
static inline void IoSearchAcpiTables(void)
|
||||||
|
{
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
//
|
||||||
|
// Initialise the ACPI by finding tables
|
||||||
|
//
|
||||||
|
void IoInitAcpi(void)
|
||||||
|
{
|
||||||
|
if (BtFirmwareInfo.romValid)
|
||||||
|
KernLog("\tRom Table is valid at %p\n", BtFirmwareInfo.romTable);
|
||||||
|
|
||||||
|
if (BtFirmwareInfo.apmValid)
|
||||||
|
KernLog("\tApm Table is valid at %p\n", BtFirmwareInfo.apmTable);
|
||||||
|
|
||||||
|
// FIND RSDP
|
||||||
|
|
||||||
|
IoInitRSDP();
|
||||||
|
|
||||||
|
IoInitRXSDT();
|
||||||
|
}
|
||||||
|
|
Loading…
Reference in New Issue