X-Git-Url: https://notaz.gp2x.de/cgi-bin/gitweb.cgi?a=blobdiff_plain;f=linux%2Fin_evdev.c;h=7795b69e6962669cb204fe6660f755b57da59bfe;hb=388947f33d88ce3de0d9cb3e873244fbb5162a59;hp=cfb31b6c2e9347c151c5a399247a49e1248e4d88;hpb=da767bd51b7532b822a28d5a2878a6cd80110675;p=libpicofe.git diff --git a/linux/in_evdev.c b/linux/in_evdev.c index cfb31b6..7795b69 100644 --- a/linux/in_evdev.c +++ b/linux/in_evdev.c @@ -1,4 +1,5 @@ #include +#include #include #include #include @@ -8,13 +9,26 @@ #include #include -#include "../common/common.h" #include "../common/input.h" #include "in_evdev.h" +typedef struct { + int fd; + int prev_update; + int abs_lzone; + int abs_rzone; + int abs_tzone; + int abs_bzone; + int abs_lastx; + int abs_lasty; +} in_evdev_t; + #define KEYBITS_BIT(x) (keybits[(x)/sizeof(keybits[0])/8] & \ (1 << ((x) & (sizeof(keybits[0])*8-1)))) +#define KEYBITS_BIT_SET(x) (keybits[(x)/sizeof(keybits[0])/8] |= \ + (1 << ((x) & (sizeof(keybits[0])*8-1)))) + static const char * const in_evdev_prefix = "evdev:"; static const char * const in_evdev_keys[KEY_MAX + 1] = { [0 ... KEY_MAX] = NULL, @@ -109,8 +123,10 @@ static void in_evdev_probe(void) for (i = 0;; i++) { - int u, ret, fd, keybits[(KEY_MAX+1)/sizeof(int)]; + int keybits[(KEY_MAX+1)/sizeof(int)], absbits[(ABS_MAX+1)/sizeof(int)]; int support = 0, count = 0; + in_evdev_t *dev; + int u, ret, fd; char name[64]; snprintf(name, sizeof(name), "/dev/input/event%d", i); @@ -143,11 +159,42 @@ static void in_evdev_probe(void) if (count == 0) goto skip; + dev = calloc(1, sizeof(*dev)); + if (dev == NULL) + goto skip; + + /* check for abs too */ + if (support & (1 << EV_ABS)) { + struct input_absinfo ainfo; + int dist; + ret = ioctl(fd, EVIOCGBIT(EV_ABS, sizeof(absbits)), absbits); + if (ret == -1) + goto no_abs; + if (absbits[0] & (1 << ABS_X)) { + ret = ioctl(fd, EVIOCGABS(ABS_X), &ainfo); + if (ret == -1) + goto no_abs; + dist = ainfo.maximum - ainfo.minimum; + dev->abs_lzone = ainfo.minimum + dist / 4; + dev->abs_rzone = ainfo.maximum - dist / 4; + } + if (absbits[0] & (1 << ABS_Y)) { + ret = ioctl(fd, EVIOCGABS(ABS_Y), &ainfo); + if (ret == -1) + goto no_abs; + dist = ainfo.maximum - ainfo.minimum; + dev->abs_tzone = ainfo.minimum + dist / 4; + dev->abs_bzone = ainfo.maximum - dist / 4; + } + } + +no_abs: + dev->fd = fd; strcpy(name, in_evdev_prefix); ioctl(fd, EVIOCGNAME(sizeof(name)-6), name+6); printf("in_evdev: found \"%s\" with %d events (type %08x)\n", name+6, count, support); - in_register(name, IN_DRVID_EVDEV, (void *)fd); + in_register(name, IN_DRVID_EVDEV, fd, dev, 0); continue; skip: @@ -157,7 +204,11 @@ skip: static void in_evdev_free(void *drv_data) { - close((int)drv_data); + in_evdev_t *dev = drv_data; + if (dev == NULL) + return; + close(dev->fd); + free(dev); } static int in_evdev_get_bind_count(void) @@ -165,16 +216,18 @@ static int in_evdev_get_bind_count(void) return KEY_MAX + 1; } +/* returns bitfield of binds of pressed buttons */ int in_evdev_update(void *drv_data, int *binds) { struct input_event ev[16]; + struct input_absinfo ainfo; int keybits[(KEY_MAX+1)/sizeof(int)]; - int fd = (int)drv_data; + in_evdev_t *dev = drv_data; int result = 0, changed = 0; int rd, ret, u; while (1) { - rd = read(fd, ev, sizeof(ev)); + rd = read(dev->fd, ev, sizeof(ev)); if (rd < (int)sizeof(ev[0])) { if (errno != EAGAIN) perror("in_evdev: read failed"); @@ -184,34 +237,50 @@ int in_evdev_update(void *drv_data, int *binds) changed = 1; } -/* if (!changed) - return 0; -*/ - ret = ioctl(fd, EVIOCGKEY(sizeof(keybits)), keybits); + return dev->prev_update; + + ret = ioctl(dev->fd, EVIOCGKEY(sizeof(keybits)), keybits); if (ret == -1) { perror("in_evdev: ioctl failed"); return 0; } - printf("#%d: ", fd); for (u = 0; u < KEY_MAX + 1; u++) { if (KEYBITS_BIT(u)) { - printf(" %d", u); result |= binds[u]; } } - printf("\n"); + /* map X and Y absolute to UDLR */ + if (dev->abs_lzone != 0) { + ret = ioctl(dev->fd, EVIOCGABS(ABS_X), &ainfo); + if (ret != -1) { + if (ainfo.value < dev->abs_lzone) result |= binds[KEY_LEFT]; + if (ainfo.value > dev->abs_rzone) result |= binds[KEY_RIGHT]; + } + } + if (dev->abs_tzone != 0) { + ret = ioctl(dev->fd, EVIOCGABS(ABS_Y), &ainfo); + if (ret != -1) { + if (ainfo.value < dev->abs_tzone) result |= binds[KEY_UP]; + if (ainfo.value > dev->abs_bzone) result |= binds[KEY_DOWN]; + } + } + + dev->prev_update = result; return result; } -static void in_evdev_set_blocking(void *data, int y) +static void in_evdev_set_blocking(void *drv_data, int y) { + in_evdev_t *dev = drv_data; long flags; int ret; - flags = (long)fcntl((int)data, F_GETFL); + dev->prev_update = 0; + + flags = (long)fcntl(dev->fd, F_GETFL); if ((int)flags == -1) { perror("in_evdev: F_GETFL fcntl failed"); return; @@ -220,72 +289,114 @@ static void in_evdev_set_blocking(void *data, int y) flags &= ~O_NONBLOCK; else flags |= O_NONBLOCK; - ret = fcntl((int)data, F_SETFL, flags); + ret = fcntl(dev->fd, F_SETFL, flags); if (ret == -1) perror("in_evdev: F_SETFL fcntl failed"); } -int in_evdev_update_keycode(void **data, int dcount, int *which, int *is_down) +static int in_evdev_update_keycode(void *data, int *is_down) { - const int *fds = (const int *)data; - int i, fdmax = -1; - - for (i = 0; i < dcount; i++) - if (fds[i] > fdmax) fdmax = fds[i]; - - while (1) - { - struct input_event ev[64]; - int ret, fd = -1, rd; - fd_set fdset; - - FD_ZERO(&fdset); - for (i = 0; i < dcount; i++) - FD_SET(fds[i], &fdset); - - ret = select(fdmax + 1, &fdset, NULL, NULL, NULL); - if (ret == -1) - { - perror("in_evdev: select failed"); - sleep(1); - return 0; - } + in_evdev_t *dev = data; + struct input_event ev; + int rd; - for (i = 0; i < dcount; i++) - if (FD_ISSET(fds[i], &fdset)) - *which = i, fd = fds[i]; + if (is_down != NULL) + *is_down = 0; - rd = read(fd, ev, sizeof(ev[0]) * 64); - if (rd < (int) sizeof(ev[0])) { + rd = read(dev->fd, &ev, sizeof(ev)); + if (rd < (int) sizeof(ev)) { + if (errno != EAGAIN) { perror("in_evdev: error reading"); sleep(1); - return 0; } + return -1; + } - for (i = 0; i < rd / sizeof(ev[0]); i++) - { - if (ev[i].type != EV_KEY || ev[i].value < 0 || ev[i].value > 1) - continue; - - if (is_down) - *is_down = ev[i].value; - return ev[i].code; + if (ev.type == EV_KEY) { + if (ev.value < 0 || ev.value > 1) + return -1; + if (is_down != NULL) + *is_down = ev.value; + return ev.code; + } + else if (ev.type == EV_ABS) + { + int down = 0; + if (dev->abs_lzone != 0 && ev.code == ABS_X) { + if (ev.value < dev->abs_lzone) { + down = 1; + dev->abs_lastx = KEY_LEFT; + } + else if (ev.value > dev->abs_rzone) { + down = 1; + dev->abs_lastx = KEY_RIGHT; + } + if (is_down != NULL) + *is_down = down; + return dev->abs_lastx; + } + if (dev->abs_tzone != 0 && ev.code == ABS_Y) { + if (ev.value < dev->abs_tzone) { + down = 1; + dev->abs_lasty = KEY_UP; + } + else if (ev.value > dev->abs_bzone) { + down = 1; + dev->abs_lasty = KEY_DOWN; + } + if (is_down != NULL) + *is_down = down; + return dev->abs_lasty; } } + + return -1; } +static const struct { + short key; + short pbtn; +} key_pbtn_map[] = +{ + { KEY_UP, PBTN_UP }, + { KEY_DOWN, PBTN_DOWN }, + { KEY_LEFT, PBTN_LEFT }, + { KEY_RIGHT, PBTN_RIGHT }, + { KEY_ENTER, PBTN_MOK }, + { BTN_A, PBTN_MOK }, + { BTN_TRIGGER, PBTN_MOK }, + { KEY_ESC, PBTN_MBACK }, + { BTN_B, PBTN_MBACK }, + { BTN_THUMB, PBTN_MBACK }, + { KEY_A, PBTN_MA2 }, + { KEY_S, PBTN_MA3 }, + { KEY_BACKSLASH, PBTN_MENU }, + { KEY_MENU, PBTN_MENU }, + { KEY_LEFTBRACE, PBTN_L }, + { KEY_RIGHTBRACE, PBTN_R }, +}; + +#define KEY_PBTN_MAP_SIZE (sizeof(key_pbtn_map) / sizeof(key_pbtn_map[0])) + static int in_evdev_menu_translate(int keycode) { - switch (keycode) { - /* keyboards */ - case KEY_UP: return PBTN_UP; - case KEY_DOWN: return PBTN_DOWN; - case KEY_LEFT: return PBTN_LEFT; - case KEY_RIGHT: return PBTN_RIGHT; - case KEY_ENTER: return PBTN_EAST; - case KEY_ESC: return PBTN_SOUTH; - default: return 0; + int i; + if (keycode < 0) + { + /* menu -> kc */ + keycode = -keycode; + for (i = 0; i < KEY_PBTN_MAP_SIZE; i++) + if (key_pbtn_map[i].pbtn == keycode) + return key_pbtn_map[i].key; + } + else + { + for (i = 0; i < KEY_PBTN_MAP_SIZE; i++) + if (key_pbtn_map[i].key == keycode) + return key_pbtn_map[i].pbtn; } + + return 0; } static int in_evdev_get_key_code(const char *key_name) @@ -294,8 +405,7 @@ static int in_evdev_get_key_code(const char *key_name) for (i = 0; i < KEY_MAX + 1; i++) { const char *k = in_evdev_keys[i]; - if (k != NULL && k[0] == key_name[0] && - strcasecmp(k, key_name) == 0) + if (k != NULL && strcasecmp(k, key_name) == 0) return i; } @@ -324,9 +434,15 @@ static const struct { { KEY_LEFT, 2 }, { KEY_RIGHT, 3 }, { KEY_S, 4 }, /* B */ + { BTN_B, 4 }, { KEY_D, 5 }, /* C */ + { BTN_A, 5 }, { KEY_A, 6 }, /* A */ + { BTN_Y, 6 }, { KEY_ENTER, 7 }, + { BTN_START, 7 }, + { BTN_TL, PEVB_STATE_LOAD }, + { BTN_TR, PEVB_STATE_SAVE }, }; #define DEF_BIND_COUNT (sizeof(in_evdev_def_binds) / sizeof(in_evdev_def_binds[0])) @@ -339,18 +455,28 @@ static void in_evdev_get_def_binds(int *binds) binds[in_evdev_def_binds[i].code] = 1 << in_evdev_def_binds[i].bit; } -/* remove bad binds, count good ones */ +/* remove binds of missing keys, count remaining ones */ static int in_evdev_clean_binds(void *drv_data, int *binds) { int keybits[(KEY_MAX+1)/sizeof(int)]; + in_evdev_t *dev = drv_data; int i, ret, count = 0; - ret = ioctl((int)drv_data, EVIOCGBIT(EV_KEY, sizeof(keybits)), keybits); + ret = ioctl(dev->fd, EVIOCGBIT(EV_KEY, sizeof(keybits)), keybits); if (ret == -1) { perror("in_evdev: ioctl failed"); memset(keybits, 0xff, sizeof(keybits)); /* mark all as good */ } + if (dev->abs_lzone != 0) { + KEYBITS_BIT_SET(KEY_LEFT); + KEYBITS_BIT_SET(KEY_RIGHT); + } + if (dev->abs_tzone != 0) { + KEYBITS_BIT_SET(KEY_UP); + KEYBITS_BIT_SET(KEY_DOWN); + } + for (i = 0; i < KEY_MAX + 1; i++) { if (!KEYBITS_BIT(i)) binds[i] = binds[i + KEY_MAX + 1] = 0; @@ -372,6 +498,7 @@ void in_evdev_init(void *vdrv) drv->get_def_binds = in_evdev_get_def_binds; drv->clean_binds = in_evdev_clean_binds; drv->set_blocking = in_evdev_set_blocking; + drv->update_keycode = in_evdev_update_keycode; drv->menu_translate = in_evdev_menu_translate; drv->get_key_code = in_evdev_get_key_code; drv->get_key_name = in_evdev_get_key_name;