Add port tool

diff --git a/tools/Makefile b/tools/Makefile
index 1cd4d812ef0b34cdc78a231996164d415504abff..7402d797f6adfd47640927cfcea6687aa9fc4347 100644 (file)
--- a/tools/Makefile
+++ b/tools/Makefile
@@ -1,9 +1,17 @@
 CFLAGS=-I../include
 CC=gcc
-SMRAM_ICH2_OBJS=smram-linux-tool.o ../pci/pci-linux.o ../ich2/smram-ich2.o
+SMRAM_ICH2_OBJS=smram-linux-tool.o ../pci/pci-linux.o ../ich2/smram-ich2.noraw.o
+
+all: smram-ich2 port
+
+%.noraw.o: %.c
+       gcc $(CFLAGS) -c -o $@ $<
 
 smram-ich2: $(SMRAM_ICH2_OBJS)
-       gcc -o smram-ich2 $(SMRAM_ICH2_OBJS)
+       gcc $(CFLAGS) -o smram-ich2 $(SMRAM_ICH2_OBJS)
+
+port: port.o
+       gcc -o port port.o
 
 clean:
        rm -f $(SMRAM_ICH2_OBJS) smram-ich2

diff --git a/tools/port.c b/tools/port.c
new file mode 100644 (file)
index 0000000..c939913
--- /dev/null
+++ b/tools/port.c
@@ -0,0 +1,69 @@
+#include <sys/io.h>
+#include <string.h>
+
+int main(int argc, char **argv)
+{
+       unsigned int port;
+       unsigned char type = 'b';
+       unsigned int datum;
+       
+       if (iopl(3) < 0)
+       {
+               perror("iopl");
+               return 1;
+       }
+       
+       if ((argc < 2) || (argc > 4))
+       {
+       usage:
+               printf("usage: %s port [b|w|l [datum]]\n", argv[0]);
+               return 2;
+       }
+       
+       port = strtoul(argv[1], NULL, 0);
+       
+       if (argc > 2)
+               type = *argv[2];
+       
+       if (argc > 3)
+       {
+               datum = strtoul(argv[3], NULL, 0);
+               switch (type)
+               {
+               case 'b':
+                       datum &= 0xFF;
+                       outb(datum, port);
+                       printf("Wrote byte 0x%02x to port 0x%04x\n", datum, port);
+                       break;
+               case 'w':
+                       datum &= 0xFFFF;
+                       outw(datum, port);
+                       printf("Wrote word 0x%04x to port 0x%04x\n", datum, port);
+                       break;
+               case 'l':
+                       outb(datum, port);
+                       printf("Wrote long 0x%08x to port 0x%04x\n", datum, port);
+                       break;
+               default:
+                       goto usage;
+               }
+       } else {
+               switch(type)
+               {
+               case 'b':
+                       datum = inb(port);
+                       printf("Read byte 0x%02x from port 0x%04x\n", datum, port);
+                       break;
+               case 'w':
+                       datum = inw(port);
+                       printf("Read word 0x%04x from port 0x%04x\n", datum, port);
+                       break;
+               case 'l':
+                       datum = inl(port);
+                       printf("Read long 0x%08x from port 0x%04x\n", datum, port);
+                       break;
+               default:
+                       goto usage;
+               }
+       }
+}