#include <stdio.h>
+#include <stdlib.h>
#include <string.h>
#include <sys/types.h>
#include <sys/stat.h>
#include "../common/input.h"
#include "in_evdev.h"
-#define BIT(x) (keybits[(x)/sizeof(keybits[0])/8] & \
+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))))
-static const char *in_evdev_keys[KEY_MAX + 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,
[KEY_RESERVED] = "Reserved", [KEY_ESC] = "Esc",
[KEY_1] = "1", [KEY_2] = "2",
};
-int in_evdev_probe(void)
+static void in_evdev_probe(void)
{
int i;
for (i = 0;; i++)
{
- int u, ret, fd, keybits[KEY_MAX/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);
}
/* check for interesting keys */
- for (u = 0; u < KEY_MAX; u++) {
- if (BIT(u) && u != KEY_POWER && u != KEY_SLEEP)
+ for (u = 0; u < KEY_MAX + 1; u++) {
+ if (KEYBITS_BIT(u) && u != KEY_POWER && u != KEY_SLEEP)
count++;
}
if (count == 0)
goto skip;
- strcpy(name, "evdev:");
+ 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, dev);
continue;
skip:
close(fd);
}
-
- return 0;
}
-void in_evdev_free(void *drv_data)
+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);
}
-int in_evdev_bind_count(void)
+static int in_evdev_get_bind_count(void)
{
- return 512;
+ 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];
- int keybits[KEY_MAX/sizeof(int)];
- int fd = (int)drv_data;
+ struct input_absinfo ainfo;
+ int keybits[(KEY_MAX+1)/sizeof(int)];
+ 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");
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; u++) {
- if (BIT(u)) {
- printf(" %d", u);
+ for (u = 0; u < KEY_MAX + 1; u++) {
+ if (KEYBITS_BIT(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;
}
-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;
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)
+int in_evdev_update_keycode(void **data, int dcount, int *which, int *is_down, int timeout_ms)
{
- const int *fds = (const int *)data;
+ in_evdev_t **devs = (in_evdev_t **)data;
+ struct timeval tv, *timeout = NULL;
int i, fdmax = -1;
+ if (timeout_ms >= 0) {
+ tv.tv_sec = timeout_ms / 1000;
+ tv.tv_usec = (timeout_ms % 1000) * 1000;
+ timeout = &tv;
+ }
+
+ if (is_down != NULL)
+ *is_down = 0;
+
for (i = 0; i < dcount; i++)
- if (fds[i] > fdmax) fdmax = fds[i];
+ if (devs[i]->fd > fdmax) fdmax = devs[i]->fd;
while (1)
{
- struct input_event ev[64];
- int ret, fd = -1, rd;
+ struct input_event ev;
+ in_evdev_t *dev = NULL;
+ int ret, rd;
fd_set fdset;
FD_ZERO(&fdset);
for (i = 0; i < dcount; i++)
- FD_SET(fds[i], &fdset);
+ FD_SET(devs[i]->fd, &fdset);
- ret = select(fdmax + 1, &fdset, NULL, NULL, NULL);
+ ret = select(fdmax + 1, &fdset, NULL, NULL, timeout);
if (ret == -1)
{
perror("in_evdev: select failed");
return 0;
}
+ if (ret == 0)
+ return 0; /* timeout */
+
for (i = 0; i < dcount; i++)
- if (FD_ISSET(fds[i], &fdset))
- *which = i, fd = fds[i];
+ if (FD_ISSET(devs[i]->fd, &fdset))
+ *which = i, dev = devs[i];
- 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)) {
perror("in_evdev: error reading");
sleep(1);
return 0;
}
- for (i = 0; i < rd / sizeof(ev[0]); i++)
- {
- if (ev[i].type != EV_KEY || ev[i].value < 0 || ev[i].value > 1)
+ if (ev.type == EV_KEY) {
+ if (ev.value < 0 || ev.value > 1)
continue;
-
- if (is_down)
- *is_down = ev[i].value;
- return ev[i].code;
+ 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;
+ }
}
}
}
-int in_evdev_menu_translate(int keycode)
+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;
+ case KEY_ENTER:
+ case BTN_A:
+ case BTN_TRIGGER: return PBTN_MOK;
+ case KEY_ESC:
+ case BTN_B:
+ case BTN_THUMB: return PBTN_MBACK;
+ case KEY_MENU: return PBTN_MENU;
default: return 0;
}
}
-const char *in_evdev_get_key_name(int keycode)
+static int in_evdev_get_key_code(const char *key_name)
+{
+ int i;
+
+ 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)
+ return i;
+ }
+
+ return -1;
+}
+
+static const char *in_evdev_get_key_name(int keycode)
{
const char *name = NULL;
- if (keycode >= 0 && keycode < KEY_MAX)
+ if (keycode >= 0 && keycode <= KEY_MAX)
name = in_evdev_keys[keycode];
if (name == NULL)
name = "Unkn";
return name;
}
+static const struct {
+ short code;
+ short bit;
+} in_evdev_def_binds[] =
+{
+ /* MXYZ SACB RLDU */
+ { KEY_UP, 0 },
+ { KEY_DOWN, 1 },
+ { 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 },
+};
+
+#define DEF_BIND_COUNT (sizeof(in_evdev_def_binds) / sizeof(in_evdev_def_binds[0]))
+
+static void in_evdev_get_def_binds(int *binds)
+{
+ int i;
+
+ for (i = 0; i < DEF_BIND_COUNT; i++)
+ binds[in_evdev_def_binds[i].code] = 1 << in_evdev_def_binds[i].bit;
+}
+
+/* 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(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;
+ if (binds[i])
+ count++;
+ }
+
+ return count;
+}
+
+void in_evdev_init(void *vdrv)
+{
+ in_drv_t *drv = vdrv;
+
+ drv->prefix = in_evdev_prefix;
+ drv->probe = in_evdev_probe;
+ drv->free = in_evdev_free;
+ drv->get_bind_count = in_evdev_get_bind_count;
+ drv->get_def_binds = in_evdev_get_def_binds;
+ drv->clean_binds = in_evdev_clean_binds;
+ drv->set_blocking = in_evdev_set_blocking;
+ 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;
+}
+