util/superiotool/superiotool.c

   1 /*
   2  * This file is part of the LinuxBIOS project.
   3  *
   4  * Copyright (C) 2006 Ronald Minnich <rminnich@gmail.com>
   5  * Copyright (C) 2007 Uwe Hermann <uwe@hermann-uwe.de>
   6  * Copyright (C) 2007 Carl-Daniel Hailfinger
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License as published by
  10  * the Free Software Foundation; either version 2 of the License, or
  11  * (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
  21  */
  22
  23 #include "superiotool.h"
  24
  25 uint8_t regval(uint16_t port, uint8_t reg)
  26 {
  27         outb(reg, port);
  28         return inb(port + 1);
  29 }
  30
  31 void regwrite(uint16_t port, uint8_t reg, uint8_t val)
  32 {
  33         outb(reg, port);
  34         outb(val, port + 1);
  35 }
  36
  37 void dump_superio(const char *vendor, const struct superio_registers reg_table[],
  38                   uint16_t port, uint16_t id)
  39 {
  40         int i, j, k, nodump;
  41         int *idx;
  42
  43         for (i = 0; /* Nothing */; i++) {
  44                 if (reg_table[i].superio_id == EOT)
  45                         break;
  46
  47                 if ((uint16_t)reg_table[i].superio_id != id)
  48                         continue;
  49
  50                 nodump = 1;
  51
  52                 for (j = 0; /* Nothing */; j++) {
  53                         if (reg_table[i].ldn[j].ldn == EOT)
  54                                 break;
  55
  56                         printf("%s %s\n", vendor, reg_table[i].name);
  57                         nodump = 0;
  58
  59                         if (reg_table[i].ldn[j].ldn != NOLDN) {
  60                                 printf("Switching to LDN 0x%02x\n",
  61                                        reg_table[i].ldn[j].ldn);
  62                                 regwrite(port, 0x07, reg_table[i].ldn[j].ldn);
  63                         }
  64
  65                         idx = reg_table[i].ldn[j].idx;
  66
  67                         printf("idx ");
  68                         for (k = 0; /* Nothing */; k++) {
  69                                 if (idx[k] == EOT)
  70                                         break;
  71                                 printf("%02x ", idx[k]);
  72                         }
  73
  74                         printf("\nval ");
  75                         for (k = 0; /* Nothing */; k++) {
  76                                 if (idx[k] == EOT)
  77                                         break;
  78                                 printf("%02x ", regval(port, idx[k]));
  79                         }
  80
  81                         printf("\ndef ");
  82                         idx = reg_table[i].ldn[j].def;
  83                         for (k = 0; /* Nothing */; k++) {
  84                                 if (idx[k] == EOT)
  85                                         break;
  86                                 else if (idx[k] == NANA)
  87                                         printf("NA ");
  88                                 else if (idx[k] == RSVD)
  89                                         printf("RR ");
  90                                 else
  91                                         printf("%02x ", idx[k]);
  92                         }
  93                         printf("\n");
  94                 }
  95
  96                 if (nodump)
  97                         printf("No dump for %s %s\n", vendor, reg_table[i].name);
  98         }
  99 }
 100
 101 int main(int argc, char *argv[])
 102 {
 103         int i, j;
 104
 105         if (iopl(3) < 0) {
 106                 perror("iopl");
 107                 exit(1);
 108         }
 109
 110         for (i = 0; i < ARRAY_SIZE(superio_ports_table); i++) {
 111                 for (j = 0; superio_ports_table[i].ports[j] != EOT; j++)
 112                         superio_ports_table[i].probe_idregs(
 113                                 superio_ports_table[i].ports[j]);
 114         }
 115
 116         return 0;
 117 }