137 lines
3.5 KiB
C
137 lines
3.5 KiB
C
/*
|
|
* 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);
|
|
}
|