inp.c
上传用户:wudi5211
上传日期:2010-01-21
资源大小:607k
文件大小:3k
源码类别:

嵌入式Linux

开发平台:

C/C++

  1. /* 
  2.  * inp.c -- read all the ports specified in hex on the command line.
  3.  *     The program uses the faster ioperm/iopl calls on x86, /dev/port
  4.  *     on other platforms. The program acts as inb/inw/inl according
  5.  *     to its own name
  6.  *
  7.  * Copyright (C) 1998,2000,2001 Alessandro Rubini
  8.  * 
  9.  *   This program is free software; you can redistribute it and/or modify
  10.  *   it under the terms of the GNU General Public License as published by
  11.  *   the Free Software Foundation; either version 2 of the License, or
  12.  *   (at your option) any later version.
  13.  *
  14.  *   This program is distributed in the hope that it will be useful,
  15.  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
  16.  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17.  *   GNU General Public License for more details.
  18.  *
  19.  *   You should have received a copy of the GNU General Public License
  20.  *   along with this program; if not, write to the Free Software
  21.  *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
  22.  */
  23. #include <stdio.h>
  24. #include <stdlib.h>
  25. #include <string.h>
  26. #include <unistd.h>
  27. #include <errno.h>
  28. #include <fcntl.h>
  29. #include <sys/types.h>
  30. #include <sys/stat.h>
  31. #include <asm/io.h> /* linux-specific */
  32. #ifdef __GLIBC__
  33. #  include <sys/perm.h>
  34. #endif
  35. #define PORT_FILE "/dev/port"
  36. char *prgname;
  37. #ifdef __i386__
  38. static int read_and_print_one(unsigned int port,int size)
  39. {
  40.     static int iopldone = 0;
  41.     if (port > 1024) {
  42. if (!iopldone && iopl(3)) {
  43.     fprintf(stderr, "%s: iopl(): %sn", prgname, strerror(errno));
  44.     return 1;
  45. }
  46. iopldone++;
  47.     } else if (ioperm(port,size,1)) {
  48. fprintf(stderr, "%s: ioperm(%x): %sn", prgname,
  49. port, strerror(errno));
  50. return 1;
  51.     }
  52.     if (size == 4)
  53. printf("%04x: %08xn", port, inl(port));
  54.     else if (size == 2)
  55. printf("%04x: %04xn", port, inw(port));
  56.     else
  57. printf("%04x: %02xn", port, inb(port));
  58.     return 0;
  59. }
  60. #else /* not i386 */
  61. static int read_and_print_one(unsigned int port,int size)
  62. {
  63.     static int fd = -1;
  64.     unsigned char b; unsigned short w; unsigned int l;
  65.     if (fd < 0)
  66. fd = open(PORT_FILE, O_RDONLY);
  67.     if (fd < 0) {
  68. fprintf(stderr, "%s: %s: %sn", prgname, PORT_FILE, strerror(errno));
  69. return 1;
  70.     }
  71.     lseek(fd, port, SEEK_SET);
  72.     
  73.     if (size == 4) {
  74. read(fd, &l, 4);
  75. printf("%04x: 0x%08xn", port, l);
  76.     } else if (size == 2) {
  77. read(fd, &w, 2);
  78. printf("%04x: 0x%04xn", port, w & 0xffff);
  79.     } else {
  80. read(fd, &b, 1);
  81. printf("%04x: 0x%02xn", port, b & 0xff);
  82.     }
  83.     return 0;
  84. }
  85. #endif /* i386 */
  86. int main(int argc, char **argv)
  87. {
  88.     unsigned int i, n, port, size, error = 0;
  89.     
  90.     prgname = argv[0];
  91.     /* find the data size */
  92.     switch (prgname[strlen(prgname)-1]) {
  93.         case 'w': size = 2; break;
  94.         case 'l': size = 4; break;
  95.         case 'b': case 'p': default:
  96.     size = 1;
  97.     }
  98.     setuid(0); /* if we're setuid, force it on */
  99.     for (i = 1; i < argc; i++) {
  100.         if ( sscanf(argv[i], "%x%n", &port, &n) < 1
  101.       || n != strlen(argv[i]) ) {
  102.     fprintf(stderr, "%s: argument "%s" is not a hex numbern",
  103.     argv[0], argv[i]);
  104.     error++; continue;
  105. }
  106. if (port & (size-1)) {
  107.     fprintf(stderr, "%s: argument "%s" is not properly alignedn",
  108.     argv[0], argv[i]);
  109.     error++; continue;
  110. }
  111. error += read_and_print_one(port, size);
  112.     }
  113.     exit (error ? 1 : 0);
  114. }