version 1.1.2.1, 2011/07/22 14:20:24
|
version 1.1.2.8, 2011/10/24 20:32:11
|
Line 47 SUCH DAMAGE.
|
Line 47 SUCH DAMAGE.
|
#include "pceng.h" |
#include "pceng.h" |
|
|
|
|
|
const u_int led_base[2][MAX_GPIO_PINS] = {{0xf410, 0xf400, 0xf400, 0xf400}, |
|
{0x61b0, 0x6100, 0x6180, 0x6180}}; |
|
const int led_bit[2][MAX_GPIO_PINS] = {{8, 2, 3, 18}, {8, 6, 9, 11}}; |
|
const int gpio_off[2] = { 0x4, 0x10 }; |
|
|
|
|
|
static inline board_t |
|
getBoard() |
|
{ |
|
board_t type; |
|
char szStr[STRSIZ]; |
|
|
|
FTRACE(3); |
|
|
|
cfg_LoadAttribute(&cfg, CFG("pceng"), CFG("board"), CFG(szStr), sizeof szStr, DEFAULT_BOARD); |
|
if (!strcasecmp(szStr, "alix")) |
|
type = alix; |
|
else if (!strcasecmp(szStr, "wrap")) |
|
type = wrap; |
|
else { |
|
type = unknown; |
|
syslog(LOG_ERR, "Error:: unknown board type %s", szStr); |
|
} |
|
|
|
return type; |
|
} |
|
|
|
static u_int |
|
gpioRead(u_char ledno) |
|
{ |
|
u_int n; |
|
board_t type = getBoard(); |
|
|
|
FTRACE(3); |
|
|
|
switch (type) { |
|
case wrap: |
|
n = inl(led_base[type - 1][ledno] + gpio_off[type - 1]); |
|
if (n & (1 << led_bit[type - 1][ledno])) |
|
n = 1; |
|
else |
|
n = 0; |
|
break; |
|
case alix: |
|
n = inl(led_base[type - 1][ledno]); |
|
if (n & (1 << led_bit[type - 1][ledno])) |
|
n = 0; |
|
else |
|
n = 1; |
|
break; |
|
default: |
|
return -1; |
|
} |
|
|
|
return n; |
|
} |
|
|
|
|
int |
int |
Run(int io) | LED(u_char ledno, u_char state) |
{ |
{ |
|
u_int n; |
|
board_t type = getBoard(); |
|
|
FTRACE(3); |
FTRACE(3); |
|
|
|
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])); |
|
|
|
if (state) |
|
n |= (1 << led_bit[type - 1][ledno]); |
|
else |
|
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])); |
|
} |
|
|
|
if (state) |
|
n = (1 << (led_bit[type - 1][ledno] + gpio_off[type - 1])); |
|
else |
|
n = (1 << led_bit[type - 1][ledno]); |
|
break; |
|
default: /* unknown */ |
|
return -1; |
|
} |
|
|
|
outl(led_base[type - 1][ledno], n); |
|
return (int) state; |
|
} |
|
|
|
static int |
|
RunCmd(u_char pin, u_int state) |
|
{ |
|
char szStr[STRSIZ], szArg[STRSIZ] = { 0 }; |
|
|
|
FTRACE(3); |
|
|
|
switch (pin) { |
|
case 0: /* button */ |
|
cfg_LoadAttribute(&cfg, CFG("event"), CFG("button_exec"), |
|
CFG(szStr), sizeof szStr, NULL); |
|
break; |
|
case 1: /* LEDs */ |
|
case 2: |
|
case 3: |
|
cfg_LoadAttribute(&cfg, CFG("event"), CFG("led_exec"), |
|
CFG(szStr), sizeof szStr, NULL); |
|
break; |
|
} |
|
if (!*szStr) |
|
return 0; |
|
else |
|
snprintf(szArg, sizeof szArg, "%d", state); |
|
|
|
switch (fork()) { |
|
case -1: |
|
syslog(LOG_ERR, "Error:: RunCmd #%d - %s\n", errno, strerror(errno)); |
|
return -1; |
|
case 0: /* execute command */ |
|
return execl(szStr, szStr, szArg, NULL); |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
int |
|
Run() |
|
{ |
|
register u_char i; |
|
u_int ret, t, slice, states = 0; |
|
char szStr[STRSIZ]; |
|
|
|
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, CFG("event"), CFG("button_slice"), |
|
CFG(szStr), sizeof szStr, DEFAULT_SLICE); |
|
slice = strtol(szStr, NULL, 0); |
|
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; |
return 0; |
} |
} |