Superiotool: Add dump support to the Winbond W83697HF/F.

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

diff --git a/util/superiotool/superiotool.c b/util/superiotool/superiotool.c
index fd49c309eef86a90156a36d6025bc54612f7a805..8aea0a02d98b42586f909b6103929368be2d66b3 100644 (file)
--- a/util/superiotool/superiotool.c
+++ b/util/superiotool/superiotool.c
@@ -22,6 +22,9 @@
 
 #include "superiotool.h"
 
+/* Command line options. */
+int dump = 0, verbose = 0;
+
 uint8_t regval(uint16_t port, uint8_t reg)
 {
        outb(reg, port);
@@ -34,11 +37,15 @@ void regwrite(uint16_t port, uint8_t reg, uint8_t val)
        outb(val, port + 1);
 }
 
-void dump_superio(const char *vendor, const struct superio_registers reg_table[],
-                 uint16_t port, uint16_t id)
+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)
 {
-       int i, j, k, nodump;
-       int *idx;
+       int i;
 
        for (i = 0; /* Nothing */; i++) {
                if (reg_table[i].superio_id == EOT)
@@ -47,63 +54,138 @@ void dump_superio(const char *vendor, const struct superio_registers reg_table[]
                if ((uint16_t)reg_table[i].superio_id != id)
                        continue;
 
-               nodump = 1;
+               return reg_table[i].name;
+       }
+
+       return "<unknown>";
+}
+
+static void dump_regs(const struct superio_registers reg_table[],
+                     int i, int j, uint16_t port)
+{
+       int k, *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);
+       } else {
+               printf("Register dump:");
+       }
+
+       idx = reg_table[i].ldn[j].idx;
+
+       printf("\nidx ");
+       for (k = 0; /* Nothing */; k++) {
+               if (idx[k] == EOT)
+                       break;
+               printf("%02x ", idx[k]);
+       }
+
+       printf("\nval ");
+       for (k = 0; /* Nothing */; k++) {
+               if (idx[k] == EOT)
+                       break;
+               printf("%02x ", regval(port, idx[k]));
+       }
+
+       printf("\ndef ");
+       idx = reg_table[i].ldn[j].def;
+       for (k = 0; /* Nothing */; k++) {
+               if (idx[k] == EOT)
+                       break;
+               else if (idx[k] == NANA)
+                       printf("NA ");
+               else if (idx[k] == RSVD)
+                       printf("RR ");
+               else if (idx[k] == MISC)        /* TODO */
+                       printf("MM ");
+               else
+                       printf("%02x ", idx[k]);
+       }
+       printf("\n");
+}
+
+void dump_superio(const char *vendor,
+                 const struct superio_registers reg_table[],
+                 uint16_t port, uint16_t id)
+{
+       int i, j, no_dump_available = 1;
+
+       if (!dump)
+               return;
+
+       for (i = 0; /* Nothing */; i++) {
+               if (reg_table[i].superio_id == EOT)
+                       break;
+
+               if ((uint16_t)reg_table[i].superio_id != id)
+                       continue;
 
                for (j = 0; /* Nothing */; j++) {
                        if (reg_table[i].ldn[j].ldn == EOT)
                                break;
-
-                       printf("%s %s\n", vendor, reg_table[i].name);
-                       nodump = 0;
-
-                       if (reg_table[i].ldn[j].ldn != NOLDN) {
-                               printf("Switching to LDN 0x%02x\n",
-                                      reg_table[i].ldn[j].ldn);
-                               regwrite(port, 0x07, reg_table[i].ldn[j].ldn);
-                       }
-
-                       idx = reg_table[i].ldn[j].idx;
-
-                       printf("idx ");
-                       for (k = 0; /* Nothing */; k++) {
-                               if (idx[k] == EOT)
-                                       break;
-                               printf("%02x ", idx[k]);
-                       }
-
-                       printf("\nval ");
-                       for (k = 0; /* Nothing */; k++) {
-                               if (idx[k] == EOT)
-                                       break;
-                               printf("%02x ", regval(port, idx[k]));
-                       }
-
-                       printf("\ndef ");
-                       idx = reg_table[i].ldn[j].def;
-                       for (k = 0; /* Nothing */; k++) {
-                               if (idx[k] == EOT)
-                                       break;
-                               else if (idx[k] == NANA)
-                                       printf("NA ");
-                               else if (idx[k] == RSVD)
-                                       printf("RR ");
-                               else
-                                       printf("%02x ", idx[k]);
-                       }
-                       printf("\n");
+                       no_dump_available = 0;
+                       dump_regs(reg_table, i, j, port);
                }
 
-               if (nodump)
-                       printf("No dump for %s %s\n", vendor, reg_table[i].name);
+               if (no_dump_available)
+                       printf("No dump available for this Super I/O\n");
        }
 }
 
+void no_superio_found(uint16_t port)
+{
+       if (!verbose)
+               return;
+
+       if (inb(port) == 0xff)
+               printf("No Super I/O chip found at 0x%04x\n", port);
+       else
+               printf("Probing 0x%04x, failed (0x%02x), data returns 0x%02x\n",
+                      port, inb(port), inb(port + 1));
+}
+
 int main(int argc, char *argv[])
 {
-       int i, j;
+       int i, j, opt, option_index;
+
+       const static struct option long_options[] = {
+               {"dump",        no_argument, NULL, 'd'},
+               {"verbose",     no_argument, NULL, 'V'},
+               {"version",     no_argument, NULL, 'v'},
+               {"help",        no_argument, NULL, 'h'},
+               {0, 0, 0, 0}
+       };
+
+       while ((opt = getopt_long(argc, argv, "dVvh",
+                                 long_options, &option_index)) != EOF) {
+               switch (opt) {
+               case 'd':
+                       dump = 1;
+                       break;
+               case 'V':
+                       verbose = 1;
+                       break;
+               case 'v':
+                       printf("superiotool %s\n", SUPERIOTOOL_VERSION);
+                       exit(0);
+                       break;
+               case 'h':
+                       printf(USAGE);
+                       exit(0);
+                       break;
+               default:
+                       /* Unknown option. */
+                       exit(1);
+                       break;
+               }
+       }
 
        if (iopl(3) < 0) {
                perror("iopl");
+               printf("Superiotool must be run as root.\n");
                exit(1);
        }