1 files changed, 136 insertions, 0 deletions
diff --git a/misc-progs/outp.c b/misc-progs/outp.c
new file mode 100644
index 0000000..219d613
--- /dev/null
+++ b/misc-progs/outp.c
@@ -0,0 +1,136 @@
+/* 
+ * outp.c -- write all the ports specified in hex on the command line.
+ *     The program uses the faster ioperm/iopl calls on x86, /dev/port
+ *     on other platforms. The program acts as outb/outw/outl according
+ *     to its own name
+ *
+ * Copyright (C) 1998,2000,2001 Alessandro Rubini
+ * 
+ *   This program is free software; you can redistribute it and/or modify
+ *   it under the terms of the GNU General Public License as published by
+ *   the Free Software Foundation; either version 2 of the License, or
+ *   (at your option) any later version.
+ *
+ *   This program is distributed in the hope that it will be useful,
+ *   but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *   GNU General Public License for more details.
+ *
+ *   You should have received a copy of the GNU General Public License
+ *   along with this program; if not, write to the Free Software
+ *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <unistd.h>
+#include <errno.h>
+#include <fcntl.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+
+#include <asm/io.h> /* linux-specific */
+
+#ifdef __GLIBC__
+#  include <sys/perm.h>
+#endif
+
+#define PORT_FILE "/dev/port"
+
+char *prgname;
+
+#ifdef __i386__
+static int write_one(unsigned int port, unsigned int val, int size)
+{
+    static int iopldone = 0;
+
+    if (port > 1024) {
+	if (!iopldone && iopl(3)) {
+	    fprintf(stderr, "%s: iopl(): %s\n", prgname, strerror(errno));
+	    return 1;
+	}
+	iopldone++;
+    } else if (ioperm(port,size,1)) {
+	fprintf(stderr, "%s: ioperm(%x): %s\n", prgname,
+		port, strerror(errno));
+	return 1;
+    }
+
+    if (size == 4)
+	outl(val, port);
+    else if (size == 2)
+	outw(val&0xffff, port);
+    else
+	outb(val&0xff, port);
+    return 0;
+}
+#else /* not i386 */
+
+static int write_one(unsigned int port, unsigned int val, int size)
+{
+    static int fd = -1;
+    unsigned char b; unsigned short w;
+
+    if (fd < 0)
+	fd = open(PORT_FILE, O_WRONLY);
+    if (fd < 0) {
+	fprintf(stderr, "%s: %s: %s\n", prgname, PORT_FILE, strerror(errno));
+	return 1;
+    }
+    lseek(fd, port, SEEK_SET);
+    
+    if (size == 4) {
+	write(fd, &val, 4);
+    } else if (size == 2) {
+	w = val;
+	write(fd, &w, 2);
+    } else {
+	b = val;
+	write(fd, &b, 1);
+    }
+    return 0;
+}
+
+#endif /* i386 */
+
+int main(int argc, char **argv)
+{
+    unsigned int i, n, port, val, size, error = 0;
+    
+    prgname = argv[0];
+    /* find the data size */
+    switch (prgname[strlen(prgname)-1]) {
+        case 'w': size = 2; break;
+        case 'l': size = 4; break;
+        case 'b': case 'p': default:
+	    size = 1;
+    }
+    setuid(0); /* if we're setuid, force it on */
+    for (i=1;i<argc-1;i++) {
+        if ( sscanf(argv[i], "%x%n", &port, &n) < 1
+	      || n != strlen(argv[i]) ) {
+	    fprintf(stderr, "%s: argument \"%s\" is not a hex number\n",
+		    argv[0], argv[i]);
+	    error++; continue;
+	}
+	if (port & (size-1)) {
+	    fprintf(stderr, "%s: argument \"%s\" is not properly aligned\n",
+		    argv[0], argv[i]);
+	    error++; continue;
+	}
+        if ( sscanf(argv[i+1], "%x%n", &val, &n) < 1
+	      || n != strlen(argv[i+1]) ) {
+	    fprintf(stderr, "%s: argument \"%s\" is not a hex number\n",
+		    argv[0], argv[i+1]);
+	    error++; continue;
+	}
+	if (size < 4 && val > (size == 1 ? 0xff : 0xffff)) {
+	    fprintf(stderr, "%s: argument \"%s\" out of range\n",
+		    argv[0], argv[i+1]);
+	    error++; continue;
+	}
+	error += write_one(port, val, size);
+    }
+    exit (error ? 1 : 0);
+}