Add constants for fast path resume copying

[coreboot.git] / util / superiotool / superiotool.c

diff --git a/util/superiotool/superiotool.c b/util/superiotool/superiotool.c
index 1edaf30f8679a215ea5d4e4f8e8c436234971260..293aaa617d018ef156abe976668616fab4d50862 100644 (file)
--- a/util/superiotool/superiotool.c
+++ b/util/superiotool/superiotool.c
@@ -23,6 +23,11 @@
 
 #include "superiotool.h"
 
+#if defined(__FreeBSD__)
+#include <fcntl.h>
+#include <unistd.h>
+#endif
+
 /* Command line options. */
 int dump = 0, verbose = 0, extra_dump = 0;
 
@@ -31,33 +36,45 @@ int chip_found = 0;
 
 uint8_t regval(uint16_t port, uint8_t reg)
 {
-       outb(reg, port);
-       return inb(port + 1);
+       OUTB(reg, port);
+       return INB(port + ((port == 0x3bd) ? 2 : 1)); /* 0x3bd is special. */
 }
 
 void regwrite(uint16_t port, uint8_t reg, uint8_t val)
 {
-       outb(reg, port);
-       outb(val, port + 1);
+       OUTB(reg, port);
+       OUTB(val, port + 1);
 }
 
 void enter_conf_mode_winbond_fintek_ite_8787(uint16_t port)
 {
-       outb(0x87, port);
-       outb(0x87, port);
+       OUTB(0x87, port);
+       OUTB(0x87, port);
 }
 
 void exit_conf_mode_winbond_fintek_ite_8787(uint16_t port)
 {
-       outb(0xaa, port);               /* Fintek, Winbond */
+       OUTB(0xaa, port);               /* Fintek, Winbond */
        regwrite(port, 0x02, 0x02);     /* ITE */
 }
 
+void enter_conf_mode_fintek_7777(uint16_t port)
+{
+       OUTB(0x77, port);
+       OUTB(0x77, port);
+}
+
+void exit_conf_mode_fintek_7777(uint16_t port)
+{
+       OUTB(0xaa, port);               /* Fintek */
+}
+
 int superio_unknown(const struct superio_registers reg_table[], uint16_t id)
 {
        return !strncmp(get_superio_name(reg_table, id), "<unknown>", 9);
 }
 
+
 const char *get_superio_name(const struct superio_registers reg_table[],
                             uint16_t id)
 {
@@ -77,18 +94,21 @@ const char *get_superio_name(const struct superio_registers reg_table[],
 }
 
 static void dump_regs(const struct superio_registers reg_table[],
-                     int i, int j, uint16_t port)
+                     int i, int j, uint16_t port, uint8_t ldn_sel)
 {
        int k;
-       const int *idx;
+       const int16_t *idx;
 
        if (reg_table[i].ldn[j].ldn != NOLDN) {
                printf("LDN 0x%02x", reg_table[i].ldn[j].ldn);
                if (reg_table[i].ldn[j].name != NULL)
                        printf(" (%s)", reg_table[i].ldn[j].name);
-               regwrite(port, 0x07, reg_table[i].ldn[j].ldn);
+               regwrite(port, ldn_sel, reg_table[i].ldn[j].ldn);
        } else {
-               printf("Register dump:");
+               if (reg_table[i].ldn[j].name == NULL)
+                       printf("Register dump:");
+               else
+                       printf("(%s)", reg_table[i].ldn[j].name);
        }
 
        idx = reg_table[i].ldn[j].idx;
@@ -126,7 +146,7 @@ static void dump_regs(const struct superio_registers reg_table[],
 
 void dump_superio(const char *vendor,
                  const struct superio_registers reg_table[],
-                 uint16_t port, uint16_t id)
+                 uint16_t port, uint16_t id, uint8_t ldn_sel)
 {
        int i, j, no_dump_available = 1;
 
@@ -144,7 +164,7 @@ void dump_superio(const char *vendor,
                        if (reg_table[i].ldn[j].ldn == EOT)
                                break;
                        no_dump_available = 0;
-                       dump_regs(reg_table, i, j, port);
+                       dump_regs(reg_table, i, j, port, ldn_sel);
                }
 
                if (no_dump_available)
@@ -152,14 +172,27 @@ void dump_superio(const char *vendor,
        }
 }
 
+void dump_io(uint16_t iobase, uint16_t length)
+{
+       uint16_t i;
+
+       printf("Dumping %d I/O mapped registers at base 0x%04x:\n",
+                       length, iobase);
+       for (i = 0; i < length; i++)
+               printf("%02x ", i);
+       printf("\n");
+       for (i = 0; i < length; i++)
+               printf("%02x ", INB(iobase + i));
+       printf("\n");
+}
+
 void probing_for(const char *vendor, const char *info, uint16_t port)
 {
        if (!verbose)
                return;
 
        /* Yes, there's no space between '%s' and 'at'! */
-       printf("Probing for %s Super I/O %sat 0x%x...\n",
-              vendor, info, port);
+       printf("Probing for %s Super I/O %sat 0x%x...\n", vendor, info, port);
 }
 
 /** Print a list of all supported chips from the given vendor. */
@@ -205,6 +238,9 @@ static void print_version(void)
 int main(int argc, char *argv[])
 {
        int i, j, opt, option_index;
+#if defined(__FreeBSD__)
+       int io_fd;
+#endif
 
        static const struct option long_options[] = {
                {"dump",                no_argument, NULL, 'd'},
@@ -238,6 +274,7 @@ int main(int argc, char *argv[])
                        break;
                case 'h':
                        printf(USAGE);
+                       printf(USAGE_INFO);
                        exit(0);
                        break;
                default:
@@ -247,14 +284,26 @@ int main(int argc, char *argv[])
                }
        }
 
+#if defined(__FreeBSD__)
+       if ((io_fd = open("/dev/io", O_RDWR)) < 0) {
+               perror("/dev/io");
+#else
        if (iopl(3) < 0) {
                perror("iopl");
+#endif
                printf("Superiotool must be run as root.\n");
                exit(1);
        }
 
        print_version();
 
+#ifdef PCI_SUPPORT
+       /* Do some basic libpci init. */
+       pacc = pci_alloc();
+       pci_init(pacc);
+       pci_scan_bus(pacc);
+#endif
+
        for (i = 0; i < ARRAY_SIZE(superio_ports_table); i++) {
                for (j = 0; superio_ports_table[i].ports[j] != EOT; j++)
                        superio_ports_table[i].probe_idregs(
@@ -264,5 +313,8 @@ int main(int argc, char *argv[])
        if (!chip_found)
                printf("No Super I/O found\n");
 
+#if defined(__FreeBSD__)
+       close(io_fd);
+#endif
        return 0;
 }