started evdev implementation

git-svn-id: file:///home/notaz/opt/svn/PicoDrive/platform@617 be3aeb3a-fb24-0410-a615-afba39da0efa

diff --git a/linux/event.c b/linux/event.c
new file mode 100644 (file)
index 0000000..dea5072
--- /dev/null
+++ b/linux/event.c
@@ -0,0 +1,142 @@
+#include <stdio.h>
+#include <string.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <fcntl.h>
+#include <sys/ioctl.h>
+#include <unistd.h>
+#include <linux/input.h>
+#include <errno.h>
+
+#include "event.h"
+
+#define NUM_DEVS       8
+#define NUM_KEYS_DOWN  16
+
+#define BIT(x) (keybits[(x)/sizeof(keybits[0])/8] & \
+       (1 << ((x) & (sizeof(keybits[0])*8-1))))
+
+static int event_fds[NUM_DEVS];
+static int event_fd_count = 0;
+
+int in_event_init(void)
+{
+       int i;
+
+       in_event_exit();
+
+       for (i = 0; event_fd_count < NUM_DEVS; i++)
+       {
+               int u, ret, fd, keybits[KEY_MAX/sizeof(int)];
+               int support = 0, count = 0;
+               char name[64];
+
+               snprintf(name, sizeof(name), "/dev/input/event%d", i);
+               fd = open(name, O_RDONLY|O_NONBLOCK);
+               if (fd == -1)
+                       break;
+
+               /* check supported events */
+               ret = ioctl(fd, EVIOCGBIT(0, sizeof(support)), &support);
+               if (ret == -1) {
+                       printf("in_event: ioctl failed on %s\n", name);
+                       goto skip;
+               }
+
+               if (!(support & (1 << EV_KEY)))
+                       goto skip;
+
+               ret = ioctl(fd, EVIOCGBIT(EV_KEY, sizeof(keybits)), keybits);
+               if (ret == -1) {
+                       printf("in_event: ioctl failed on %s\n", name);
+                       goto skip;
+               }
+
+               printf("%s: %08x\n", name, support);
+
+               /* check for interesting keys */
+               for (u = 0; u < KEY_MAX; u++) {
+                       if (BIT(u) && u != KEY_POWER)
+                               count++;
+               }
+
+               if (count == 0)
+                       goto skip;
+
+               ioctl(fd, EVIOCGNAME(sizeof(name)), name);
+               printf("event: %d: using \"%s\" with %d events\n",
+                       event_fd_count, name, count);
+               event_fds[event_fd_count++] = fd;
+               continue;
+
+skip:
+               close(fd);
+       }
+
+       printf("event: %d devices found.\n", event_fd_count);
+       return 0;
+}
+
+void in_event_exit(void)
+{
+       for (; event_fd_count > 0; event_fd_count--)
+               close(event_fds[event_fd_count - 1]);
+}
+
+int in_event_update(int binds[512])
+{
+       struct input_event ev[16];
+       int d, rd, ret;
+       int result = 0;
+
+       for (d = 0; d < event_fd_count; d++)
+       {
+               int keybits[KEY_MAX/sizeof(int)];
+               int fd = event_fds[d];
+               int u, changed = 0;
+
+               while (1) {
+                       rd = read(fd, ev, sizeof(ev));
+                       if (rd < (int)sizeof(ev[0])) {
+                               if (errno != EAGAIN)
+                                       perror("event: read failed");
+                               break;
+                       }
+
+                       changed = 1;
+               }
+
+               if (!changed)
+                       continue;
+
+               ret = ioctl(fd, EVIOCGKEY(sizeof(keybits)), keybits);
+               if (ret == -1) {
+                       printf("in_event: ioctl failed on %d\n", d);
+                       continue;
+               }
+
+               for (u = 0; u < KEY_MAX; u++) {
+                       if (BIT(u)) {
+                               printf(" %d", u);
+                               result |= binds[u];
+                       }
+               }
+               printf("\n");
+       }
+
+       return result;
+}
+
+int main()
+{
+       in_event_init();
+
+       while (1) {
+               int b[512];
+               in_event_update(b);
+               sleep(1);
+       }
+
+       return 0;
+}
+

diff --git a/linux/event.h b/linux/event.h
new file mode 100644 (file)
index 0000000..9ea887a
--- /dev/null
+++ b/linux/event.h
@@ -0,0 +1,3 @@
+int in_event_init(void);
+void in_event_exit(void);
+int in_event_update(int binds[512]);