mirror of
https://github.com/DragonOS-Community/DragonOS.git
synced 2025-06-09 15:26:47 +00:00
103 lines
3.6 KiB
C
103 lines
3.6 KiB
C
#include "acpi.h"
|
||
#include "../../common/printk.h"
|
||
#include "../../common/kprint.h"
|
||
#include "../multiboot2/multiboot2.h"
|
||
#include "../../mm/mm.h"
|
||
|
||
static struct acpi_RSDP_t *rsdpv1;
|
||
static struct acpi_RSDP_2_t *rsdpv2;
|
||
static struct acpi_RSDT_Structure_t *rsdt;
|
||
|
||
static struct multiboot_tag_old_acpi_t old_acpi;
|
||
static struct multiboot_tag_new_acpi_t new_acpi;
|
||
|
||
static ul acpi_RSDT_offset = 0;
|
||
static uint acpi_RSDT_Entry_num = 0;
|
||
|
||
|
||
// RSDT中的第一个entry所在物理页的基地址
|
||
static ul acpi_RSDT_entry_phys_base = 0;
|
||
|
||
/**
|
||
* @brief 迭代器，用于迭代描述符头（位于ACPI标准文件的Table 5-29）
|
||
* @param _fun 迭代操作调用的函数
|
||
* @param _data 数据
|
||
*/
|
||
void acpi_iter_SDT(bool (*_fun)(const struct acpi_iter_SDT_header_t *, void *),
|
||
void *_data)
|
||
{
|
||
}
|
||
|
||
static ul acpi_get_RSDT_entry_vaddr(ul phys_addr)
|
||
{
|
||
return ACPI_DESCRIPTION_HEDERS_BASE + MASK_HIGH_32bit(phys_addr) - acpi_RSDT_entry_phys_base;
|
||
}
|
||
/**
|
||
* @brief 初始化acpi模块
|
||
*
|
||
*/
|
||
void acpi_init()
|
||
{
|
||
kinfo("Initializing ACPI...");
|
||
|
||
// 获取rsdp
|
||
|
||
int reserved;
|
||
multiboot2_iter(multiboot2_get_acpi_old_RSDP, &old_acpi, &reserved);
|
||
|
||
*rsdpv1 = (old_acpi.rsdp);
|
||
|
||
kdebug("RSDT_phys_Address=%#018lx", rsdpv1->RsdtAddress);
|
||
kdebug("RSDP_Revision=%d", rsdpv1->Revision);
|
||
|
||
// 映射RSDT的物理地址到页表
|
||
// 暂定字节数为2MB
|
||
// 由于页表映射的原因，需要清除低21位地址，才能填入页表
|
||
ul rsdt_phys_base = rsdpv1->RsdtAddress & PAGE_2M_MASK;
|
||
acpi_RSDT_offset = rsdpv1->RsdtAddress - rsdt_phys_base;
|
||
mm_map_phys_addr(ACPI_RSDT_VIRT_ADDR_BASE, rsdt_phys_base, PAGE_2M_SIZE, PAGE_KERNEL_PAGE | PAGE_PWT | PAGE_PCD);
|
||
kdebug("RSDT mapped!");
|
||
|
||
multiboot2_iter(multiboot2_get_acpi_new_RSDP, &new_acpi, &reserved);
|
||
*rsdpv2 = new_acpi.rsdp;
|
||
kdebug("Rsdt_v2_phys_Address=%#018lx", rsdpv2->rsdp1.RsdtAddress);
|
||
kdebug("RSDP_v2_Revision=%d", rsdpv2->rsdp1.Revision);
|
||
|
||
rsdt = ACPI_RSDT_VIRT_ADDR_BASE + acpi_RSDT_offset;
|
||
|
||
// 计算RSDT Entry的数量
|
||
kdebug("offset=%d", sizeof(rsdt->header));
|
||
acpi_RSDT_Entry_num = (rsdt->header.Length - 36) / 4;
|
||
|
||
printk_color(ORANGE, BLACK, "%s\n", rsdt->header.Signature);
|
||
printk_color(ORANGE, BLACK, "RSDT Length=%dbytes.\n", rsdt->header.Length);
|
||
printk_color(ORANGE, BLACK, "RSDT Entry num=%d\n", acpi_RSDT_Entry_num);
|
||
|
||
// 映射所有的Entry的物理地址
|
||
acpi_RSDT_entry_phys_base = ((ul)(rsdt->Entry)) & PAGE_2M_MASK;
|
||
// 由于地址只是32bit的，并且存在脏数据，这里需要手动清除高32bit，否则会触发#GP
|
||
acpi_RSDT_entry_phys_base = MASK_HIGH_32bit(acpi_RSDT_entry_phys_base);
|
||
|
||
|
||
kdebug("entry=%#018lx", rsdt->Entry);
|
||
kdebug("acpi_RSDT_entry_phys_base=%#018lx", acpi_RSDT_entry_phys_base);
|
||
|
||
mm_map_phys_addr(ACPI_DESCRIPTION_HEDERS_BASE, acpi_RSDT_entry_phys_base, PAGE_2M_SIZE, PAGE_KERNEL_PAGE | PAGE_PWT | PAGE_PCD);
|
||
|
||
// 设置第一个entry的虚拟地址
|
||
struct acpi_system_description_table_header_t *sdt_header;
|
||
uint* ent = &(rsdt->Entry);
|
||
for (int i = 0; i < acpi_RSDT_Entry_num; ++i)
|
||
{
|
||
kdebug("entry_addr_phys[ %d ]= %#018lx", i, MASK_HIGH_32bit((ul)(*(ent+i))));
|
||
sdt_header = (struct acpi_system_description_table_header_t *)(acpi_get_RSDT_entry_vaddr((ul)(*(ent+i))));
|
||
if(i<7)
|
||
{
|
||
struct acpi_Multiple_APIC_Description_Table_t *madt = (struct acpi_Multiple_APIC_Description_Table_t*)sdt_header;
|
||
for(int j=0;j<4;++j)
|
||
printk_color(ORANGE, BLACK, "%c", madt->header.Signature[j]);
|
||
printk("\n");
|
||
kdebug("length=%d", madt->header.Length);
|
||
}
|
||
}
|
||
} |