// gpio_cmd.cc // nono - programme du robot 2004. {{{ // // Copyright (C) 2004 Nicolas Schodet // // Robot APB Team/Efrei 2004. // Web: http://assos.efrei.fr/robot/ // Email: robot AT efrei DOT fr // // 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 "gpio_cmd.h" #include "gpio.h" #include "date/date.h" #include #include const char gpioHelp[] = " o set une sortie.\n" " i get une entrée.\n" " j attend que l'entrée passe à bit.\n" " O set des sorties.\n" " I get des entrées.\n" " d dir des entrées/sorties.\n"; bool gpioCmd (int argc, char **argv, int &i, Gpio &gpio) { static bool inJack = false; int n, nb; unsigned bits, bit; switch (argv[i][0]) { case 'o': i++; if (i >= argc) break; n = gpio.getByName (argv[i]); if (n == -1) n = atoi (argv[i]); i++; if (i >= argc) break; bit = atoi (argv[i++]); std::cout << "test: set " << n << ' ' << bit << std::endl; gpio.set (n, bit); break; case 'O': i++; if (i >= argc) break; n = atoi (argv[i++]); if (i >= argc) break; bits = atoi (argv[i++]); if (i >= argc) break; nb = atoi (argv[i++]); std::cout << "test: set " << n << " 0x" << std::hex << bits << std::dec << ' ' << nb << std::endl; gpio.set (n, bits, nb); break; case 'i': i++; if (i >= argc) break; n = gpio.getByName (argv[i]); if (n == -1) n = atoi (argv[i]); i++; std::cout << "test: get " << n << std::endl; bit = gpio.get (n); std::cout << "test: get result " << bit << std::endl; break; case 'j': i++; if (i >= argc) break; n = gpio.getByName (argv[i]); if (n == -1) n = atoi (argv[i]); i++; if (i >= argc) break; bit = atoi (argv[i++]); if (!inJack) std::cout << "test: jack " << n << ' ' << bit << std::endl; if (gpio.get (n) != bit) { i -= 3; inJack = true; Date::wait (50); } else { inJack = false; } break; case 'I': i++; if (i >= argc) break; n = atoi (argv[i++]); if (i >= argc) break; nb = atoi (argv[i++]); std::cout << "test: get " << n << ' ' << nb << std::endl; bits = gpio.get (n, nb); std::cout << "test: get result 0x" << std::hex << bits << std::dec << std::endl; break; case 'd': i++; if (i >= argc) break; n = atoi (argv[i++]); if (i >= argc) break; bits = atoi (argv[i++]); if (i >= argc) break; nb = atoi (argv[i++]); std::cout << "test: dir " << n << ' ' << std::hex << bits << std::dec << ' ' << nb << std::endl; gpio.dir (n, bits, nb); break; default: return false; } return true; }