cherry pick device tree modifications from isa/arm64

[lunaix-os.git] / lunaix-os / hal / acpi / acpi.c

diff --git a/lunaix-os/hal/acpi/acpi.c b/lunaix-os/hal/acpi/acpi.c
index c6a566e47b713849f320920f74eeecd696bc0fdf..bc90ba149e335940f5ae6a9ed81a2e3e33c9446f 100644 (file)
--- a/lunaix-os/hal/acpi/acpi.c
+++ b/lunaix-os/hal/acpi/acpi.c
@@ -1,5 +1,6 @@
 #include <hal/acpi/acpi.h>
 
+#include <lunaix/device.h>
 #include <lunaix/mm/valloc.h>
 #include <lunaix/spike.h>
 #include <lunaix/syslog.h>
@@ -15,13 +16,61 @@ LOG_MODULE("ACPI")
 int
 acpi_rsdp_validate(acpi_rsdp_t* rsdp);
 
-acpi_rsdp_t*
-acpi_locate_rsdp(multiboot_info_t* mb_info);
+acpi_context*
+acpi_get_context()
+{
+    assert_msg(ctx, "ACPI is not initialized");
+    return ctx;
+}
 
 int
-acpi_init(multiboot_info_t* mb_info)
+acpi_rsdp_validate(acpi_rsdp_t* rsdp)
+{
+    u8_t sum = 0;
+    u8_t* rsdp_ptr = (u8_t*)rsdp;
+    for (size_t i = 0; i < 20; i++) {
+        sum += *(rsdp_ptr + i);
+    }
+
+    return sum == 0;
+}
+
+u8_t
+acpi_gsimap(u8_t old_irq)
+{
+    if (old_irq >= 24) {
+        return old_irq;
+    }
+    acpi_intso_t* int_override = ctx->madt.irq_exception[old_irq];
+    return int_override ? (u8_t)int_override->gsi : old_irq;
+}
+
+#define VIRTUAL_BOX_PROBLEM
+
+acpi_rsdp_t*
+acpi_locate_rsdp()
+{
+    acpi_rsdp_t* rsdp = NULL;
+
+    ptr_t mem_start = 0x4000;
+    for (; mem_start < 0x100000; mem_start += 16) {
+        u32_t sig_low = *((u32_t*)mem_start);
+        // XXX: do we need to compare this as well?
+        // u32_t sig_high = *((u32_t*)(mem_start+j) + 1);
+
+        if (sig_low == ACPI_RSDP_SIG_L) {
+            rsdp = (acpi_rsdp_t*)mem_start;
+            break;
+        }
+    }
+
+    return rsdp;
+}
+
+static int
+acpi_init(struct device_def* devdef)
 {
-    acpi_rsdp_t* rsdp = acpi_locate_rsdp(mb_info);
+    acpi_rsdp_t* rsdp = acpi_locate_rsdp();
 
     assert_msg(rsdp, "Fail to locate ACPI_RSDP");
     assert_msg(acpi_rsdp_validate(rsdp), "Invalid ACPI_RSDP (checksum failed)");
@@ -36,15 +85,14 @@ acpi_init(multiboot_info_t* mb_info)
 
     size_t entry_n = (rsdt->header.length - sizeof(acpi_sdthdr_t)) >> 2;
     for (size_t i = 0; i < entry_n; i++) {
-        acpi_sdthdr_t* sdthdr =
-          (acpi_sdthdr_t*)((acpi_apic_t**)&(rsdt->entry))[i];
+        acpi_sdthdr_t* sdthdr = __acpi_sdthdr(rsdt->entry[i]);
         switch (sdthdr->signature) {
             case ACPI_MADT_SIG:
-                madt_parse((acpi_madt_t*)sdthdr, ctx);
+                madt_parse(__acpi_madt(sdthdr), ctx);
                 break;
             case ACPI_FADT_SIG:
                 // FADT just a plain structure, no need to parse.
-                ctx->fadt = *(acpi_fadt_t*)sdthdr;
+                ctx->fadt = *__acpi_fadt(sdthdr);
                 break;
             case ACPI_MCFG_SIG:
                 mcfg_parse(sdthdr, ctx);
@@ -54,73 +102,11 @@ acpi_init(multiboot_info_t* mb_info)
         }
     }
 
-    kprintf(KINFO "ACPI: %s\n", ctx->oem_id);
+    return 0;
 }
 
-acpi_context*
-acpi_get_context()
-{
-    assert_msg(ctx, "ACPI is not initialized");
-    return ctx;
-}
-
-int
-acpi_rsdp_validate(acpi_rsdp_t* rsdp)
-{
-    uint8_t sum = 0;
-    uint8_t* rsdp_ptr = (uint8_t*)rsdp;
-    for (size_t i = 0; i < 20; i++) {
-        sum += *(rsdp_ptr + i);
-    }
-
-    return sum == 0;
-}
-
-#define VIRTUAL_BOX_PROBLEM
-
-acpi_rsdp_t*
-acpi_locate_rsdp(multiboot_info_t* mb_info)
-{
-    acpi_rsdp_t* rsdp = NULL;
-
-    // You can't trust memory map from multiboot in virtual box!
-    // They put ACPI RSDP in the FUCKING 0xe0000 !!!
-    // Which is reported to be free area bt multiboot!
-    // SWEET CELESTIA!!!
-#ifndef VIRTUAL_BOX_PROBLEM
-    multiboot_memory_map_t* mmap = (multiboot_memory_map_t*)mb_info->mmap_addr;
-    for (size_t i = 0, j = 0; j < mb_info->mmap_length && !rsdp;
-         i++, j += MB_MMAP_ENTRY_SIZE) {
-        multiboot_memory_map_t entry = mmap[i];
-        if (entry.type != MULTIBOOT_MEMORY_RESERVED ||
-            entry.addr_low > 0x100000) {
-            continue;
-        }
-
-        uint8_t* mem_start = entry.addr_low & ~0xf;
-        size_t len = entry.len_low;
-        for (size_t j = 0; j < len; j += 16) {
-            uint32_t sig_low = *((uint32_t*)(mem_start + j));
-            // uint32_t sig_high = *((uint32_t*)(mem_start+j) + 1);
-            if (sig_low == ACPI_RSDP_SIG_L) {
-                rsdp = (acpi_rsdp_t*)(mem_start + j);
-                break;
-            }
-        }
-    }
-#else
-    // You know what, I just search the entire 1MiB for Celestia's sake.
-    uint8_t* mem_start = 0x4000;
-    for (; mem_start < 0x100000; mem_start += 16) {
-        uint32_t sig_low = *((uint32_t*)(mem_start));
-        // XXX: do we need to compare this as well?
-        // uint32_t sig_high = *((uint32_t*)(mem_start+j) + 1);
-        if (sig_low == ACPI_RSDP_SIG_L) {
-            rsdp = (acpi_rsdp_t*)(mem_start);
-            break;
-        }
-    }
-#endif
-
-    return rsdp;
-}
\ No newline at end of file
+struct device_def acpi_sysdev = { .name = "ACPI Proxy",
+                                  .class =
+                                    DEVCLASS(DEVIF_FMW, DEVFN_CFG, DEV_ACPI),
+                                  .init = acpi_init };
+EXPORT_DEVICE(acpi, &acpi_sysdev, load_sysconf);
\ No newline at end of file