2 files changed, 487 insertions, 0 deletions

diff --git a/tools/power/acpi/Makefile b/tools/power/acpi/Makefile
new file mode 100644
index 000000000000..faf5ff5c8f8f
--- /dev/null
+++ b/tools/power/acpi/Makefile
@@ -0,0 +1,15 @@
+PROG=   acpidump
+SRCS=   acpidump.c
+KERNEL_INCLUDE := ../../../include
+CFLAGS += -Wall -Wstrict-prototypes -Os -s -D_LINUX -DDEFINE_ALTERNATE_TYPES -I$(KERNEL_INCLUDE) 
+
+all: acpidump
+
+acpidump : $(SRCS) 
+        $(CC) $(CFLAGS) $(SRCS) -o $(PROG)
+
+CLEANFILES= $(PROG)
+
+clean : 
+        rm -f $(CLEANFILES) $(patsubst %.c,%.o, $(SRCS)) *~
+
diff --git a/tools/power/acpi/acpidump.c b/tools/power/acpi/acpidump.c
new file mode 100644
index 000000000000..3f0a9da6df9f
--- /dev/null
+++ b/tools/power/acpi/acpidump.c
@@ -0,0 +1,472 @@
+/*
+ * (c) Alexey Starikovskiy, Intel, 2005.
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions, and the following disclaimer,
+ *    without modification.
+ * 2. Redistributions in binary form must reproduce at minimum a disclaimer
+ *    substantially similar to the "NO WARRANTY" disclaimer below
+ *    ("Disclaimer") and any redistribution must be conditioned upon
+ *    including a substantially similar Disclaimer requirement for further
+ *    binary redistribution.
+ * 3. Neither the names of the above-listed copyright holders nor the names
+ *    of any contributors may be used to endorse or promote products derived
+ *    from this software without specific prior written permission.
+ *
+ * Alternatively, this software may be distributed under the terms of the
+ * GNU General Public License ("GPL") version 2 as published by the Free
+ * Software Foundation.
+ *
+ * NO WARRANTY
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR
+ * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
+ * HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
+ * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
+ * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGES.
+ */
+
+#ifdef DEFINE_ALTERNATE_TYPES
+/* hack to enable building old application with new headers -lenb */
+#define acpi_fadt_descriptor acpi_table_fadt
+#define acpi_rsdp_descriptor acpi_table_rsdp
+#define DSDT_SIG ACPI_SIG_DSDT
+#define FACS_SIG ACPI_SIG_FACS
+#define FADT_SIG ACPI_SIG_FADT
+#define xfirmware_ctrl Xfacs
+#define firmware_ctrl facs
+
+typedef int                             s32;
+typedef unsigned char                   u8;
+typedef unsigned short                  u16;
+typedef unsigned int                    u32;
+typedef unsigned long long              u64;
+typedef long long                       s64;
+#endif
+
+#include <sys/mman.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <fcntl.h>
+#include <stdio.h>
+#include <string.h>
+#include <unistd.h>
+#include <getopt.h>
+
+
+#include <acpi/acconfig.h>
+#include <acpi/platform/acenv.h>
+#include <acpi/actypes.h>
+#include <acpi/actbl.h>
+
+static inline u8 checksum(u8 * buffer, u32 length)
+{
+        u8 sum = 0, *i = buffer;
+        buffer += length;
+        for (; i < buffer; sum += *(i++));
+        return sum;
+}
+
+static unsigned long psz, addr, length;
+static int print, connect;
+static u8 select_sig[4];
+
+static unsigned long read_efi_systab( void )
+{
+        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;
+                }
+                fclose(f);
+        }
+        return 0;
+}
+
+static u8 *acpi_map_memory(unsigned long where, unsigned length)
+{
+        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,
+                         fd, where - offset);
+        close(fd);
+        if (there == MAP_FAILED) return 0;
+        return (there + offset);
+}
+
+static void acpi_unmap_memory(u8 * there, unsigned length)
+{
+        unsigned long offset = (unsigned long)there % psz;
+        munmap(there - offset, length + offset);
+}
+
+static struct acpi_table_header *acpi_map_table(unsigned long where, char *sig)
+{
+        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;
+        acpi_unmap_memory((u8 *) tbl, sizeof(struct acpi_table_header));
+        return (struct acpi_table_header *)acpi_map_memory(where, size);
+}
+
+static void acpi_unmap_table(struct acpi_table_header *tbl)
+{
+        acpi_unmap_memory((u8 *)tbl, tbl->length);
+}
+
+static struct acpi_rsdp_descriptor *acpi_scan_for_rsdp(u8 *begin, u32 length)
+{
+        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;
+                /* Signature matches, check the appropriate checksum */
+                if (!checksum((u8 *) rsdp, (rsdp->revision < 2) ?
+                              ACPI_RSDP_CHECKSUM_LENGTH :
+                              ACPI_RSDP_XCHECKSUM_LENGTH))
+                        /* Checksum valid, we have found a valid RSDP */
+                        return rsdp;
+        }
+        /* Searched entire block, no RSDP was found */
+        return 0;
+}
+
+/*
+ * Output data
+ */
+static void acpi_show_data(int fd, u8 * data, int size)
+{
+        char buffer[256];
+        int i, remain = size;
+        while (remain > 0) {
+                int len = snprintf(buffer, 256, "  %04x:", size - remain);
+                for (i = 0; i < 16 && i < remain; i++) {
+                        len +=
+                            snprintf(&buffer[len], 256 - len, " %02x", data[i]);
+                }
+                for (; i < 16; i++) {
+                        len += snprintf(&buffer[len], 256 - len, "   ");
+                }
+                len += snprintf(&buffer[len], 256 - len, "  ");
+                for (i = 0; i < 16 && i < remain; i++) {
+                        buffer[len++] = (isprint(data[i])) ? data[i] : '.';
+                }
+                buffer[len++] = '\n';
+                write(fd, buffer, len);
+                data += 16;
+                remain -= 16;
+        }
+}
+
+/*
+ * Output ACPI table
+ */
+static void acpi_show_table(int fd, struct acpi_table_header *table, unsigned long addr)
+{
+        char buff[80];
+        int len = snprintf(buff, 80, "%.4s @ %p\n", table->signature, (void *)addr);
+        write(fd, buff, len);
+        acpi_show_data(fd, (u8 *) table, table->length);
+        buff[0] = '\n';
+        write(fd, buff, 1);
+}
+
+static void write_table(int fd, struct acpi_table_header *tbl, unsigned long addr)
+{
+        static int select_done = 0;
+        if (!select_sig[0]) {
+                if (print) {
+                        acpi_show_table(fd, tbl, addr);
+                } else {
+                        write(fd, tbl, tbl->length);
+                }
+        } else if (!select_done && !memcmp(select_sig, tbl->signature, 4)) {
+                if (print) {
+                        acpi_show_table(fd, tbl, addr);
+                } else {
+                        write(fd, tbl, tbl->length);
+                }
+                select_done = 1;
+        }
+}
+
+static void acpi_dump_FADT(int fd, struct acpi_table_header *tbl, unsigned long xaddr) {
+        struct acpi_fadt_descriptor x;
+        unsigned long addr;
+        size_t len = sizeof(struct acpi_fadt_descriptor);
+        if (len > tbl->length) len = tbl->length;
+        memcpy(&x, tbl, len);
+        x.header.length = len;
+        if (checksum((u8 *)tbl, len)) {
+                fprintf(stderr, "Wrong checksum for FADT!\n");
+        }
+        if (x.header.length >= 148 && x.Xdsdt) {
+                addr = (unsigned long)x.Xdsdt;
+                if (connect) {
+                        x.Xdsdt = lseek(fd, 0, SEEK_CUR);
+                }
+        } else if (x.header.length >= 44 && x.dsdt) {
+                addr = (unsigned long)x.dsdt;
+                if (connect) {
+                        x.dsdt = lseek(fd, 0, SEEK_CUR);
+                }
+        } else {
+                fprintf(stderr, "No DSDT in FADT!\n");
+                goto no_dsdt;
+        }
+        tbl = acpi_map_table(addr, DSDT_SIG);
+        if (!tbl) goto no_dsdt;
+        if (checksum((u8 *)tbl, tbl->length))
+                fprintf(stderr, "Wrong checksum for DSDT!\n");
+        write_table(fd, tbl, addr);
+        acpi_unmap_table(tbl);
+no_dsdt:
+        if (x.header.length >= 140 && x.xfirmware_ctrl) {
+                addr = (unsigned long)x.xfirmware_ctrl;
+                if (connect) {
+                        x.xfirmware_ctrl = lseek(fd, 0, SEEK_CUR);
+                }
+        } else if (x.header.length >= 40 && x.firmware_ctrl) {
+                addr = (unsigned long)x.firmware_ctrl;
+                if (connect) {
+                        x.firmware_ctrl = lseek(fd, 0, SEEK_CUR);
+                }
+        } else {
+                fprintf(stderr, "No FACS in FADT!\n");
+                goto no_facs;
+        }
+        tbl = acpi_map_table(addr, FACS_SIG);
+        if (!tbl) goto no_facs;
+        /* do not checksum FACS */
+        write_table(fd, tbl, addr);
+        acpi_unmap_table(tbl);
+no_facs:
+        write_table(fd, (struct acpi_table_header *)&x, xaddr);
+}
+
+static int acpi_dump_SDT(int fd, struct acpi_rsdp_descriptor *rsdp)
+{
+        struct acpi_table_header *tbl = 0;
+        int xsdt = 1;
+        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");
+        }
+        if (!tbl) return 0;
+        struct acpi_table_header *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;
+        for (i = 0; i < num; ++i, offset += ((xsdt) ? sizeof(u64) : sizeof(u32))) {
+                addr = (xsdt) ? (unsigned long)(*(u64 *)offset):
+                                (unsigned long)(*(u32 *)offset);
+                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 generic table!\n");
+                        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);
+                }
+        }
+        if (xsdt) {
+                addr = (unsigned long)rsdp->xsdt_physical_address;
+                if (connect) {
+                        rsdp->xsdt_physical_address = lseek(fd, 0, SEEK_CUR);
+                }
+        } else {
+                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 void usage(const char *progname)
+{
+        puts("Usage:");
+        printf("%s [--addr 0x1234][--table DSDT][--output filename]"
+                "[--binary][--length 0x456][--help]\n", progname);
+        puts("\t--addr 0x1234 or -a 0x1234 -- look for tables at this physical address");
+        puts("\t--table DSDT or -t DSDT -- only dump table with DSDT signature");
+        puts("\t--output filename or -o filename -- redirect output from stdin to filename");
+        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--help or -h -- this help message");
+        exit(0);
+}
+
+int main(int argc, char **argv)
+{
+        memset(select_sig, 0, 4);
+        print = 1;
+        connect = 0;
+        char *filename = 0;
+        addr = length = 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",
+                                    long_options, &option_index);
+                if (c == -1)
+                        break;
+
+                switch (c) {
+                case 0:
+                        switch (option_index) {
+                        case 0:
+                                addr = strtoul(optarg, (char **)NULL, 16);
+                                break;
+                        case 1:
+                                memcpy(select_sig, optarg, 4);
+                                break;
+                        case 2:
+                                filename = optarg;
+                                break;
+                        case 3:
+                                print = 0;
+                                break;
+                        case 4:
+                                length = strtoul(optarg, (char **)NULL, 16);
+                                break;
+                        case 5:
+                                usage(argv[0]);
+                                exit(0);
+                        }
+                        break;
+                case 'a':
+                        addr = strtoul(optarg, (char **)NULL, 16);
+                        break;
+                case 't':
+                        memcpy(select_sig, optarg, 4);
+                        break;
+                case 'o':
+                        filename = optarg;
+                        break;
+                case 'b':
+                        print = 0;
+                        break;
+                case 'l':
+                        length = strtoul(optarg, (char **)NULL, 16);
+                        break;
+                case 'h':
+                        usage(argv[0]);
+                        exit(0);
+                default:
+                        printf("Unknown option!\n");
+                        usage(argv[0]);
+                        exit(0);
+                }
+        }
+        
+        int 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)))
+                        goto not_found;
+                write(fd, raw, length);
+                acpi_unmap_memory(raw, length);
+                return 0;
+        }
+        
+        length = sizeof(struct acpi_rsdp_descriptor);
+        if (!addr) {
+                addr = read_efi_systab();
+                if (!addr) {
+                        addr = ACPI_HI_RSDP_WINDOW_BASE;
+                        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))) 
+                goto not_found;
+        
+        /* Find RSDP and print all found tables */
+        memcpy(&rsdpx, x, sizeof(struct acpi_rsdp_descriptor));
+        acpi_unmap_memory(raw, length);
+        if (connect) {
+                lseek(fd, sizeof(struct acpi_rsdp_descriptor), SEEK_SET);
+        }
+        if (!acpi_dump_SDT(fd, &rsdpx))
+                goto not_found;
+        if (connect) {
+                lseek(fd, 0, SEEK_SET);
+                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);
+                acpi_show_data(fd, (u8 *) & rsdpx, (rsdpx.revision < 2) ?
+                                ACPI_RSDP_CHECKSUM_LENGTH : ACPI_RSDP_XCHECKSUM_LENGTH);
+                buff[0] = '\n';
+                write(fd, buff, 1);
+        }
+        return 0;
+not_found:
+        fprintf(stderr, "ACPI tables were not found. If you know location "
+                "of RSD PTR table (from dmesg, etc), "
+                "supply it with either --addr or -a option\n");
+        return 1;
+}