|
@@ -1,5 +1,6 @@
|
|
|
/*
|
|
|
* (c) Alexey Starikovskiy, Intel, 2005-2006.
|
|
|
+ * (c) Len Brown, Intel, 2007.
|
|
|
* All rights reserved.
|
|
|
*
|
|
|
* Redistribution and use in source and binary forms, with or without
|
|
@@ -185,6 +186,40 @@ static void acpi_show_data(int fd, u8 * data, int size)
|
|
|
/*
|
|
|
* Output ACPI table
|
|
|
*/
|
|
|
+
|
|
|
+#define MAX_TABLES 128
|
|
|
+int next_table_dump;
|
|
|
+u64 dumped_tables[MAX_TABLES];
|
|
|
+
|
|
|
+void
|
|
|
+set_table_dumped(u64 address) {
|
|
|
+ if (next_table_dump >= MAX_TABLES) {
|
|
|
+ printf("increase MAX_TABLES\n");
|
|
|
+ exit(1);
|
|
|
+ }
|
|
|
+ dumped_tables[next_table_dump++] = address;
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * list the tables as they are dumped
|
|
|
+ * check the list so that they are not dumped twice.
|
|
|
+ *
|
|
|
+ * this is needed because we follow both the XSDT and RSDT
|
|
|
+ * which generally point to all duplicate tables
|
|
|
+ * except the FADT
|
|
|
+ */
|
|
|
+int
|
|
|
+check_table_dumped(u64 address) {
|
|
|
+ int i;
|
|
|
+
|
|
|
+ for (i = 0; i < MAX_TABLES; ++i) {
|
|
|
+ if (address == dumped_tables[i])
|
|
|
+ return 1;
|
|
|
+ if (dumped_tables[i] == 0)
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+ return 0;
|
|
|
+}
|
|
|
static void acpi_show_table(int fd, struct acpi_table_header *table, unsigned long addr)
|
|
|
{
|
|
|
char buff[80];
|
|
@@ -198,6 +233,10 @@ static void acpi_show_table(int fd, struct acpi_table_header *table, unsigned lo
|
|
|
static void write_table(int fd, struct acpi_table_header *tbl, unsigned long addr)
|
|
|
{
|
|
|
static int select_done = 0;
|
|
|
+
|
|
|
+ if (check_table_dumped((u64)addr))
|
|
|
+ return;
|
|
|
+
|
|
|
if (!select_sig[0]) {
|
|
|
if (print) {
|
|
|
acpi_show_table(fd, tbl, addr);
|
|
@@ -216,6 +255,7 @@ static void write_table(int fd, struct acpi_table_header *tbl, unsigned long add
|
|
|
}
|
|
|
select_done = 1;
|
|
|
}
|
|
|
+ set_table_dumped((u64) addr);
|
|
|
}
|
|
|
|
|
|
static void acpi_dump_FADT(int fd, struct acpi_table_header *tbl, unsigned long xaddr) {
|
|
@@ -272,30 +312,26 @@ no_facs:
|
|
|
write_table(fd, (struct acpi_table_header *)&x, xaddr);
|
|
|
}
|
|
|
|
|
|
-static int acpi_dump_SDT(int fd, struct acpi_rsdp_descriptor *rsdp)
|
|
|
+
|
|
|
+static int acpi_dump_RSDT(int fd, struct acpi_rsdp_descriptor *rsdp)
|
|
|
{
|
|
|
struct acpi_table_header *sdt, *tbl = 0;
|
|
|
- int xsdt = 1, i, num;
|
|
|
+ int i, num;
|
|
|
char *offset;
|
|
|
unsigned long addr;
|
|
|
- if (rsdp->revision > 1 && rsdp->xsdt_physical_address) {
|
|
|
- tbl = acpi_map_table(rsdp->xsdt_physical_address, "XSDT");
|
|
|
- }
|
|
|
- if (!tbl && rsdp->rsdt_physical_address) {
|
|
|
- xsdt = 0;
|
|
|
- tbl = acpi_map_table(rsdp->rsdt_physical_address, "RSDT");
|
|
|
- }
|
|
|
+
|
|
|
+ tbl = acpi_map_table(rsdp->rsdt_physical_address, "RSDT");
|
|
|
if (!tbl) return 0;
|
|
|
+
|
|
|
sdt = malloc(tbl->length);
|
|
|
memcpy(sdt, tbl, tbl->length);
|
|
|
acpi_unmap_table(tbl);
|
|
|
if (checksum((u8 *)sdt, sdt->length))
|
|
|
- fprintf(stderr, "Wrong checksum for %s!\n", (xsdt)?"XSDT":"RSDT");
|
|
|
- num = (sdt->length - sizeof(struct acpi_table_header))/((xsdt)?sizeof(u64):sizeof(u32));
|
|
|
+ fprintf(stderr, "Wrong checksum for %s!\n", "RSDT");
|
|
|
+ num = (sdt->length - sizeof(struct acpi_table_header))/sizeof(u32);
|
|
|
offset = (char *)sdt + sizeof(struct acpi_table_header);
|
|
|
- for (i = 0; i < num; ++i, offset += ((xsdt) ? sizeof(u64) : sizeof(u32))) {
|
|
|
- addr = (xsdt) ? (unsigned long)(*(u64 *)offset):
|
|
|
- (unsigned long)(*(u32 *)offset);
|
|
|
+ for (i = 0; i < num; ++i, offset += sizeof(u32)) {
|
|
|
+ addr = (unsigned long)(*(u32 *)offset);
|
|
|
if (!addr) continue;
|
|
|
tbl = acpi_map_table(addr, 0);
|
|
|
if (!tbl) continue;
|
|
@@ -303,28 +339,63 @@ static int acpi_dump_SDT(int fd, struct acpi_rsdp_descriptor *rsdp)
|
|
|
acpi_dump_FADT(fd, tbl, addr);
|
|
|
} else {
|
|
|
if (checksum((u8 *)tbl, tbl->length))
|
|
|
- fprintf(stderr, "Wrong checksum for generic table!\n");
|
|
|
+ fprintf(stderr, "Wrong checksum for %.4s!\n", tbl->signature);
|
|
|
write_table(fd, tbl, addr);
|
|
|
}
|
|
|
acpi_unmap_table(tbl);
|
|
|
if (connect) {
|
|
|
- if (xsdt)
|
|
|
- (*(u64*)offset) = lseek(fd, 0, SEEK_CUR);
|
|
|
- else
|
|
|
- (*(u32*)offset) = lseek(fd, 0, SEEK_CUR);
|
|
|
+ (*(u32*)offset) = lseek(fd, 0, SEEK_CUR);
|
|
|
}
|
|
|
}
|
|
|
- if (xsdt) {
|
|
|
- addr = (unsigned long)rsdp->xsdt_physical_address;
|
|
|
- if (connect) {
|
|
|
- rsdp->xsdt_physical_address = lseek(fd, 0, SEEK_CUR);
|
|
|
+ addr = (unsigned long)rsdp->rsdt_physical_address;
|
|
|
+ if (connect) {
|
|
|
+ rsdp->rsdt_physical_address = lseek(fd, 0, SEEK_CUR);
|
|
|
+ }
|
|
|
+ write_table(fd, sdt, addr);
|
|
|
+ free (sdt);
|
|
|
+ return 1;
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
+static int acpi_dump_XSDT(int fd, struct acpi_rsdp_descriptor *rsdp)
|
|
|
+{
|
|
|
+ struct acpi_table_header *sdt, *tbl = 0;
|
|
|
+ int i, num;
|
|
|
+ char *offset;
|
|
|
+ unsigned long addr;
|
|
|
+ if (rsdp->revision > 1 && rsdp->xsdt_physical_address) {
|
|
|
+ tbl = acpi_map_table(rsdp->xsdt_physical_address, "XSDT");
|
|
|
+ }
|
|
|
+ if (!tbl) return 0;
|
|
|
+
|
|
|
+ sdt = malloc(tbl->length);
|
|
|
+ memcpy(sdt, tbl, tbl->length);
|
|
|
+ acpi_unmap_table(tbl);
|
|
|
+ if (checksum((u8 *)sdt, sdt->length))
|
|
|
+ fprintf(stderr, "Wrong checksum for %s!\n", "XSDT");
|
|
|
+ num = (sdt->length - sizeof(struct acpi_table_header))/sizeof(u64);
|
|
|
+ offset = (char *)sdt + sizeof(struct acpi_table_header);
|
|
|
+ for (i = 0; i < num; ++i, offset += sizeof(u64)) {
|
|
|
+ addr = (unsigned long)(*(u64 *)offset);
|
|
|
+ if (!addr) continue;
|
|
|
+ tbl = acpi_map_table(addr, 0);
|
|
|
+ if (!tbl) continue;
|
|
|
+ if (!memcmp(tbl->signature, FADT_SIG, 4)) {
|
|
|
+ acpi_dump_FADT(fd, tbl, addr);
|
|
|
+ } else {
|
|
|
+ if (checksum((u8 *)tbl, tbl->length))
|
|
|
+ fprintf(stderr, "Wrong checksum for %.4s\n", tbl->signature);
|
|
|
+ write_table(fd, tbl, addr);
|
|
|
}
|
|
|
- } else {
|
|
|
- addr = (unsigned long)rsdp->rsdt_physical_address;
|
|
|
+ acpi_unmap_table(tbl);
|
|
|
if (connect) {
|
|
|
- rsdp->rsdt_physical_address = lseek(fd, 0, SEEK_CUR);
|
|
|
+ (*(u64*)offset) = lseek(fd, 0, SEEK_CUR);
|
|
|
}
|
|
|
}
|
|
|
+ addr = (unsigned long)rsdp->xsdt_physical_address;
|
|
|
+ if (connect) {
|
|
|
+ rsdp->xsdt_physical_address = lseek(fd, 0, SEEK_CUR);
|
|
|
+ }
|
|
|
write_table(fd, sdt, addr);
|
|
|
free (sdt);
|
|
|
return 1;
|
|
@@ -469,7 +540,9 @@ int main(int argc, char **argv)
|
|
|
if (connect) {
|
|
|
lseek(fd, sizeof(struct acpi_rsdp_descriptor), SEEK_SET);
|
|
|
}
|
|
|
- if (!acpi_dump_SDT(fd, &rsdpx))
|
|
|
+ if (!acpi_dump_XSDT(fd, &rsdpx))
|
|
|
+ goto not_found;
|
|
|
+ if (!acpi_dump_RSDT(fd, &rsdpx))
|
|
|
goto not_found;
|
|
|
if (connect) {
|
|
|
lseek(fd, 0, SEEK_SET);
|