检测处理器核心数量

kernel/driver/acpi/acpi.c

@@ -22,6 +22,8 @@ static uint acpi_XSDT_Entry_num = 0;
 
 static ul acpi_RSDT_entry_phys_base = 0; // RSDT中的第一个entry所在物理页的基地址
 
+static uint64_t acpi_madt_vaddr = 0;    // MADT的虚拟地址
+
 // static ul acpi_XSDT_entry_phys_base = 0; // XSDT中的第一个entry所在物理页的基地址
 
 /**
@@ -53,7 +55,6 @@ void acpi_iter_SDT(bool (*_fun)(const struct acpi_system_description_table_heade
         {
 
             sdt_header = (struct acpi_system_description_table_header_t *)(acpi_get_RSDT_entry_vaddr((ul)(*(ent + i))));
-          
 
             if (_fun(sdt_header, _data) == true)
                 return;
@@ -79,10 +80,11 @@ bool acpi_get_MADT(const struct acpi_system_description_table_header_t *_iter_da
     //*(struct acpi_Multiple_APIC_Description_Table_t *)_data = *(struct acpi_Multiple_APIC_Description_Table_t *)_iter_data;
     // 返回MADT的虚拟地址
     *(ul *)_data = (ul)_iter_data;
-
+    acpi_madt_vaddr = _iter_data;
     return true;
 }
 
+
 /**
  * @brief 初始化acpi模块
  *
@@ -138,7 +140,7 @@ void acpi_init()
             mm_map_phys_addr(ACPI_XSDT_DESCRIPTION_HEDERS_BASE + PAGE_2M_SIZE * j, (*(ent + j)) & PAGE_2M_MASK, PAGE_2M_SIZE, PAGE_KERNEL_PAGE | PAGE_PWT | PAGE_PCD);
         }
         */
-       // 由于解析XSDT出现问题。暂时只使用Rsdpv2的rsdt，但是这是不符合ACPI规范的！！！
+        // 由于解析XSDT出现问题。暂时只使用Rsdpv2的rsdt，但是这是不符合ACPI规范的！！！
         ul rsdt_phys_base = rsdpv2->rsdp1.RsdtAddress & PAGE_2M_MASK;
         acpi_RSDT_offset = rsdpv2->rsdp1.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);

kernel/driver/acpi/acpi.h

@@ -162,15 +162,6 @@ void acpi_iter_SDT(bool (*_fun)(const struct acpi_system_description_table_heade
 bool acpi_get_MADT(const struct acpi_system_description_table_header_t *_iter_data, void *_data);
 
 
-/**
- * @brief 迭代器，用于迭代中断控制器结构(Interrupt Controller Structure)（位于ACPI标准文件的Table 5-45）
- * @param  _fun            迭代操作调用的函数
- * @param  _data           数据
- */
-void acpi_iter_Interrupt_Controller_Structure(bool (*_fun)(const struct apic_Interrupt_Controller_Structure_header_t *, void *),
-                   void *_data);
-
-
 
 // 初始化acpi模块
 void acpi_init();

kernel/driver/interrupt/apic/apic.c

@@ -24,7 +24,6 @@ void apic_io_apic_init()
 {
 
     ul madt_addr;
-    kdebug("madt_addr = %#018lx", (ul)madt_addr);
     acpi_iter_SDT(acpi_get_MADT, &madt_addr);
     madt = (struct acpi_Multiple_APIC_Description_Table_t *)madt_addr;
 
@@ -453,4 +452,38 @@ void apic_ioapic_edge_ack(ul irq_num) // 边沿触发
                          "movq 	$0x80b,	%%rcx	\n\t"
                          "wrmsr	\n\t" ::
                              : "memory");
+}
+
+/**
+ * @brief 读取指定类型的 Interrupt Control Structure
+ *
+ * @param type ics的类型
+ * @param ret_vaddr 对应的ICS的虚拟地址数组
+ * @param total 返回数组的元素总个数
+ * @return uint
+ */
+uint apic_get_ics(const uint type, ul *ret_vaddr[], uint *total)
+{
+    void *ent = (void *)(madt) + sizeof(struct acpi_Multiple_APIC_Description_Table_t);
+    struct apic_Interrupt_Controller_Structure_header_t *header = (struct apic_Interrupt_Controller_Structure_header_t *)ent;
+    bool flag = false;
+
+    uint cnt = 0;
+
+    while (header->length > 2)
+    {
+        header = (struct apic_Interrupt_Controller_Structure_header_t *)ent;
+        if (header->type == type)
+        {
+            *(ret_vaddr[cnt++]) = (ul)ent;
+            flag = true;
+        }
+        ent += header->length;
+    }
+
+    *total = cnt;
+    if (!flag)
+        return APIC_E_NOTFOUND;
+    else
+        return APIC_SUCCESS;
 }

kernel/driver/interrupt/apic/apic.h

@@ -5,6 +5,9 @@
 #include "../../../exception/irq.h"
 #include "../../../mm/mm.h"
 
+#define APIC_SUCCESS 0
+#define APIC_E_NOTFOUND 1
+
 #define APIC_IO_APIC_VIRT_BASE_ADDR SPECIAL_MEMOEY_MAPPING_VIRT_ADDR_BASE + IO_APIC_MAPPING_OFFSET
 #define APIC_LOCAL_APIC_VIRT_BASE_ADDR SPECIAL_MEMOEY_MAPPING_VIRT_ADDR_BASE + LOCAL_APIC_MAPPING_OFFSET
 
@@ -70,6 +73,8 @@
 // 分频配置寄存器（定时器专用）
 #define LOCAL_APIC_OFFSET_Local_APIC_CLKDIV 0x3e0
 
+
+
 /*
 
 1:	LVT	CMCI
@@ -270,10 +275,20 @@ void apic_ioapic_write_rte(unsigned char index, ul value);
  */
 void apic_init();
 
+/**
+ * @brief 读取指定类型的 Interrupt Control Structure
+ * 
+ * @param type ics的类型
+ * @param ret_vaddr 对应的ICS的虚拟地址数组
+ * @param total 返回数组的元素总个数
+ * @return uint 
+ */
+uint apic_get_ics(const uint type, ul *ret_vaddr[], uint * total);
+
 // =========== 中断控制操作接口 ============
 void apic_ioapic_enable(ul irq_num);
 void apic_ioapic_disable(ul irq_num);
 ul apic_ioapic_install(ul irq_num, void *arg);
 void apic_ioapic_uninstall(ul irq_num);
 void apic_ioapic_level_ack(ul irq_num); // 电平触发
-void apic_ioapic_edge_ack(ul irq_num);  // 边沿触发
+void apic_ioapic_edge_ack(ul irq_num);  // 边沿触发