ACPI in kernel
- the ability for kernel to use ACPI tables to detect IO APICs. It is the bare minimum the kernel needs to know about ACPI tables. - it will be used to find out about processors as the MPS tables are deprecated by ACPI and not all vendorsprovide them.
This commit is contained in:
Tomas Hruby
parent
e7252adc1e
commit
45badf4c05
@ -30,7 +30,8 @@ SRCS+= arch_do_vmctl.c \
|
||||
apic.c \
|
||||
apic_asm.S \
|
||||
arch_watchdog.c \
|
||||
pre_init.c
|
||||
pre_init.c \
|
||||
acpi.c
|
||||
|
||||
.if ${COMPILER_TYPE} == "ack"
|
||||
I86CPPFLAGS = -mi86
|
||||
|
||||
297
kernel/arch/i386/acpi.c
Normal file
297
kernel/arch/i386/acpi.c
Normal file
@ -0,0 +1,297 @@
|
||||
#include "kernel/kernel.h"
|
||||
|
||||
/* ACPI root system description pointer */
|
||||
struct acpi_rsdp {
|
||||
char signature[8]; /* must be "RSD PTR " */
|
||||
u8_t checksum;
|
||||
char oemid[6];
|
||||
u8_t revision;
|
||||
u32_t rsdt_addr;
|
||||
u32_t length;
|
||||
};
|
||||
|
||||
#define ACPI_SDT_SIGNATURE_LEN 4
|
||||
|
||||
#define ACPI_SDT_SIGNATURE(name) #name
|
||||
|
||||
/* header common to all system description tables */
|
||||
struct acpi_sdt_header {
|
||||
char signature[ACPI_SDT_SIGNATURE_LEN];
|
||||
u32_t length;
|
||||
u8_t revision;
|
||||
u8_t checksum;
|
||||
char oemid[6];
|
||||
char oem_table_id[8];
|
||||
u32_t oem_revision;
|
||||
u32_t creator_id;
|
||||
u32_t creator_revision;
|
||||
};
|
||||
|
||||
struct acpi_madt_hdr {
|
||||
struct acpi_sdt_header hdr;
|
||||
u32_t local_apic_address;
|
||||
u32_t flags;
|
||||
};
|
||||
|
||||
#define ACPI_MADT_TYPE_LAPIC 0
|
||||
#define ACPI_MADT_TYPE_IOAPIC 1
|
||||
#define ACPI_MADT_TYPE_INT_SRC 2
|
||||
#define ACPI_MADT_TYPE_NMI_SRC 3
|
||||
#define ACPI_MADT_TYPE_LAPIC_NMI 4
|
||||
#define ACPI_MADT_TYPE_LAPIC_ADRESS 5
|
||||
#define ACPI_MADT_TYPE_IOSAPIC 6
|
||||
#define ACPI_MADT_TYPE_LSAPIC 7
|
||||
#define ACPI_MADT_TYPE_PLATFORM_INT_SRC 8
|
||||
#define ACPI_MADT_TYPE_Lx2APIC 9
|
||||
#define ACPI_MADT_TYPE_Lx2APIC_NMI 10
|
||||
|
||||
struct acpi_madt_item_hdr{
|
||||
u8_t type;
|
||||
u8_t length;
|
||||
};
|
||||
|
||||
struct acpi_madt_lapic {
|
||||
struct acpi_madt_item_hdr hdr;
|
||||
u8_t acpi_cpu_id;
|
||||
u8_t apic_id;
|
||||
u32_t flags;
|
||||
};
|
||||
|
||||
struct acpi_madt_ioapic {
|
||||
struct acpi_madt_item_hdr hdr;
|
||||
u8_t id;
|
||||
u8_t __reserved;
|
||||
u32_t address;
|
||||
u32_t global_int_base;
|
||||
};
|
||||
|
||||
struct acpi_madt_int_src {
|
||||
struct acpi_madt_item_hdr hdr;
|
||||
u8_t bus;
|
||||
u8_t bus_int;
|
||||
u32_t global_int;
|
||||
u16_t mps_flags;
|
||||
};
|
||||
|
||||
struct acpi_madt_nmi {
|
||||
struct acpi_madt_item_hdr hdr;
|
||||
u16_t flags;
|
||||
u32_t global_int;
|
||||
};
|
||||
|
||||
typedef int ((* acpi_read_t)(phys_bytes addr, void * buff, size_t size));
|
||||
|
||||
struct acpi_rsdp acpi_rsdp;
|
||||
|
||||
PRIVATE acpi_read_t read_func;
|
||||
|
||||
#define MAX_RSDT 35 /* ACPI defines 35 signatures */
|
||||
|
||||
PRIVATE struct acpi_rsdt {
|
||||
struct acpi_sdt_header hdr;
|
||||
u32_t data[MAX_RSDT];
|
||||
} rsdt;
|
||||
|
||||
PRIVATE struct {
|
||||
char signature [ACPI_SDT_SIGNATURE_LEN + 1];
|
||||
size_t length;
|
||||
} sdt_trans[MAX_RSDT];
|
||||
|
||||
PRIVATE int sdt_count;
|
||||
|
||||
PRIVATE int acpi_check_csum(struct acpi_sdt_header * tb, size_t size)
|
||||
{
|
||||
u8_t total = 0;
|
||||
int i;
|
||||
for (i = 0; i < size; i++)
|
||||
total += ((unsigned char *)tb)[i];
|
||||
return total == 0 ? 0 : -1;
|
||||
}
|
||||
|
||||
PRIVATE int acpi_check_signature(const char * orig, const char * match)
|
||||
{
|
||||
return strncmp(orig, match, ACPI_SDT_SIGNATURE_LEN);
|
||||
}
|
||||
|
||||
PRIVATE int acpi_read_sdt_at(phys_bytes addr,
|
||||
struct acpi_sdt_header * tb,
|
||||
size_t size,
|
||||
const char * name)
|
||||
{
|
||||
struct acpi_sdt_header hdr;
|
||||
|
||||
/* if NULL is supplied, we only return the size of the table */
|
||||
if (tb == NULL) {
|
||||
if (read_func(addr, &hdr, sizeof(struct acpi_sdt_header))) {
|
||||
printf("ERROR acpi cannot read %s header\n", name);
|
||||
return -1;
|
||||
}
|
||||
|
||||
return hdr.length;
|
||||
}
|
||||
|
||||
if (read_func(addr, tb, sizeof(struct acpi_sdt_header))) {
|
||||
printf("ERROR acpi cannot read %s header\n", name);
|
||||
return -1;
|
||||
}
|
||||
|
||||
if (acpi_check_signature(tb->signature, name)) {
|
||||
printf("ERROR acpi %s signature does not match\n", name);
|
||||
return -1;
|
||||
}
|
||||
|
||||
if (size < tb->length) {
|
||||
printf("ERROR acpi buffer too small for %s\n", name);
|
||||
return -1;
|
||||
}
|
||||
|
||||
if (read_func(addr, tb, size)) {
|
||||
printf("ERROR acpi cannot read %s\n", name);
|
||||
return -1;
|
||||
}
|
||||
|
||||
if (acpi_check_csum(tb, tb->length)) {
|
||||
printf("ERROR acpi %s checksum does not match\n", name);
|
||||
return -1;
|
||||
}
|
||||
|
||||
return tb->length;
|
||||
}
|
||||
|
||||
PRIVATE phys_bytes acpi_get_table_base(const char * name)
|
||||
{
|
||||
int i;
|
||||
|
||||
for(i = 0; i < sdt_count; i++) {
|
||||
if (strncmp(name, sdt_trans[i].signature,
|
||||
ACPI_SDT_SIGNATURE_LEN) == 0)
|
||||
return (phys_bytes) rsdt.data[i];
|
||||
}
|
||||
|
||||
return (phys_bytes) NULL;
|
||||
}
|
||||
|
||||
PRIVATE size_t acpi_get_table_length(const char * name)
|
||||
{
|
||||
int i;
|
||||
|
||||
for(i = 0; i < sdt_count; i++) {
|
||||
if (strncmp(name, sdt_trans[i].signature,
|
||||
ACPI_SDT_SIGNATURE_LEN) == 0)
|
||||
return sdt_trans[i].length;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
PRIVATE void * acpi_madt_get_typed_item(struct acpi_madt_hdr * hdr,
|
||||
unsigned char type,
|
||||
unsigned idx)
|
||||
{
|
||||
u8_t * t, * end;
|
||||
int i;
|
||||
|
||||
t = (u8_t *) hdr + sizeof(struct acpi_madt_hdr);
|
||||
end = (u8_t *) hdr + hdr->hdr.length;
|
||||
|
||||
i = 0;
|
||||
while(t < end) {
|
||||
if (type == ((struct acpi_madt_item_hdr *) t)->type) {
|
||||
if (i == idx)
|
||||
return t;
|
||||
else
|
||||
i++;
|
||||
}
|
||||
t += ((struct acpi_madt_item_hdr *) t)->length;
|
||||
}
|
||||
|
||||
return NULL;
|
||||
}
|
||||
|
||||
PRIVATE void * acpi_madt_get_item(struct acpi_madt_hdr * hdr,
|
||||
unsigned idx)
|
||||
{
|
||||
u8_t * t, * end;
|
||||
int i;
|
||||
|
||||
t = (u8_t *) hdr + sizeof(struct acpi_madt_hdr);
|
||||
end = (u8_t *) hdr + hdr->hdr.length;
|
||||
|
||||
for(i = 0 ; i <= idx && t < end; i++) {
|
||||
if (i == idx)
|
||||
return t;
|
||||
t += ((struct acpi_madt_item_hdr *) t)->length;
|
||||
}
|
||||
|
||||
return NULL;
|
||||
}
|
||||
PRIVATE int acpi_rsdp_test(void * buff)
|
||||
{
|
||||
struct acpi_rsdp * rsdp = (struct acpi_rsdp *) buff;
|
||||
|
||||
if (!platform_tbl_checksum_ok(buff, 20))
|
||||
return 0;
|
||||
if (strncmp(rsdp->signature, "RSD PTR ", 8))
|
||||
return 0;
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
PRIVATE int get_acpi_rsdp(void)
|
||||
{
|
||||
u16_t ebda;
|
||||
/*
|
||||
* Read 40:0Eh - to find the starting address of the EBDA.
|
||||
*/
|
||||
phys_copy (0x40E, vir2phys(&ebda), sizeof(ebda));
|
||||
if (ebda) {
|
||||
ebda <<= 4;
|
||||
if(platform_tbl_ptr(ebda, ebda + 0x400, 16, &acpi_rsdp,
|
||||
sizeof(acpi_rsdp), acpi_rsdp_test))
|
||||
return 1;
|
||||
}
|
||||
|
||||
/* try BIOS read only mem space */
|
||||
if(platform_tbl_ptr(0xE0000, 0x100000, 16, &acpi_rsdp,
|
||||
sizeof(acpi_rsdp), acpi_rsdp_test))
|
||||
return 1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
PRIVATE int acpi_read_kernel(phys_bytes addr, void * buff, size_t size)
|
||||
{
|
||||
phys_copy(addr, vir2phys(buff), size);
|
||||
return 0;
|
||||
}
|
||||
|
||||
PUBLIC void acpi_init(void)
|
||||
{
|
||||
int s, i;
|
||||
read_func = acpi_read_kernel;
|
||||
|
||||
if (!get_acpi_rsdp()) {
|
||||
printf("WARNING : Cannot configure ACPI\n");
|
||||
return;
|
||||
}
|
||||
|
||||
s = acpi_read_sdt_at(acpi_rsdp.rsdt_addr, (struct acpi_sdt_header *) &rsdt,
|
||||
sizeof(struct acpi_rsdt), ACPI_SDT_SIGNATURE(RSDT));
|
||||
|
||||
sdt_count = (s - sizeof(struct acpi_sdt_header)) / sizeof(u32_t);
|
||||
|
||||
for (i = 0; i < sdt_count; i++) {
|
||||
struct acpi_sdt_header hdr;
|
||||
int j;
|
||||
if (read_func(rsdt.data[i], &hdr, sizeof(struct acpi_sdt_header))) {
|
||||
printf("ERROR acpi cannot read header at 0x%x\n",
|
||||
rsdt.data[i]);
|
||||
return;
|
||||
}
|
||||
|
||||
for (j = 0 ; j < ACPI_SDT_SIGNATURE_LEN; j++)
|
||||
sdt_trans[i].signature[j] = hdr.signature[j];
|
||||
sdt_trans[i].signature[ACPI_SDT_SIGNATURE_LEN] = '\0';
|
||||
sdt_trans[i].length = hdr.length;
|
||||
}
|
||||
}
|
||||
8
kernel/arch/i386/acpi.h
Normal file
8
kernel/arch/i386/acpi.h
Normal file
@ -0,0 +1,8 @@
|
||||
#ifndef __ACPI_H__
|
||||
#define __ACPI_H__
|
||||
|
||||
#include "kernel/kernel.h"
|
||||
|
||||
_PROTOTYPE(void acpi_init, (void));
|
||||
|
||||
#endif /* __ACPI_H__ */
|
||||
@ -28,6 +28,8 @@
|
||||
#include "apic.h"
|
||||
#endif
|
||||
|
||||
#include "acpi.h"
|
||||
|
||||
PRIVATE int osfxsr_feature; /* FXSAVE/FXRSTOR instructions support (SSEx) */
|
||||
|
||||
extern __dead void poweroff_jmp();
|
||||
@ -313,6 +315,8 @@ PUBLIC void arch_init(void)
|
||||
|
||||
tss_init(&tss, &k_boot_stktop, 0);
|
||||
|
||||
acpi_init();
|
||||
|
||||
#if defined(CONFIG_APIC) && !defined(CONFIG_SMP)
|
||||
if (config_no_apic) {
|
||||
BOOT_VERBOSE(printf("APIC disabled, using legacy PIC\n"));
|
||||
|
||||
@ -1073,3 +1073,30 @@ PUBLIC void release_address_space(struct proc *pr)
|
||||
{
|
||||
pr->p_seg.p_cr3_v = NULL;
|
||||
}
|
||||
|
||||
/* computes a checksum of a buffer of a given length. The byte sum must be zero */
|
||||
PUBLIC int platform_tbl_checksum_ok(void *ptr, unsigned int length)
|
||||
{
|
||||
u8_t total = 0;
|
||||
unsigned int i;
|
||||
for (i = 0; i < length; i++)
|
||||
total += ((unsigned char *)ptr)[i];
|
||||
return !total;
|
||||
}
|
||||
|
||||
PUBLIC int platform_tbl_ptr(phys_bytes start,
|
||||
phys_bytes end,
|
||||
unsigned increment,
|
||||
void * buff,
|
||||
unsigned size,
|
||||
int ((* cmp_f)(void *)))
|
||||
{
|
||||
phys_bytes addr;
|
||||
|
||||
for (addr = start; addr < end; addr += increment) {
|
||||
phys_copy (addr, vir2phys(buff), size);
|
||||
if (cmp_f(buff))
|
||||
return 1;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
@ -161,6 +161,14 @@ _PROTOTYPE(void __copy_msg_from_user_end, (void));
|
||||
_PROTOTYPE(void __copy_msg_to_user_end, (void));
|
||||
_PROTOTYPE(void __user_copy_msg_pointer_failure, (void));
|
||||
|
||||
_PROTOTYPE(int platform_tbl_checksum_ok, (void *ptr, unsigned int length));
|
||||
_PROTOTYPE(int platform_tbl_ptr, (phys_bytes start,
|
||||
phys_bytes end,
|
||||
unsigned increment,
|
||||
void * buff,
|
||||
unsigned size,
|
||||
int ((* cmp_f)(void *))));
|
||||
|
||||
/* breakpoints.c */
|
||||
#define BREAKPOINT_COUNT 4
|
||||
#define BREAKPOINT_FLAG_RW_MASK (3 << 0)
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user