--- embedtools/src/pceng_run.c 2011/07/25 09:13:34 1.1.2.4 +++ embedtools/src/pceng_run.c 2012/04/05 12:22:44 1.1.2.10 @@ -3,7 +3,7 @@ * by Michael Pounov * * $Author: misho $ - * $Id: pceng_run.c,v 1.1.2.4 2011/07/25 09:13:34 misho Exp $ + * $Id: pceng_run.c,v 1.1.2.10 2012/04/05 12:22:44 misho Exp $ * ************************************************************************* The ELWIX and AITNET software is distributed under the following @@ -12,7 +12,7 @@ terms: All of the documentation and software included in the ELWIX and AITNET Releases is copyrighted by ELWIX - Sofia/Bulgaria -Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011 +Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012 by Michael Pounov . All rights reserved. Redistribution and use in source and binary forms, with or without @@ -47,9 +47,9 @@ SUCH DAMAGE. #include "pceng.h" -const u_int led_base[2][4] = {{0xf410, 0xf400, 0xf400, 0xf400}, +const u_int led_base[2][MAX_GPIO_PINS] = {{0xf410, 0xf400, 0xf400, 0xf400}, {0x61b0, 0x6100, 0x6180, 0x6180}}; -const int led_bit[2][4] = {{8, 2, 3, 18}, {8, 6, 9, 11}}; +const int led_bit[2][MAX_GPIO_PINS] = {{8, 2, 3, 18}, {8, 6, 9, 11}}; const int gpio_off[2] = { 0x4, 0x10 }; @@ -57,25 +57,26 @@ static inline board_t getBoard() { board_t type; - char szStr[STRSIZ]; + ait_val_t v; FTRACE(3); - cfg_LoadAttribute(&cfg, CFG("pceng"), CFG("board"), CFG(szStr), sizeof szStr, DEFAULT_BOARD); - if (!strcasecmp(szStr, "alix")) + cfg_loadAttribute(&cfg, "pceng", "board", &v, DEFAULT_BOARD); + if (!strcasecmp(AIT_GET_STR(&v), "alix")) type = alix; - else if (!strcasecmp(szStr, "wrap")) + else if (!strcasecmp(AIT_GET_STR(&v), "wrap")) type = wrap; else { type = unknown; - syslog(LOG_ERR, "Error:: unknown board type %s", szStr); + syslog(LOG_ERR, "Error:: unknown board type %s", AIT_GET_STR(&v)); } + AIT_FREE_VAL(&v); return type; } static u_int -gpioRead(u_char ledno, u_char state) +gpioRead(u_char ledno) { u_int n; board_t type = getBoard(); @@ -116,6 +117,7 @@ LED(u_char ledno, u_char state) switch (type) { case wrap: n = inl(led_base[type - 1][ledno]); + /* read */ if (state == (u_char) -1) return (n &= (1 << led_bit[type - 1][ledno])); @@ -125,6 +127,7 @@ LED(u_char ledno, u_char state) n &= ~(1 << led_bit[type - 1][ledno]); break; case alix: + /* read */ if (state == (u_char) -1) { n = inl(led_base[type - 1][ledno]); return !(n &= (1 << led_bit[type - 1][ledno])); @@ -135,18 +138,104 @@ LED(u_char ledno, u_char state) else n = (1 << led_bit[type - 1][ledno]); break; - default: + default: /* unknown */ return -1; } outl(led_base[type - 1][ledno], n); + return (int) state; +} + +static int +RunCmd(u_char pin, u_int state) +{ + char szArg[STRSIZ] = { 0 }; + ait_val_t v; + + FTRACE(3); + + switch (pin) { + case 0: /* button */ + cfg_loadAttribute(&cfg, "event", "button_exec", &v, NULL); + break; + case 1: /* LEDs */ + case 2: + case 3: + cfg_loadAttribute(&cfg, "event", "led_exec", &v, NULL); + break; + } + if (AIT_ISEMPTY(&v)) + return 0; + if (pin) + snprintf(szArg, sizeof szArg, "%d=%d", pin, state); + else + snprintf(szArg, sizeof szArg, "%d", state); + + switch (fork()) { + case -1: + syslog(LOG_ERR, "Error:: RunCmd #%d - %s\n", errno, strerror(errno)); + AIT_FREE_VAL(&v); + return -1; + case 0: /* execute command */ + return execl(AIT_GET_STR(&v), AIT_GET_STR(&v), szArg, NULL); + } + + AIT_FREE_VAL(&v); return 0; } int Run() { + register u_char i; + u_int ret, t, slice, states = 0; + ait_val_t v; + FTRACE(3); + + /* init array */ + for (i = 0; i < MAX_GPIO_PINS; i++) + if ((ret = gpioRead(i)) == -1) + return 126; + else + states |= ret ? (1 << i) : 0; + + /* state machine */ + while (!Kill) { + cfg_loadAttribute(&cfg, "event", "button_slice", &v, DEFAULT_SLICE); + slice = strtol(AIT_GET_STR(&v), NULL, 0); + AIT_FREE_VAL(&v); + if (!slice) + slice = strtol(DEFAULT_SLICE, NULL, 0); + slice *= 1000; + + for (i = t = 0; i < MAX_GPIO_PINS; t = 0, i++) { + if ((ret = gpioRead(i)) == -1) + return 127; + + if (ret != ((states >> i) & 0x1)) { + if (!i) { /* button */ + t = 0; + do { + t++; + usleep(slice); + if (gpioRead(i) != ret) + break; + } while (!Kill); + } else { /* leds */ + t = ret; + if (ret) + states |= (1 << i); + else + states &= ~(1 << i); + } + + RunCmd(i, t); + } + } + + usleep(slice); + } return 0; }