started evdev implementation

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

platform/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;
+}
+

platform/linux/event.h

@@ -0,0 +1,3 @@
+int in_event_init(void);
+void in_event_exit(void);
+int in_event_update(int binds[512]);