@@ -1,5 +1,5 @@
/*
- * (c) Alexey Starikovskiy, Intel, 2005.
+ * (c) Alexey Starikovskiy, Intel, 2005-2006.
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
@@ -77,16 +77,16 @@ static inline u8 checksum(u8 * buffer, u32 length)
}
static unsigned long psz, addr, length;
-static int print, connect;
+static int print, connect, skip;
static u8 select_sig[4];
static unsigned long read_efi_systab( void )
{
+ char buffer[80];
+ unsigned long addr;
FILE *f = fopen("/sys/firmware/efi/systab", "r");
if (f) {
- char buffer[80];
while (fgets(buffer, 80, f)) {
- unsigned long addr;
if (sscanf(buffer, "ACPI20=0x%lx", &addr) == 1)
return addr;
}
@@ -97,13 +97,15 @@ static unsigned long read_efi_systab( void )
static u8 *acpi_map_memory(unsigned long where, unsigned length)
{
+ unsigned long offset;
+ u8 *there;
int fd = open("/dev/mem", O_RDONLY);
if (fd < 0) {
fprintf(stderr, "acpi_os_map_memory: cannot open /dev/mem\n");
exit(1);
}
- unsigned long offset = where % psz;
- u8 *there = mmap(NULL, length + offset, PROT_READ, MAP_PRIVATE,
+ offset = where % psz;
+ there = mmap(NULL, length + offset, PROT_READ, MAP_PRIVATE,
fd, where - offset);
close(fd);
if (there == MAP_FAILED) return 0;
@@ -118,10 +120,11 @@ static void acpi_unmap_memory(u8 * there, unsigned length)
static struct acpi_table_header *acpi_map_table(unsigned long where, char *sig)
{
+ unsigned size;
struct acpi_table_header *tbl = (struct acpi_table_header *)
acpi_map_memory(where, sizeof(struct acpi_table_header));
if (!tbl || (sig && memcmp(sig, tbl->signature, 4))) return 0;
- unsigned size = tbl->length;
+ size = tbl->length;
acpi_unmap_memory((u8 *) tbl, sizeof(struct acpi_table_header));
return (struct acpi_table_header *)acpi_map_memory(where, size);
}
@@ -133,12 +136,13 @@ static void acpi_unmap_table(struct acpi_table_header *tbl)
static struct acpi_rsdp_descriptor *acpi_scan_for_rsdp(u8 *begin, u32 length)
{
+ struct acpi_rsdp_descriptor *rsdp;
u8 *i, *end = begin + length;
/* Search from given start address for the requested length */
for (i = begin; i < end; i += ACPI_RSDP_SCAN_STEP) {
/* The signature and checksum must both be correct */
if (memcmp((char *)i, "RSD PTR ", 8)) continue;
- struct acpi_rsdp_descriptor *rsdp = (struct acpi_rsdp_descriptor *)i;
+ rsdp = (struct acpi_rsdp_descriptor *)i;
/* Signature matches, check the appropriate checksum */
if (!checksum((u8 *) rsdp, (rsdp->revision < 2) ?
ACPI_RSDP_CHECKSUM_LENGTH :
@@ -156,9 +160,10 @@ static struct acpi_rsdp_descriptor *acpi_scan_for_rsdp(u8 *begin, u32 length)
static void acpi_show_data(int fd, u8 * data, int size)
{
char buffer[256];
+ int len;
int i, remain = size;
while (remain > 0) {
- int len = snprintf(buffer, 256, " %04x:", size - remain);
+ len = snprintf(buffer, 256, " %04x:", size - remain);
for (i = 0; i < 16 && i < remain; i++) {
len +=
snprintf(&buffer[len], 256 - len, " %02x", data[i]);
@@ -200,6 +205,10 @@ static void write_table(int fd, struct acpi_table_header *tbl, unsigned long add
write(fd, tbl, tbl->length);
}
} else if (!select_done && !memcmp(select_sig, tbl->signature, 4)) {
+ if (skip > 0) {
+ --skip;
+ return;
+ }
if (print) {
acpi_show_table(fd, tbl, addr);
} else {
@@ -265,8 +274,10 @@ no_facs:
static int acpi_dump_SDT(int fd, struct acpi_rsdp_descriptor *rsdp)
{
- struct acpi_table_header *tbl = 0;
- int xsdt = 1;
+ struct acpi_table_header *sdt, *tbl = 0;
+ int xsdt = 1, i, num;
+ char *offset;
+ unsigned long addr;
if (rsdp->revision > 1 && rsdp->xsdt_physical_address) {
tbl = acpi_map_table(rsdp->xsdt_physical_address, "XSDT");
}
@@ -275,17 +286,17 @@ static int acpi_dump_SDT(int fd, struct acpi_rsdp_descriptor *rsdp)
tbl = acpi_map_table(rsdp->rsdt_physical_address, "RSDT");
}
if (!tbl) return 0;
- struct acpi_table_header *sdt = malloc(tbl->length);
+ 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");
- int i, num = (sdt->length - sizeof(struct acpi_table_header))/((xsdt)?sizeof(u64):sizeof(u32));
- char *offset = (char *)sdt + sizeof(struct acpi_table_header);
- unsigned long addr;
+ num = (sdt->length - sizeof(struct acpi_table_header))/((xsdt)?sizeof(u64):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);
+ if (!addr) continue;
tbl = acpi_map_table(addr, 0);
if (!tbl) continue;
if (!memcmp(tbl->signature, FADT_SIG, 4)) {
@@ -330,29 +341,36 @@ static void usage(const char *progname)
puts("\t--binary or -b -- dump data in binary form rather than in hex-dump format");
puts("\t--length 0x456 or -l 0x456 -- works only with --addr, dump physical memory"
"\n\t\tregion without trying to understand it's contents");
+ puts("\t--skip 2 or -s 2 -- skip 2 tables of the given name and output only 3rd one");
puts("\t--help or -h -- this help message");
exit(0);
}
+static struct option long_options[] = {
+ {"addr", 1, 0, 0},
+ {"table", 1, 0, 0},
+ {"output", 1, 0, 0},
+ {"binary", 0, 0, 0},
+ {"length", 1, 0, 0},
+ {"skip", 1, 0, 0},
+ {"help", 0, 0, 0},
+ {0, 0, 0, 0}
+};
int main(int argc, char **argv)
{
+ int option_index, c, fd;
+ u8 *raw;
+ struct acpi_rsdp_descriptor rsdpx, *x = 0;
+ char *filename = 0;
+ char buff[80];
memset(select_sig, 0, 4);
print = 1;
connect = 0;
- char *filename = 0;
addr = length = 0;
+ skip = 0;
while (1) {
- int option_index = 0;
- static struct option long_options[] = {
- {"addr", 1, 0, 0},
- {"table", 1, 0, 0},
- {"output", 1, 0, 0},
- {"binary", 0, 0, 0},
- {"length", 1, 0, 0},
- {"help", 0, 0, 0},
- {0, 0, 0, 0}
- };
- int c = getopt_long(argc, argv, "a:t:o:bl:h",
+ option_index = 0;
+ c = getopt_long(argc, argv, "a:t:o:bl:s:h",
long_options, &option_index);
if (c == -1)
break;
@@ -376,6 +394,9 @@ int main(int argc, char **argv)
length = strtoul(optarg, (char **)NULL, 16);
break;
case 5:
+ skip = strtoul(optarg, (char **)NULL, 10);
+ break;
+ case 6:
usage(argv[0]);
exit(0);
}
@@ -395,6 +416,9 @@ int main(int argc, char **argv)
case 'l':
length = strtoul(optarg, (char **)NULL, 16);
break;
+ case 's':
+ skip = strtoul(optarg, (char **)NULL, 10);
+ break;
case 'h':
usage(argv[0]);
exit(0);
@@ -404,20 +428,19 @@ int main(int argc, char **argv)
exit(0);
}
}
-
- int fd = STDOUT_FILENO;
+
+ fd = STDOUT_FILENO;
if (filename) {
fd = creat(filename, S_IRUSR|S_IWUSR|S_IRGRP|S_IROTH);
if (fd < 0)
return fd;
}
-
+
if (!select_sig[0] && !print) {
connect = 1;
}
-
+
psz = sysconf(_SC_PAGESIZE);
- u8 *raw;
if (length && addr) {
/* We know length and address, it means we just want a memory dump */
if (!(raw = acpi_map_memory(addr, length)))
@@ -426,7 +449,7 @@ int main(int argc, char **argv)
acpi_unmap_memory(raw, length);
return 0;
}
-
+
length = sizeof(struct acpi_rsdp_descriptor);
if (!addr) {
addr = read_efi_systab();
@@ -435,12 +458,11 @@ int main(int argc, char **argv)
length = ACPI_HI_RSDP_WINDOW_SIZE;
}
}
-
- struct acpi_rsdp_descriptor rsdpx, *x = 0;
+
if (!(raw = acpi_map_memory(addr, length)) ||
- !(x = acpi_scan_for_rsdp(raw, length)))
+ !(x = acpi_scan_for_rsdp(raw, length)))
goto not_found;
-
+
/* Find RSDP and print all found tables */
memcpy(&rsdpx, x, sizeof(struct acpi_rsdp_descriptor));
acpi_unmap_memory(raw, length);
@@ -454,7 +476,6 @@ int main(int argc, char **argv)
write(fd, x, (rsdpx.revision < 2) ?
ACPI_RSDP_CHECKSUM_LENGTH : ACPI_RSDP_XCHECKSUM_LENGTH);
} else if (!select_sig[0] || !memcmp("RSD PTR ", select_sig, 4)) {
- char buff[80];
addr += (long)x - (long)raw;
length = snprintf(buff, 80, "RSD PTR @ %p\n", (void *)addr);
write(fd, buff, length);