123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372 |
- #include <Kernel/ACPI/ACPIStaticParser.h>
- #include <Kernel/IO.h>
- #include <Kernel/StdLib.h>
- #include <Kernel/VM/MemoryManager.h>
- void ACPIStaticParser::initialize(ACPI_RAW::RSDPDescriptor20& rsdp)
- {
- if (!ACPIParser::is_initialized()) {
- new ACPIStaticParser(rsdp);
- }
- }
- void ACPIStaticParser::initialize_without_rsdp()
- {
- if (!ACPIParser::is_initialized()) {
- new ACPIStaticParser();
- }
- }
- bool ACPIStaticParser::is_initialized()
- {
- return ACPIParser::is_initialized();
- }
- void ACPIStaticParser::locate_static_data()
- {
- locate_main_system_description_table();
- initialize_main_system_description_table();
- init_fadt();
- locate_all_aml_tables();
- }
- ACPI_RAW::SDTHeader* ACPIStaticParser::find_table(const char* sig)
- {
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Calling Find Table method!\n");
- #endif
- for (auto* physical_sdt_ptr : m_main_sdt->get_sdt_pointers()) {
- auto region = MM.allocate_kernel_region((PAGE_SIZE * 2), "ACPI Static Parser Tables Finding", Region::Access::Read);
- mmap_region(*region, PhysicalAddress((u32)physical_sdt_ptr));
- ACPI_RAW::SDTHeader* sdt = (ACPI_RAW::SDTHeader*)(region->vaddr().get() + ((u32)physical_sdt_ptr & (~PAGE_MASK)));
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Examining Table @ P 0x%x\n", physical_sdt_ptr);
- #endif
- if (!strncmp(sdt->sig, sig, 4)) {
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Found Table @ P 0x%x\n", physical_sdt_ptr);
- #endif
- return physical_sdt_ptr;
- }
- }
- return nullptr;
- }
- ACPI_RAW::SDTHeader& ACPIStaticParser::find_fadt()
- {
- kprintf("ACPI: Searching for the Fixed ACPI Data Table\n");
- for (auto* physical_sdt_ptr : m_main_sdt->get_sdt_pointers()) {
- auto region = MM.allocate_kernel_region((PAGE_SIZE * 2), "ACPI Static Parser AML Tables Finding", Region::Access::Read);
- mmap_region(*region, PhysicalAddress((u32)physical_sdt_ptr & PAGE_MASK));
- ACPI_RAW::SDTHeader* sdt = (ACPI_RAW::SDTHeader*)(region->vaddr().get() + ((u32)physical_sdt_ptr & (~PAGE_MASK)));
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Examining Table @ P 0x%x\n", physical_sdt_ptr);
- #endif
- if (!strncmp(sdt->sig, "FACP", 4)) {
- kprintf("ACPI: Found FADT Table @ P 0x%x, registering\n", physical_sdt_ptr);
- return *physical_sdt_ptr;
- }
- }
- ASSERT_NOT_REACHED(); // If we reached this point, there's something very incorrect with the system!
- }
- void ACPIStaticParser::init_fadt()
- {
- kprintf("ACPI: Initializing Fixed ACPI data\n");
- ACPI_RAW::SDTHeader& physical_fadt = find_fadt();
- auto checkup_region = MM.allocate_kernel_region((PAGE_SIZE * 2), "ACPI Static Parser", Region::Access::Read);
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Checking FADT Length to choose the correct mapping size\n");
- #endif
- mmap_region(*checkup_region, PhysicalAddress((u32)(&physical_fadt) & PAGE_MASK));
- ACPI_RAW::SDTHeader* sdt = (ACPI_RAW::SDTHeader*)(checkup_region->vaddr().get() + ((u32)(&physical_fadt) & (~PAGE_MASK)));
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: FADT @ V 0x%x, P 0x%x\n", sdt, &physical_fadt);
- #endif
- u32 length = sdt->length;
- kprintf("ACPI: Fixed ACPI data, Revision %u\n", sdt->revision);
- auto fadt_region = MM.allocate_kernel_region(PAGE_ROUND_UP(length) + PAGE_SIZE, "ACPI Static Parser", Region::Access::Read);
- mmap_region(*fadt_region, PhysicalAddress((u32)(&physical_fadt) & PAGE_MASK));
- m_fadt = OwnPtr<ACPI::FixedACPIData>(new ACPI::FixedACPIData(*((ACPI_RAW::FADT*)(fadt_region->vaddr().get() + ((u32)(&physical_fadt) & (~PAGE_MASK))))));
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Finished to initialize Fixed ACPI data\n");
- #endif
- }
- void ACPIStaticParser::do_acpi_reboot()
- {
- // FIXME: Determine if we need to do MMIO/PCI/IO access to reboot, according to ACPI spec 6.2, Section 4.8.3.6
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Rebooting, Probing FADT (P @ 0x%x)\n", m_fadt.ptr());
- #endif
- if (m_fadt->m_revision >= 2) {
- kprintf("ACPI: Reboot, Sending value 0%x to Port 0x%x\n", m_fadt->m_reset_value, m_fadt->m_reset_reg.address);
- IO::out8(m_fadt->m_reset_reg.address, m_fadt->m_reset_value);
- } else {
- kprintf("ACPI: Reboot, Not supported!\n");
- }
- ASSERT_NOT_REACHED(); /// If rebooting didn't work, halt.
- }
- void ACPIStaticParser::do_acpi_shutdown()
- {
- kprintf("ACPI: Shutdown is not supported with the current configuration, Abort!\n");
- ASSERT_NOT_REACHED();
- }
- void ACPIStaticParser::initialize_main_system_description_table()
- {
- auto checkup_region = MM.allocate_kernel_region((PAGE_SIZE * 2), "ACPI Static Parser Copying Method", Region::Access::Read);
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Checking Main SDT Length to choose the correct mapping size");
- #endif
- mmap_region(*checkup_region, PhysicalAddress((u32)m_main_system_description_table & PAGE_MASK));
- auto* sdt = (ACPI_RAW::SDTHeader*)(checkup_region->vaddr().get() + ((u32)m_main_system_description_table & (~PAGE_MASK)));
- u32 length = sdt->length;
- u8 revision = sdt->revision;
- auto main_sdt_region = MM.allocate_kernel_region(PAGE_ROUND_UP(length) + PAGE_SIZE, "ACPI Static Parser Copying Method", Region::Access::Read);
- mmap_region(*main_sdt_region, PhysicalAddress((u32)m_main_system_description_table & PAGE_MASK));
- Vector<ACPI_RAW::SDTHeader*> sdt_pointers;
- if (m_xsdt_supported) {
- ACPI_RAW::XSDT* xsdt = (ACPI_RAW::XSDT*)(main_sdt_region->vaddr().get() + ((u32)m_main_system_description_table & (~PAGE_MASK)));
- kprintf("ACPI: Using XSDT, Enumerating tables @ P 0x%x\n", m_main_system_description_table);
- kprintf("ACPI: XSDT Revision %d, Total length - %u\n", revision, length);
- for (u32 i = 0; i < ((xsdt->h.length - sizeof(ACPI_RAW::SDTHeader)) / sizeof(u64)); i++) {
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Found new table, @ P 0x%x\n", xsdt->table_ptrs[i]);
- #endif
- sdt_pointers.append((ACPI_RAW::SDTHeader*)xsdt->table_ptrs[i]);
- }
- } else {
- ACPI_RAW::RSDT* rsdt = (ACPI_RAW::RSDT*)(main_sdt_region->vaddr().get() + ((u32)m_main_system_description_table & (~PAGE_MASK)));
- kprintf("ACPI: Using RSDT, Enumerating tables @ P 0x%x\n", m_main_system_description_table);
- kprintf("ACPI: RSDT Revision %d, Total length - %u\n", revision, length);
- for (u32 i = 0; i < ((rsdt->h.length - sizeof(ACPI_RAW::SDTHeader)) / sizeof(u32)); i++) {
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Found new table, @ P 0x%x\n", rsdt->table_ptrs[i]);
- #endif
- sdt_pointers.append((ACPI_RAW::SDTHeader*)rsdt->table_ptrs[i]);
- }
- }
- m_main_sdt = OwnPtr<ACPI::MainSystemDescriptionTable>(new ACPI::MainSystemDescriptionTable(move(sdt_pointers)));
- }
- void ACPIStaticParser::locate_main_system_description_table()
- {
- if (m_rsdp->base.revision == 0) {
- m_xsdt_supported = false;
- } else if (m_rsdp->base.revision >= 2) {
- if (m_rsdp->xsdt_ptr != (u64) nullptr) {
- m_xsdt_supported = true;
- } else {
- m_xsdt_supported = false;
- }
- }
- if (!m_xsdt_supported) {
- m_main_system_description_table = (ACPI_RAW::SDTHeader*)m_rsdp->base.rsdt_ptr;
- } else {
- m_main_system_description_table = (ACPI_RAW::SDTHeader*)m_rsdp->xsdt_ptr;
- }
- }
- void ACPIStaticParser::locate_all_aml_tables()
- {
- // Note: According to the ACPI spec, DSDT pointer may be found in the FADT table.
- // All other continuation of the DSDT can be found as pointers in the RSDT/XSDT.
- kprintf("ACPI: Searching for AML Tables\n");
- m_aml_tables_ptrs.append(m_fadt->get_dsdt());
- for (auto* sdt_ptr : m_main_sdt->get_sdt_pointers()) {
- auto region = MM.allocate_kernel_region((PAGE_SIZE * 2), "ACPI Static Parser AML Tables Finding", Region::Access::Read);
- mmap_region(*region, PhysicalAddress((u32)sdt_ptr));
- auto* sdt = (ACPI_RAW::SDTHeader*)(region->vaddr().get() + ((u32)sdt_ptr & (~PAGE_MASK)));
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Examining Table @ P 0x%x\n", sdt_ptr);
- #endif
- if (!strncmp(sdt->sig, "SSDT", 4)) {
- kprintf("ACPI: Found AML Table @ P 0x%x, registering\n", sdt_ptr);
- m_aml_tables_ptrs.append(sdt);
- }
- }
- }
- ACPIStaticParser::ACPIStaticParser()
- : ACPIParser(true)
- , m_rsdp(nullptr)
- , m_main_sdt(nullptr)
- , m_fadt(nullptr)
- {
- m_rsdp = search_rsdp();
- if (m_rsdp != nullptr) {
- kprintf("ACPI: Using RSDP @ P 0x%x\n", m_rsdp);
- m_operable = true;
- locate_static_data();
- } else {
- m_operable = false;
- kprintf("ACPI: Disabled, due to RSDP being absent\n");
- }
- }
- ACPI_RAW::RSDPDescriptor20* ACPIStaticParser::search_rsdp()
- {
- auto region = MM.allocate_kernel_region(PAGE_SIZE, "ACPI Static Parser RSDP Finding", Region::Access::Read);
- mmap_region(*region, PhysicalAddress(0));
- u16 ebda_seg = (u16) * ((uint16_t*)((region->vaddr().get() & PAGE_MASK) + 0x40e));
- kprintf("ACPI: Probing EBDA, Segment 0x%x\n", ebda_seg);
- // FIXME: Ensure that we always have identity mapping (identity paging) here! Don't rely on existing mapping...
- for (char* rsdp_str = (char*)(PhysicalAddress(ebda_seg << 4).as_ptr()); rsdp_str < (char*)((ebda_seg << 4) + 1024); rsdp_str += 16) {
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Looking for RSDP in EBDA @ Px%x\n", rsdp_str);
- #endif
- if (!strncmp("RSD PTR ", rsdp_str, strlen("RSD PTR ")))
- return (ACPI_RAW::RSDPDescriptor20*)rsdp_str;
- }
- // FIXME: Ensure that we always have identity mapping (identity paging) here! Don't rely on existing mapping...
- for (char* rsdp_str = (char*)(PhysicalAddress(0xE0000).as_ptr()); rsdp_str < (char*)0xFFFFF; rsdp_str += 16) {
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Looking for RSDP in EBDA @ Px%x\n", rsdp_str);
- #endif
- if (!strncmp("RSD PTR ", rsdp_str, strlen("RSD PTR ")))
- return (ACPI_RAW::RSDPDescriptor20*)rsdp_str;
- }
- return nullptr;
- }
- void ACPIStaticParser::mmap(VirtualAddress vaddr, PhysicalAddress paddr, u32 length)
- {
- unsigned i = 0;
- while (length >= PAGE_SIZE) {
- MM.map_for_kernel(VirtualAddress(vaddr.offset(i * PAGE_SIZE).get()), PhysicalAddress(paddr.offset(i * PAGE_SIZE).get()));
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: map - V 0x%x -> P 0x%x\n", vaddr.offset(i * PAGE_SIZE).get(), paddr.offset(i * PAGE_SIZE).get());
- #endif
- length -= PAGE_SIZE;
- i++;
- }
- if (length > 0) {
- MM.map_for_kernel(vaddr.offset(i * PAGE_SIZE), paddr.offset(i * PAGE_SIZE), true);
- }
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Finished mapping\n");
- #endif
- }
- void ACPIStaticParser::mmap_region(Region& region, PhysicalAddress paddr)
- {
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Mapping region, size - %u\n", region.size());
- #endif
- mmap(region.vaddr(), paddr, region.size());
- }
- ACPIStaticParser::ACPIStaticParser(ACPI_RAW::RSDPDescriptor20& rsdp)
- : ACPIParser(true)
- , m_rsdp(&rsdp)
- , m_main_sdt(nullptr)
- , m_fadt(nullptr)
- {
- kprintf("ACPI: Using RSDP @ Px%x\n", &rsdp);
- m_operable = true;
- locate_static_data();
- }
- ACPI::MainSystemDescriptionTable::MainSystemDescriptionTable(Vector<ACPI_RAW::SDTHeader*>&& sdt_pointers)
- {
- for (auto* sdt_ptr : sdt_pointers) {
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Register new table in Main SDT, @ P 0x%x\n", sdt_ptr);
- #endif
- m_sdt_pointers.append(sdt_ptr);
- }
- }
- Vector<ACPI_RAW::SDTHeader*>& ACPI::MainSystemDescriptionTable::get_sdt_pointers()
- {
- return m_sdt_pointers;
- }
- ACPI::FixedACPIData::FixedACPIData(ACPI_RAW::FADT& fadt)
- {
- m_dsdt_ptr = fadt.dsdt_ptr;
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: DSDT pointer @ P 0x%x\n", m_dsdt_ptr);
- #endif
- m_revision = fadt.h.revision;
- m_x_dsdt_ptr = fadt.x_dsdt;
- m_preferred_pm_profile = fadt.preferred_pm_profile;
- m_sci_int = fadt.sci_int;
- m_smi_cmd = fadt.smi_cmd;
- m_acpi_enable_value = fadt.acpi_enable_value;
- m_acpi_disable_value = fadt.acpi_disable_value;
- m_s4bios_req = fadt.s4bios_req;
- m_pstate_cnt = fadt.pstate_cnt;
- m_PM1a_EVT_BLK = fadt.PM1a_EVT_BLK;
- m_PM1b_EVT_BLK = fadt.PM1b_EVT_BLK;
- m_PM1a_CNT_BLK = fadt.PM1a_CNT_BLK;
- m_PM1b_CNT_BLK = fadt.PM1b_CNT_BLK;
- m_PM2_CNT_BLK = fadt.PM2_CNT_BLK;
- m_PM_TMR_BLK = fadt.PM_TMR_BLK;
- m_GPE0_BLK = fadt.GPE0_BLK;
- m_GPE1_BLK = fadt.GPE1_BLK;
- m_PM1_EVT_LEN = fadt.PM1_EVT_LEN;
- m_PM1_CNT_LEN = fadt.PM1_CNT_LEN;
- m_PM2_CNT_LEN = fadt.PM2_CNT_LEN;
- m_PM_TMR_LEN = fadt.PM_TMR_LEN;
- m_GPE0_BLK_LEN = fadt.GPE0_BLK_LEN;
- m_GPE1_BLK_LEN = fadt.GPE1_BLK_LEN;
- m_GPE1_BASE = fadt.GPE1_BASE;
- m_cst_cnt = fadt.cst_cnt;
- m_P_LVL2_LAT = fadt.P_LVL2_LAT;
- m_P_LVL3_LAT = fadt.P_LVL3_LAT;
- m_flush_size = fadt.flush_size;
- m_flush_stride = fadt.flush_stride;
- m_duty_offset = fadt.duty_offset;
- m_duty_width = fadt.duty_width;
- m_day_alrm = fadt.day_alrm;
- m_mon_alrm = fadt.mon_alrm;
- m_century = fadt.century;
- m_ia_pc_boot_arch_flags = fadt.ia_pc_boot_arch_flags;
- m_flags = fadt.flags;
- m_reset_reg = fadt.reset_reg;
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Reset Register @ IO 0x%x\n", m_reset_reg.address);
- dbgprintf("ACPI: Reset Register Address space %x\n", fadt.reset_reg.address_space);
- #endif
- m_reset_value = fadt.reset_value;
- #ifdef ACPI_DEBUG
- dbgprintf("ACPI: Reset Register value @ P 0x%x\n", m_reset_value);
- #endif
- m_x_pm1a_evt_blk = fadt.x_pm1a_evt_blk;
- m_x_pm1b_evt_blk = fadt.x_pm1b_evt_blk;
- m_x_pm1a_cnt_blk = fadt.x_pm1a_cnt_blk;
- m_x_pm1b_cnt_blk = fadt.x_pm1b_cnt_blk;
- m_x_pm2_cnt_blk = fadt.x_pm2_cnt_blk;
- m_x_pm_tmr_blk = fadt.x_pm_tmr_blk;
- m_x_gpe0_blk = fadt.x_gpe0_blk;
- m_x_gpe1_blk = fadt.x_gpe1_blk;
- m_sleep_control = fadt.sleep_control;
- m_sleep_status = fadt.sleep_status;
- m_hypervisor_vendor_identity = fadt.hypervisor_vendor_identity;
- }
- ACPI_RAW::SDTHeader* ACPI::FixedACPIData::get_dsdt()
- {
- if (m_x_dsdt_ptr != (u32) nullptr)
- return (ACPI_RAW::SDTHeader*)m_x_dsdt_ptr;
- else {
- ASSERT((ACPI_RAW::SDTHeader*)m_dsdt_ptr != nullptr);
- return (ACPI_RAW::SDTHeader*)m_dsdt_ptr;
- }
- }
|