release/src/router/rc/gpio.c

   1 /*
   2
   3         Tomato Firmware
   4         Copyright (C) 2006-2009 Jonathan Zarate
   5
   6 */
   7 #include "rc.h"
   8
   9 int gpio_main(int argc, char *argv[])
  10 {
  11         const char hex[] = "0123456789ABCDEF";
  12         unsigned long v;
  13         int bit;
  14         int i;
  15         char s[17];
  16
  17         if (argc == 3) {
  18                 bit = atoi(argv[2]);
  19                 if ((bit >= 0) && (bit <= 15)) {
  20                         bit = 1 << bit;
  21                         if ((strncmp(argv[1], "en", 2) == 0) || (strncmp(argv[1], "di", 2) == 0)) {
  22                                 gpio_write(bit, argv[1][0] == 'e');
  23                                 return 0;
  24                         }
  25                 }
  26         }
  27         else if (argc == 2) {
  28                 if (strncmp(argv[1], "po", 2) == 0) {
  29                         while ((v = gpio_read()) != ~0) {
  30                                 for (i = 15; i >= 0; --i) {
  31                                         s[i] = (v & (1 << i)) ? hex[i] : '.';
  32                                 }
  33                                 s[16] = 0;
  34                                 printf("%08lX %s\n", v, s);
  35                                 sleep(1);
  36                         }
  37                         return 0;
  38                 }
  39         }
  40
  41         usage_exit(argv[0], "<enable|disable|poll> <pin>\n");
  42 }