| 1 | #include <stdio.h> |
| 2 | #include <string.h> |
| 3 | #include <sys/types.h> |
| 4 | #include <sys/stat.h> |
| 5 | #include <fcntl.h> |
| 6 | #include <sys/ioctl.h> |
| 7 | #include <unistd.h> |
| 8 | #include <linux/input.h> |
| 9 | #include <errno.h> |
| 10 | |
| 11 | #include "../common/input.h" |
| 12 | #include "event.h" |
| 13 | |
| 14 | #define BIT(x) (keybits[(x)/sizeof(keybits[0])/8] & \ |
| 15 | (1 << ((x) & (sizeof(keybits[0])*8-1)))) |
| 16 | |
| 17 | int in_evdev_probe(void) |
| 18 | { |
| 19 | int i; |
| 20 | |
| 21 | for (i = 0;; i++) |
| 22 | { |
| 23 | int u, ret, fd, keybits[KEY_MAX/sizeof(int)]; |
| 24 | int support = 0, count = 0; |
| 25 | char name[64]; |
| 26 | |
| 27 | snprintf(name, sizeof(name), "/dev/input/event%d", i); |
| 28 | fd = open(name, O_RDONLY|O_NONBLOCK); |
| 29 | if (fd == -1) |
| 30 | break; |
| 31 | |
| 32 | /* check supported events */ |
| 33 | ret = ioctl(fd, EVIOCGBIT(0, sizeof(support)), &support); |
| 34 | if (ret == -1) { |
| 35 | printf("in_evdev: ioctl failed on %s\n", name); |
| 36 | goto skip; |
| 37 | } |
| 38 | |
| 39 | if (!(support & (1 << EV_KEY))) |
| 40 | goto skip; |
| 41 | |
| 42 | ret = ioctl(fd, EVIOCGBIT(EV_KEY, sizeof(keybits)), keybits); |
| 43 | if (ret == -1) { |
| 44 | printf("in_evdev: ioctl failed on %s\n", name); |
| 45 | goto skip; |
| 46 | } |
| 47 | |
| 48 | /* check for interesting keys */ |
| 49 | for (u = 0; u < KEY_MAX; u++) { |
| 50 | if (BIT(u) && u != KEY_POWER && u != KEY_SLEEP) |
| 51 | count++; |
| 52 | } |
| 53 | |
| 54 | if (count == 0) |
| 55 | goto skip; |
| 56 | |
| 57 | strcpy(name, "evdev:"); |
| 58 | ioctl(fd, EVIOCGNAME(sizeof(name)-6), name+6); |
| 59 | printf("in_evdev: found \"%s\" with %d events (type %08x)\n", |
| 60 | name+6, count, support); |
| 61 | in_register(name, IN_DRVID_EVDEV, (void *)fd); |
| 62 | continue; |
| 63 | |
| 64 | skip: |
| 65 | close(fd); |
| 66 | } |
| 67 | |
| 68 | return 0; |
| 69 | } |
| 70 | |
| 71 | void in_evdev_free(void *drv_data) |
| 72 | { |
| 73 | close((int)drv_data); |
| 74 | } |
| 75 | |
| 76 | int in_evdev_bind_count(void) |
| 77 | { |
| 78 | return 512; |
| 79 | } |
| 80 | |
| 81 | int in_evdev_update(void *drv_data, int *binds) |
| 82 | { |
| 83 | struct input_event ev[16]; |
| 84 | int keybits[KEY_MAX/sizeof(int)]; |
| 85 | int fd = (int)drv_data; |
| 86 | int result = 0, changed = 0; |
| 87 | int rd, ret, u; |
| 88 | |
| 89 | while (1) { |
| 90 | rd = read(fd, ev, sizeof(ev)); |
| 91 | if (rd < (int)sizeof(ev[0])) { |
| 92 | if (errno != EAGAIN) |
| 93 | perror("in_evdev: read failed"); |
| 94 | break; |
| 95 | } |
| 96 | |
| 97 | changed = 1; |
| 98 | } |
| 99 | |
| 100 | /* |
| 101 | if (!changed) |
| 102 | return 0; |
| 103 | */ |
| 104 | ret = ioctl(fd, EVIOCGKEY(sizeof(keybits)), keybits); |
| 105 | if (ret == -1) { |
| 106 | perror("in_evdev: ioctl failed"); |
| 107 | return 0; |
| 108 | } |
| 109 | |
| 110 | printf("#%d: ", fd); |
| 111 | for (u = 0; u < KEY_MAX; u++) { |
| 112 | if (BIT(u)) { |
| 113 | printf(" %d", u); |
| 114 | result |= binds[u]; |
| 115 | } |
| 116 | } |
| 117 | printf("\n"); |
| 118 | |
| 119 | return result; |
| 120 | } |
| 121 | |