lunaix-os/hal/acpi/acpi.c

   1 #include <hal/acpi/acpi.h>
   2
   3 #include <lunaix/mm/valloc.h>
   4 #include <lunaix/spike.h>
   5 #include <lunaix/syslog.h>
   6
   7 #include <klibc/string.h>
   8
   9 #include "parser/parser.h"
  10
  11 static acpi_context* ctx = NULL;
  12
  13 LOG_MODULE("ACPI")
  14
  15 int
  16 acpi_rsdp_validate(acpi_rsdp_t* rsdp);
  17
  18 acpi_rsdp_t*
  19 acpi_locate_rsdp(multiboot_info_t* mb_info);
  20
  21 int
  22 acpi_init(multiboot_info_t* mb_info)
  23 {
  24     acpi_rsdp_t* rsdp = acpi_locate_rsdp(mb_info);
  25
  26     assert_msg(rsdp, "Fail to locate ACPI_RSDP");
  27     assert_msg(acpi_rsdp_validate(rsdp), "Invalid ACPI_RSDP (checksum failed)");
  28
  29     acpi_rsdt_t* rsdt = rsdp->rsdt;
  30
  31     ctx = vzalloc(sizeof(acpi_context));
  32     assert_msg(ctx, "Fail to create ACPI context");
  33
  34     strncpy(ctx->oem_id, rsdt->header.oem_id, 6);
  35     ctx->oem_id[6] = '\0';
  36
  37     size_t entry_n = (rsdt->header.length - sizeof(acpi_sdthdr_t)) >> 2;
  38     for (size_t i = 0; i < entry_n; i++) {
  39         acpi_sdthdr_t* sdthdr =
  40           (acpi_sdthdr_t*)((acpi_apic_t**)&(rsdt->entry))[i];
  41         switch (sdthdr->signature) {
  42             case ACPI_MADT_SIG:
  43                 kprintf(KINFO "MADT: %p\n", sdthdr);
  44                 madt_parse((acpi_madt_t*)sdthdr, ctx);
  45                 break;
  46             case ACPI_FADT_SIG:
  47                 // FADT just a plain structure, no need to parse.
  48                 kprintf(KINFO "FADT: %p\n", sdthdr);
  49                 ctx->fadt = *(acpi_fadt_t*)sdthdr;
  50                 break;
  51             case ACPI_MCFG_SIG:
  52                 kprintf(KINFO "MCFG: %p\n", sdthdr);
  53                 mcfg_parse(sdthdr, ctx);
  54                 break;
  55             default:
  56                 break;
  57         }
  58     }
  59
  60     kprintf(KINFO "ACPI: %s\n", ctx->oem_id);
  61
  62     return 0;
  63 }
  64
  65 acpi_context*
  66 acpi_get_context()
  67 {
  68     assert_msg(ctx, "ACPI is not initialized");
  69     return ctx;
  70 }
  71
  72 int
  73 acpi_rsdp_validate(acpi_rsdp_t* rsdp)
  74 {
  75     u8_t sum = 0;
  76     u8_t* rsdp_ptr = (u8_t*)rsdp;
  77     for (size_t i = 0; i < 20; i++) {
  78         sum += *(rsdp_ptr + i);
  79     }
  80
  81     return sum == 0;
  82 }
  83
  84 u8_t
  85 acpi_gistranslate(u8_t old_irq)
  86 {
  87     if (old_irq >= 24) {
  88         return old_irq;
  89     }
  90     acpi_intso_t* int_override = ctx->madt.irq_exception[old_irq];
  91     return int_override ? (u8_t)int_override->gsi : old_irq;
  92 }
  93
  94 #define VIRTUAL_BOX_PROBLEM
  95
  96 acpi_rsdp_t*
  97 acpi_locate_rsdp(multiboot_info_t* mb_info)
  98 {
  99     acpi_rsdp_t* rsdp = NULL;
 100
 101     // You can't trust memory map from multiboot in virtual box!
 102     // They put ACPI RSDP in the FUCKING 0xe0000 !!!
 103     // Which is reported to be free area bt multiboot!
 104     // SWEET CELESTIA!!!
 105 #ifndef VIRTUAL_BOX_PROBLEM
 106     multiboot_memory_map_t* mmap = (multiboot_memory_map_t*)mb_info->mmap_addr;
 107     for (size_t i = 0, j = 0; j < mb_info->mmap_length && !rsdp;
 108          i++, j += MB_MMAP_ENTRY_SIZE) {
 109         multiboot_memory_map_t entry = mmap[i];
 110         if (entry.type != MULTIBOOT_MEMORY_RESERVED ||
 111             entry.addr_low > 0x100000) {
 112             continue;
 113         }
 114
 115         u8_t* mem_start = entry.addr_low & ~0xf;
 116         size_t len = entry.len_low;
 117         for (size_t j = 0; j < len; j += 16) {
 118             u32_t sig_low = *((u32_t*)(mem_start + j));
 119             // u32_t sig_high = *((u32_t*)(mem_start+j) + 1);
 120             if (sig_low == ACPI_RSDP_SIG_L) {
 121                 rsdp = (acpi_rsdp_t*)(mem_start + j);
 122                 break;
 123             }
 124         }
 125     }
 126 #else
 127     // You know what, I just search the entire 1MiB for Celestia's sake.
 128     ptr_t mem_start = 0x4000;
 129     for (; mem_start < 0x100000; mem_start += 16) {
 130         u32_t sig_low = *((u32_t*)mem_start);
 131         // XXX: do we need to compare this as well?
 132         // u32_t sig_high = *((u32_t*)(mem_start+j) + 1);
 133
 134         if (sig_low == ACPI_RSDP_SIG_L) {
 135             rsdp = (acpi_rsdp_t*)mem_start;
 136             break;
 137         }
 138     }
 139 #endif
 140
 141     return rsdp;
 142 }