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
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
|
// 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) {
if (check_sdt(header))
return header;
else
break;
}
}
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);
}
void hpet_install(int period)
{
if (hpet && hpet->legacy_replacement && hpet->comparator_count > 0) {
struct hpet_registers *r = (struct hpet_registers *)hpet->address.phys;
printf("HPET tick period: %dns\n", HPET_MAX_PERIOD / r->tick_period);
if ((r->timer0 & hpet_periodic_support) == hpet_periodic_support) {
r->config |= hpet_enable;
r->config |= hpet_legacy_replacement;
r->timer0 |= hpet_periodic | hpet_set_accumulator | hpet_enable_timer;
assert(r->tick_period + period < HPET_MAX_PERIOD);
r->timer_comparator0 = r->tick_period + period;
r->timer_comparator0 = period;
}
} else {
hpet = NULL;
}
}
|
