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 |
---|
18 | * along with ALMOS-MKH.; if not, write to the Free Software Foundation, |
---|
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 | |
---|
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; |
---|
63 | size_t off, size; |
---|
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 | |
---|
100 | static void hal_acpi_parse_ioapic(madt_ioapic_t *ioapic) |
---|
101 | { |
---|
102 | extern paddr_t ioapic_pa; |
---|
103 | ioapic_pa = ioapic->Address; |
---|
104 | x86_printf("-> IOAPIC address: %Z\n", ioapic_pa); |
---|
105 | } |
---|
106 | |
---|
107 | static void hal_acpi_parse_madt(madt_t *madt) |
---|
108 | { |
---|
109 | void *ptr, *end; |
---|
110 | subheader_t *sub; |
---|
111 | |
---|
112 | extern paddr_t lapic_pa; |
---|
113 | lapic_pa = (paddr_t)madt->Address; |
---|
114 | |
---|
115 | ptr = (void *)(madt + 1); |
---|
116 | end = (void *)madt + madt->Header.Length; |
---|
117 | |
---|
118 | while (ptr < end) { |
---|
119 | sub = (subheader_t *)ptr; |
---|
120 | if (sub->Type == ACPI_MADT_TYPE_IO_APIC) { |
---|
121 | hal_acpi_parse_ioapic((madt_ioapic_t *)sub); |
---|
122 | } |
---|
123 | // XXX: handle lapic override |
---|
124 | ptr += sub->Length; |
---|
125 | } |
---|
126 | |
---|
127 | x86_printf("-> LAPIC address: %Z\n", lapic_pa); |
---|
128 | } |
---|
129 | |
---|
130 | static madt_t *hal_acpi_map_madt(rsdt_t *rsdt) |
---|
131 | { |
---|
132 | vaddr_t va; |
---|
133 | paddr_t pa; |
---|
134 | uint32_t *ent; |
---|
135 | size_t i, n; |
---|
136 | |
---|
137 | n = RSDT_NENTRIES(rsdt); |
---|
138 | ent = RSDT_ENTRIES(rsdt); |
---|
139 | |
---|
140 | for (i = 0; i < n; i++) { |
---|
141 | pa = (paddr_t)ent[i]; |
---|
142 | va = hal_acpi_map_table(pa, "APIC"); |
---|
143 | if (va == 0) |
---|
144 | continue; |
---|
145 | return (madt_t *)va; |
---|
146 | } |
---|
147 | |
---|
148 | return NULL; |
---|
149 | } |
---|
150 | |
---|
151 | /* -------------------------------------------------------------------------- */ |
---|
152 | |
---|
153 | static rsdt_t *hal_acpi_map_rsdt(rsdp_t *rsdp) |
---|
154 | { |
---|
155 | paddr_t rsdt_pa; |
---|
156 | rsdt_t *rsdt; |
---|
157 | |
---|
158 | rsdt_pa = (paddr_t)rsdp->RsdtPhysicalAddress; |
---|
159 | rsdt = (rsdt_t *)hal_acpi_map_table(rsdt_pa, "RSDT"); |
---|
160 | if (rsdt == 0) |
---|
161 | x86_panic("RSDT invalid"); |
---|
162 | |
---|
163 | return rsdt; |
---|
164 | } |
---|
165 | |
---|
166 | /* -------------------------------------------------------------------------- */ |
---|
167 | |
---|
168 | static bool_t hal_acpi_rsdp_correct(uint8_t *ptr) |
---|
169 | { |
---|
170 | uint8_t sum = 0; |
---|
171 | size_t i; |
---|
172 | |
---|
173 | /* Verify checksum */ |
---|
174 | for (i = 0; i < 20; i++) { |
---|
175 | sum += ptr[i]; |
---|
176 | } |
---|
177 | |
---|
178 | return (sum == 0); |
---|
179 | } |
---|
180 | |
---|
181 | static rsdp_t *hal_acpi_find_rsdp(vaddr_t va_start, vaddr_t va_end) |
---|
182 | { |
---|
183 | rsdp_t *rsdp; |
---|
184 | vaddr_t va = va_start; |
---|
185 | size_t i, n = PAGE_SIZE / ACPI_RSDP_ALIGN; |
---|
186 | char oem[ACPI_OEM_ID_SIZE + 1]; |
---|
187 | uint8_t *ptr; |
---|
188 | |
---|
189 | /* The table is on a 16bit boundary */ |
---|
190 | for (va = va_start; va < va_end; va += PAGE_SIZE) { |
---|
191 | for (i = 0; i < n; i++) { |
---|
192 | ptr = (uint8_t *)va + i * ACPI_RSDP_ALIGN; |
---|
193 | if (memcmp(ptr, ACPI_RSDP_SIGNATURE, ACPI_RSDP_SIGNATURE_SIZE)) |
---|
194 | continue; |
---|
195 | if (!hal_acpi_rsdp_correct(ptr)) |
---|
196 | continue; |
---|
197 | goto found; |
---|
198 | } |
---|
199 | } |
---|
200 | |
---|
201 | return NULL; |
---|
202 | |
---|
203 | found: |
---|
204 | rsdp = (rsdp_t *)ptr; |
---|
205 | |
---|
206 | memcpy(&oem, rsdp->OemId, ACPI_OEM_ID_SIZE); |
---|
207 | oem[ACPI_OEM_ID_SIZE] = '\0'; |
---|
208 | x86_printf("-> OEM: %s\n", oem); |
---|
209 | if (rsdp->Revision != 0) |
---|
210 | x86_printf("[!] Using ACPI 1.0\n"); |
---|
211 | |
---|
212 | return rsdp; |
---|
213 | } |
---|
214 | |
---|
215 | /* -------------------------------------------------------------------------- */ |
---|
216 | |
---|
217 | void hal_acpi_init() |
---|
218 | { |
---|
219 | rsdp_t *rsdp; |
---|
220 | rsdt_t *rsdt; |
---|
221 | madt_t *madt; |
---|
222 | paddr_t bios_min = 0x0E0000; |
---|
223 | paddr_t bios_max = 0x100000; |
---|
224 | vaddr_t vabase; |
---|
225 | size_t npages; |
---|
226 | |
---|
227 | npages = (bios_max - bios_min) / PAGE_SIZE; |
---|
228 | vabase = hal_gpt_bootstrap_valloc(npages); |
---|
229 | |
---|
230 | hal_gpt_enter_range(vabase, bios_min, npages); |
---|
231 | |
---|
232 | /* First, find RSDP */ |
---|
233 | rsdp = hal_acpi_find_rsdp(vabase, vabase + npages * PAGE_SIZE); |
---|
234 | if (rsdp == NULL) |
---|
235 | x86_panic("RSDP not found"); |
---|
236 | |
---|
237 | /* Then, map RSDT */ |
---|
238 | rsdt = hal_acpi_map_rsdt(rsdp); |
---|
239 | if (rsdt == NULL) |
---|
240 | x86_panic("RSDT not found"); |
---|
241 | |
---|
242 | /* Now, map MADT */ |
---|
243 | madt = hal_acpi_map_madt(rsdt); |
---|
244 | if (madt == NULL) |
---|
245 | x86_panic("MADT not found"); |
---|
246 | |
---|
247 | /* Parse it */ |
---|
248 | hal_acpi_parse_madt(madt); |
---|
249 | } |
---|
250 | |
---|