嵌入式Linux

开发平台：

C/C++

outp.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
 */
#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(): %sn", prgname, strerror(errno));
	    return 1;
	}
	iopldone++;
    } else if (ioperm(port,size,1)) {
	fprintf(stderr, "%s: ioperm(%x): %sn", 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: %sn", 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 numbern",
		    argv[0], argv[i]);
	    error++; continue;
	}
	if (port & (size-1)) {
	    fprintf(stderr, "%s: argument "%s" is not properly alignedn",
		    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 numbern",
		    argv[0], argv[i+1]);
	    error++; continue;
	}
	if (size < 4 && val > (size == 1 ? 0xff : 0xffff)) {
	    fprintf(stderr, "%s: argument "%s" out of rangen",
		    argv[0], argv[i+1]);
	    error++; continue;
	}
	error += write_one(port, val, size);
    }
    exit (error ? 1 : 0);
}

						