[35] | 1 | /* |
---|
| 2 | * hal_acpi.c - ACPI parser |
---|
| 3 | * |
---|
| 4 | * Copyright (c) 2017 Maxime Villard |
---|
| 5 | * |
---|
| 6 | * This file is part of ALMOS-MKH. |
---|
| 7 | * |
---|
| 8 | * ALMOS-MKH is free software; you can redistribute it and/or modify it |
---|
| 9 | * under the terms of the GNU General Public License as published by |
---|
| 10 | * the Free Software Foundation; version 2.0 of the License. |
---|
| 11 | * |
---|
| 12 | * ALMOS-MKH is distributed in the hope that it will be useful, but |
---|
| 13 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
---|
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
---|
| 15 | * General Public License for more details. |
---|
| 16 | * |
---|
| 17 | * You should have received a copy of the GNU General Public License |
---|
[234] | 18 | * along with ALMOS-MKH; if not, write to the Free Software Foundation, |
---|
[35] | 19 | * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
---|
| 20 | */ |
---|
| 21 | |
---|
| 22 | #include <hal_types.h> |
---|
| 23 | #include <hal_boot.h> |
---|
| 24 | #include <hal_acpi.h> |
---|
| 25 | #include <hal_internal.h> |
---|
| 26 | |
---|
| 27 | #include <memcpy.h> |
---|
| 28 | #include <thread.h> |
---|
| 29 | #include <string.h> |
---|
| 30 | #include <process.h> |
---|
| 31 | #include <printk.h> |
---|
| 32 | #include <vmm.h> |
---|
| 33 | #include <core.h> |
---|
| 34 | #include <cluster.h> |
---|
| 35 | |
---|
[39] | 36 | /* -------------------------------------------------------------------------- */ |
---|
| 37 | |
---|
| 38 | #define RSDT_NENTRIES(rsdt) \ |
---|
| 39 | ( (rsdt->Header.Length - sizeof(rsdt_t) + sizeof(uint32_t)) / sizeof(uint32_t) ) |
---|
| 40 | #define RSDT_ENTRIES(rsdt) \ |
---|
| 41 | ((uint32_t *)&rsdt->TableOffsetEntry[0]) |
---|
| 42 | |
---|
| 43 | static bool_t hal_acpi_table_correct(header_t *header) |
---|
| 44 | { |
---|
| 45 | uint8_t *ptr, sum = 0; |
---|
| 46 | size_t i, n; |
---|
| 47 | |
---|
| 48 | ptr = (uint8_t *)header; |
---|
| 49 | n = header->Length; |
---|
| 50 | |
---|
| 51 | /* Verify checksum */ |
---|
| 52 | for (i = 0; i < n; i++) { |
---|
| 53 | sum += ptr[i]; |
---|
| 54 | } |
---|
| 55 | |
---|
| 56 | return (sum == 0); |
---|
| 57 | } |
---|
| 58 | |
---|
| 59 | static vaddr_t hal_acpi_map_table(paddr_t headerpa, const char *sig) |
---|
| 60 | { |
---|
| 61 | paddr_t basepa, pa; |
---|
| 62 | vaddr_t baseva, retva, va; |
---|
[43] | 63 | size_t off, size; |
---|
[39] | 64 | size_t npages, ngrow, n; |
---|
| 65 | header_t *header; |
---|
| 66 | |
---|
| 67 | /* Allocate the VA for the header */ |
---|
| 68 | basepa = rounddown(headerpa, PAGE_SIZE); |
---|
| 69 | npages = roundup(headerpa + sizeof(header_t), PAGE_SIZE) - basepa; |
---|
| 70 | baseva = hal_gpt_bootstrap_valloc(npages); |
---|
| 71 | off = headerpa - basepa; |
---|
| 72 | |
---|
| 73 | /* Enter the VA, and get the total size of the structure */ |
---|
| 74 | hal_gpt_enter_range(baseva, basepa, npages); |
---|
| 75 | retva = (vaddr_t)(baseva + off); |
---|
| 76 | header = (header_t *)retva; |
---|
| 77 | size = header->Length; |
---|
| 78 | XASSERT(size >= sizeof(header_t)); |
---|
| 79 | |
---|
| 80 | /* Check the signature */ |
---|
| 81 | if (memcmp((void *)&header->Signature, sig, ACPI_NAME_SIZE)) |
---|
| 82 | return 0; |
---|
| 83 | |
---|
| 84 | /* Grow the VA to map the rest */ |
---|
| 85 | ngrow = roundup(headerpa + size, PAGE_SIZE) - basepa; |
---|
| 86 | n = ngrow - npages; |
---|
| 87 | va = hal_gpt_bootstrap_valloc(n); |
---|
| 88 | pa = basepa + npages * PAGE_SIZE; |
---|
| 89 | hal_gpt_enter_range(va, pa, n); |
---|
| 90 | |
---|
| 91 | /* Verify the checksum */ |
---|
| 92 | if (!hal_acpi_table_correct(header)) |
---|
| 93 | x86_panic("Wrong checksum for table"); |
---|
| 94 | |
---|
| 95 | return retva; |
---|
| 96 | } |
---|
| 97 | |
---|
| 98 | /* -------------------------------------------------------------------------- */ |
---|
| 99 | |
---|
[89] | 100 | static void hal_acpi_parse_ioapic(madt_ioapic_t *ioapic) |
---|
| 101 | { |
---|
| 102 | extern paddr_t ioapic_pa; |
---|
[187] | 103 | uint32_t irqbase; |
---|
[89] | 104 | ioapic_pa = ioapic->Address; |
---|
[187] | 105 | irqbase = ioapic->GlobalIrqBase; |
---|
| 106 | |
---|
[89] | 107 | x86_printf("-> IOAPIC address: %Z\n", ioapic_pa); |
---|
[187] | 108 | x86_printf("-> IOAPIC irqbase: %z\n", (uint64_t)irqbase); |
---|
[89] | 109 | } |
---|
| 110 | |
---|
[39] | 111 | static void hal_acpi_parse_madt(madt_t *madt) |
---|
| 112 | { |
---|
[235] | 113 | madt_lapic_t *lapic; |
---|
[163] | 114 | madt_lapic_override_t *override; |
---|
[89] | 115 | void *ptr, *end; |
---|
| 116 | subheader_t *sub; |
---|
[187] | 117 | size_t nioapic = 0; |
---|
[240] | 118 | extern size_t ncpu; |
---|
[89] | 119 | |
---|
[45] | 120 | extern paddr_t lapic_pa; |
---|
| 121 | lapic_pa = (paddr_t)madt->Address; |
---|
[89] | 122 | |
---|
| 123 | ptr = (void *)(madt + 1); |
---|
| 124 | end = (void *)madt + madt->Header.Length; |
---|
| 125 | |
---|
| 126 | while (ptr < end) { |
---|
| 127 | sub = (subheader_t *)ptr; |
---|
| 128 | if (sub->Type == ACPI_MADT_TYPE_IO_APIC) { |
---|
| 129 | hal_acpi_parse_ioapic((madt_ioapic_t *)sub); |
---|
[187] | 130 | nioapic++; |
---|
[163] | 131 | } else if (sub->Type == ACPI_MADT_TYPE_LOCAL_APIC_OVERRIDE) { |
---|
| 132 | override = (madt_lapic_override_t *)sub; |
---|
| 133 | lapic_pa = (paddr_t)override->Address; |
---|
| 134 | x86_printf("-> found LAPIC override\n"); |
---|
| 135 | } else if (sub->Type == ACPI_MADT_TYPE_LOCAL_APIC) { |
---|
[235] | 136 | lapic = (madt_lapic_t *)sub; |
---|
[241] | 137 | if (lapic->LapicFlags & ACPI_MADT_LAPIC_ENABLED) { |
---|
| 138 | cpu_activate(lapic->Id); |
---|
| 139 | x86_printf("-> found LAPIC %z\n", (uint64_t)lapic->Id); |
---|
| 140 | ncpu++; |
---|
| 141 | } |
---|
[89] | 142 | } |
---|
[163] | 143 | |
---|
[89] | 144 | ptr += sub->Length; |
---|
| 145 | } |
---|
| 146 | |
---|
[39] | 147 | x86_printf("-> LAPIC address: %Z\n", lapic_pa); |
---|
[163] | 148 | x86_printf("-> number of CPUs: %z\n", ncpu); |
---|
[187] | 149 | x86_printf("-> number of IOAPICs: %z\n", nioapic); |
---|
[39] | 150 | } |
---|
| 151 | |
---|
| 152 | static madt_t *hal_acpi_map_madt(rsdt_t *rsdt) |
---|
| 153 | { |
---|
| 154 | vaddr_t va; |
---|
[43] | 155 | paddr_t pa; |
---|
[39] | 156 | uint32_t *ent; |
---|
| 157 | size_t i, n; |
---|
| 158 | |
---|
| 159 | n = RSDT_NENTRIES(rsdt); |
---|
| 160 | ent = RSDT_ENTRIES(rsdt); |
---|
| 161 | |
---|
| 162 | for (i = 0; i < n; i++) { |
---|
| 163 | pa = (paddr_t)ent[i]; |
---|
| 164 | va = hal_acpi_map_table(pa, "APIC"); |
---|
| 165 | if (va == 0) |
---|
| 166 | continue; |
---|
| 167 | return (madt_t *)va; |
---|
| 168 | } |
---|
| 169 | |
---|
| 170 | return NULL; |
---|
| 171 | } |
---|
| 172 | |
---|
| 173 | /* -------------------------------------------------------------------------- */ |
---|
| 174 | |
---|
| 175 | static rsdt_t *hal_acpi_map_rsdt(rsdp_t *rsdp) |
---|
| 176 | { |
---|
| 177 | paddr_t rsdt_pa; |
---|
| 178 | rsdt_t *rsdt; |
---|
| 179 | |
---|
| 180 | rsdt_pa = (paddr_t)rsdp->RsdtPhysicalAddress; |
---|
| 181 | rsdt = (rsdt_t *)hal_acpi_map_table(rsdt_pa, "RSDT"); |
---|
| 182 | if (rsdt == 0) |
---|
| 183 | x86_panic("RSDT invalid"); |
---|
| 184 | |
---|
| 185 | return rsdt; |
---|
| 186 | } |
---|
| 187 | |
---|
| 188 | /* -------------------------------------------------------------------------- */ |
---|
| 189 | |
---|
[35] | 190 | static bool_t hal_acpi_rsdp_correct(uint8_t *ptr) |
---|
| 191 | { |
---|
| 192 | uint8_t sum = 0; |
---|
| 193 | size_t i; |
---|
| 194 | |
---|
| 195 | /* Verify checksum */ |
---|
| 196 | for (i = 0; i < 20; i++) { |
---|
| 197 | sum += ptr[i]; |
---|
| 198 | } |
---|
| 199 | |
---|
| 200 | return (sum == 0); |
---|
| 201 | } |
---|
| 202 | |
---|
[39] | 203 | static rsdp_t *hal_acpi_find_rsdp(vaddr_t va_start, vaddr_t va_end) |
---|
[35] | 204 | { |
---|
| 205 | rsdp_t *rsdp; |
---|
| 206 | vaddr_t va = va_start; |
---|
| 207 | size_t i, n = PAGE_SIZE / ACPI_RSDP_ALIGN; |
---|
| 208 | char oem[ACPI_OEM_ID_SIZE + 1]; |
---|
| 209 | uint8_t *ptr; |
---|
| 210 | |
---|
| 211 | /* The table is on a 16bit boundary */ |
---|
| 212 | for (va = va_start; va < va_end; va += PAGE_SIZE) { |
---|
| 213 | for (i = 0; i < n; i++) { |
---|
| 214 | ptr = (uint8_t *)va + i * ACPI_RSDP_ALIGN; |
---|
| 215 | if (memcmp(ptr, ACPI_RSDP_SIGNATURE, ACPI_RSDP_SIGNATURE_SIZE)) |
---|
| 216 | continue; |
---|
| 217 | if (!hal_acpi_rsdp_correct(ptr)) |
---|
| 218 | continue; |
---|
| 219 | goto found; |
---|
| 220 | } |
---|
| 221 | } |
---|
| 222 | |
---|
| 223 | return NULL; |
---|
| 224 | |
---|
| 225 | found: |
---|
| 226 | rsdp = (rsdp_t *)ptr; |
---|
| 227 | |
---|
| 228 | memcpy(&oem, rsdp->OemId, ACPI_OEM_ID_SIZE); |
---|
| 229 | oem[ACPI_OEM_ID_SIZE] = '\0'; |
---|
| 230 | x86_printf("-> OEM: %s\n", oem); |
---|
[39] | 231 | if (rsdp->Revision != 0) |
---|
| 232 | x86_printf("[!] Using ACPI 1.0\n"); |
---|
[35] | 233 | |
---|
| 234 | return rsdp; |
---|
| 235 | } |
---|
| 236 | |
---|
[39] | 237 | /* -------------------------------------------------------------------------- */ |
---|
| 238 | |
---|
[35] | 239 | void hal_acpi_init() |
---|
| 240 | { |
---|
| 241 | rsdp_t *rsdp; |
---|
[39] | 242 | rsdt_t *rsdt; |
---|
| 243 | madt_t *madt; |
---|
[35] | 244 | paddr_t bios_min = 0x0E0000; |
---|
| 245 | paddr_t bios_max = 0x100000; |
---|
| 246 | vaddr_t vabase; |
---|
[43] | 247 | size_t npages; |
---|
[35] | 248 | |
---|
| 249 | npages = (bios_max - bios_min) / PAGE_SIZE; |
---|
| 250 | vabase = hal_gpt_bootstrap_valloc(npages); |
---|
| 251 | |
---|
[43] | 252 | hal_gpt_enter_range(vabase, bios_min, npages); |
---|
[35] | 253 | |
---|
| 254 | /* First, find RSDP */ |
---|
| 255 | rsdp = hal_acpi_find_rsdp(vabase, vabase + npages * PAGE_SIZE); |
---|
[39] | 256 | if (rsdp == NULL) |
---|
| 257 | x86_panic("RSDP not found"); |
---|
| 258 | |
---|
| 259 | /* Then, map RSDT */ |
---|
| 260 | rsdt = hal_acpi_map_rsdt(rsdp); |
---|
| 261 | if (rsdt == NULL) |
---|
| 262 | x86_panic("RSDT not found"); |
---|
| 263 | |
---|
| 264 | /* Now, map MADT */ |
---|
| 265 | madt = hal_acpi_map_madt(rsdt); |
---|
| 266 | if (madt == NULL) |
---|
| 267 | x86_panic("MADT not found"); |
---|
| 268 | |
---|
| 269 | /* Parse it */ |
---|
| 270 | hal_acpi_parse_madt(madt); |
---|
[35] | 271 | } |
---|
| 272 | |
---|