1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
|
// MIT License, Copyright (c) 2020 Marvin Borner
#include <acpi.h>
#include <assert.h>
#include <cpu.h>
#include <def.h>
#include <mem.h>
#include <print.h>
int check_sdt(struct sdt_header *header)
{
u8 sum = 0;
for (u32 i = 0; i < header->length; i++)
sum += ((char *)header)[i];
return sum == 0;
}
int check_sdp(struct sdp_header *header)
{
u8 sum = 0;
for (u32 i = 0; i < sizeof(struct rsdp); i++)
sum += ((char *)header)[i];
return sum == 0;
}
struct rsdp *find_rsdp()
{
// Main BIOS area
for (int i = 0xe0000; i < 0xfffff; i++) {
if (memcmp((u32 *)i, RSDP_MAGIC, 8) == 0)
return (struct rsdp *)i;
}
// Or first KB of EBDA?
for (int i = 0x100000; i < 0x101000; i++) {
if (memcmp((u32 *)i, RSDP_MAGIC, 8) == 0)
return (struct rsdp *)i;
}
return NULL;
}
void *find_sdt(struct rsdt *rsdt, const char *signature)
{
int entries = (rsdt->header.length - sizeof(rsdt->header)) / 4;
for (int i = 0; i < entries; i++) {
struct sdt_header *header = (struct sdt_header *)rsdt->sdt_pointer[i];
if (memcmp(header->signature, signature, 4) == 0)
return header;
}
return NULL;
}
void acpi_install()
{
struct rsdp *rsdp = find_rsdp();
assert(rsdp && rsdp->header.revision == 0 && check_sdp(&rsdp->header));
struct rsdt *rsdt = rsdp->rsdt;
assert(rsdt && memcmp(rsdt->header.signature, RSDT_MAGIC, 4) == 0 &&
check_sdt(&rsdt->header));
madt = find_sdt(rsdt, MADT_MAGIC);
fadt = find_sdt(rsdt, FADT_MAGIC);
hpet = find_sdt(rsdt, HPET_MAGIC);
assert(madt && check_sdt(&madt->header) && fadt && check_sdt(&fadt->header) && hpet &&
check_sdt(&hpet->header));
}
|
