Changeset 10a2e22 in mainline for arch/ia32/src/acpi/acpi.c

Timestamp:

2005-04-30T00:37:35Z (20 years ago)

Author:

Jakub Jermar <jakub@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

ed0dd65

Parents:

babcb148

Message:

ACPI update (RSDT/XSDT configuration).
Cosmetic changes.

File:

• arch/ia32/src/acpi/acpi.c (modified) (4 diffs)

arch/ia32/src/acpi/acpi.c

@@ -28 +28 @@
 
 #include <arch/acpi/acpi.h>
+#include <arch/acpi/madt.h>
 #include <arch/bios/bios.h>
+
+#include <mm/page.h>
 
 #define RSDP_SIGNATURE          "RSD PTR "
@@ -34 +37 @@
 
 struct acpi_rsdp *acpi_rsdp = NULL;
+struct acpi_rsdt *acpi_rsdt = NULL;
+struct acpi_xsdt *acpi_xsdt = NULL;
+
+struct acpi_signature_map signature_map[] = { 
+        { "APIC", (struct acpi_sdt_header **) &acpi_madt, "Multiple APIC Description Table" }
+};
 
 int rsdp_check(__u8 *rsdp) {
@@ -54 +63 @@
         return !sum;
         
+}
+
+int acpi_sdt_check(__u8 *sdt)
+{
+        struct acpi_sdt_header *h = (struct acpi_sdt_header *) sdt;
+        __u8 sum = 0;
+        int i;
+
+        for (i=0; i<h->length; i++)
+                sum += sdt[i];
+                
+        return !sum;
+}
+
+void map_sdt(struct acpi_sdt_header *sdt)
+{
+        map_page_to_frame((__address) sdt, (__address) sdt, PAGE_NOT_CACHEABLE, 0);
 }
 
@@ -81 +107 @@
 
 rsdp_found:
-        printf("%L: ACPI Root System Description Pointer\n", acpi_rsdp);                
+        printf("%L: ACPI Root System Description Pointer\n", acpi_rsdp);
+        
+        acpi_rsdt = (struct acpi_rsdt *) acpi_rsdp->rsdt_address;
+        if (acpi_rsdp->revision) acpi_xsdt = (struct acpi_xsdt *) ((__address) acpi_rsdp->xsdt_address);
+
+        if (acpi_rsdt) map_sdt((struct acpi_sdt_header *) acpi_rsdt);
+        if (acpi_xsdt) map_sdt((struct acpi_sdt_header *) acpi_xsdt);   
+
+        if (acpi_rsdt && !acpi_sdt_check((__u8 *) acpi_rsdt)) {
+                printf("RSDT: %s\n", "bad checksum");
+                return;
+        }
+        if (acpi_xsdt && !acpi_sdt_check((__u8 *) acpi_xsdt)) {
+                printf("XSDT: %s\n", "bad checksum");
+                return;
+        }
+
+        if (acpi_xsdt) configure_via_xsdt();
+        else if (acpi_rsdt) configure_via_rsdt();
+
 }
+
+void configure_via_rsdt(void)
+{
+        int i, j, cnt = (acpi_rsdt->header.length - sizeof(struct acpi_sdt_header))/sizeof(__u32);
+        
+        for (i=0; i<cnt; i++) {
+                for (j=0; j<sizeof(signature_map)/sizeof(struct acpi_signature_map); j++) {
+                        struct acpi_sdt_header *h = (struct acpi_sdt_header *) acpi_rsdt->entry[i];
+                
+                        map_sdt(h);     
+                        if (*((__u32 *) &h->signature[0])==*((__u32 *) &signature_map[j].signature[0])) {
+                                if (!acpi_sdt_check((__u8 *) h))
+                                        goto next;
+                                *signature_map[j].sdt_ptr = h;
+                                printf("%L: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description);
+                        }
+                }
+next:
+                ;
+        }
+}
+
+void configure_via_xsdt(void)
+{
+        int i, j, cnt = (acpi_xsdt->header.length - sizeof(struct acpi_sdt_header))/sizeof(__u64);
+        
+        for (i=0; i<cnt; i++) {
+                for (j=0; j<sizeof(signature_map)/sizeof(struct acpi_signature_map); j++) {
+                        struct acpi_sdt_header *h = (struct acpi_sdt_header *) ((__address) acpi_rsdt->entry[i]);
+
+                        map_sdt(h);
+                        if (*((__u32 *) &h->signature[0])==*((__u32 *) &signature_map[j].signature[0])) {
+                                if (!acpi_sdt_check((__u8 *) h))
+                                        goto next;
+                                *signature_map[j].sdt_ptr = h;
+                                printf("%L: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description);
+                        }
+                }
+next:
+                ;
+        }
+
+}