more input wip
[libpicofe.git] / linux / in_evdev.c
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/common.h"
12 #include "../common/input.h"
13 #include "in_evdev.h"
14
15 #define BIT(x) (keybits[(x)/sizeof(keybits[0])/8] & \
16         (1 << ((x) & (sizeof(keybits[0])*8-1))))
17
18 static const char *in_evdev_keys[KEY_MAX + 1] = {
19         [0 ... KEY_MAX] = NULL,
20         [KEY_RESERVED] = "Reserved",            [KEY_ESC] = "Esc",
21         [KEY_1] = "1",                          [KEY_2] = "2",
22         [KEY_3] = "3",                          [KEY_4] = "4",
23         [KEY_5] = "5",                          [KEY_6] = "6",
24         [KEY_7] = "7",                          [KEY_8] = "8",
25         [KEY_9] = "9",                          [KEY_0] = "0",
26         [KEY_MINUS] = "Minus",                  [KEY_EQUAL] = "Equal",
27         [KEY_BACKSPACE] = "Backspace",          [KEY_TAB] = "Tab",
28         [KEY_Q] = "Q",                          [KEY_W] = "W",
29         [KEY_E] = "E",                          [KEY_R] = "R",
30         [KEY_T] = "T",                          [KEY_Y] = "Y",
31         [KEY_U] = "U",                          [KEY_I] = "I",
32         [KEY_O] = "O",                          [KEY_P] = "P",
33         [KEY_LEFTBRACE] = "LeftBrace",          [KEY_RIGHTBRACE] = "RightBrace",
34         [KEY_ENTER] = "Enter",                  [KEY_LEFTCTRL] = "LeftControl",
35         [KEY_A] = "A",                          [KEY_S] = "S",
36         [KEY_D] = "D",                          [KEY_F] = "F",
37         [KEY_G] = "G",                          [KEY_H] = "H",
38         [KEY_J] = "J",                          [KEY_K] = "K",
39         [KEY_L] = "L",                          [KEY_SEMICOLON] = "Semicolon",
40         [KEY_APOSTROPHE] = "Apostrophe",        [KEY_GRAVE] = "Grave",
41         [KEY_LEFTSHIFT] = "LeftShift",          [KEY_BACKSLASH] = "BackSlash",
42         [KEY_Z] = "Z",                          [KEY_X] = "X",
43         [KEY_C] = "C",                          [KEY_V] = "V",
44         [KEY_B] = "B",                          [KEY_N] = "N",
45         [KEY_M] = "M",                          [KEY_COMMA] = "Comma",
46         [KEY_DOT] = "Dot",                      [KEY_SLASH] = "Slash",
47         [KEY_RIGHTSHIFT] = "RightShift",        [KEY_KPASTERISK] = "KPAsterisk",
48         [KEY_LEFTALT] = "LeftAlt",              [KEY_SPACE] = "Space",
49         [KEY_CAPSLOCK] = "CapsLock",            [KEY_F1] = "F1",
50         [KEY_F2] = "F2",                        [KEY_F3] = "F3",
51         [KEY_F4] = "F4",                        [KEY_F5] = "F5",
52         [KEY_F6] = "F6",                        [KEY_F7] = "F7",
53         [KEY_F8] = "F8",                        [KEY_F9] = "F9",
54         [KEY_F10] = "F10",                      [KEY_NUMLOCK] = "NumLock",
55         [KEY_SCROLLLOCK] = "ScrollLock",        [KEY_KP7] = "KP7",
56         [KEY_KP8] = "KP8",                      [KEY_KP9] = "KP9",
57         [KEY_KPMINUS] = "KPMinus",              [KEY_KP4] = "KP4",
58         [KEY_KP5] = "KP5",                      [KEY_KP6] = "KP6",
59         [KEY_KPPLUS] = "KPPlus",                [KEY_KP1] = "KP1",
60         [KEY_KP2] = "KP2",                      [KEY_KP3] = "KP3",
61         [KEY_KP0] = "KP0",                      [KEY_KPDOT] = "KPDot",
62         [KEY_ZENKAKUHANKAKU] = "Zenkaku/Hankaku", [KEY_102ND] = "102nd",
63         [KEY_F11] = "F11",                      [KEY_F12] = "F12",
64         [KEY_KPJPCOMMA] = "KPJpComma",          [KEY_KPENTER] = "KPEnter",
65         [KEY_RIGHTCTRL] = "RightCtrl",          [KEY_KPSLASH] = "KPSlash",
66         [KEY_SYSRQ] = "SysRq",                  [KEY_RIGHTALT] = "RightAlt",
67         [KEY_LINEFEED] = "LineFeed",            [KEY_HOME] = "Home",
68         [KEY_UP] = "Up",                        [KEY_PAGEUP] = "PageUp",
69         [KEY_LEFT] = "Left",                    [KEY_RIGHT] = "Right",
70         [KEY_END] = "End",                      [KEY_DOWN] = "Down",
71         [KEY_PAGEDOWN] = "PageDown",            [KEY_INSERT] = "Insert",
72         [KEY_DELETE] = "Delete",                [KEY_MACRO] = "Macro",
73         [KEY_HELP] = "Help",                    [KEY_MENU] = "Menu",
74         [KEY_COFFEE] = "Coffee",                [KEY_DIRECTION] = "Direction",
75         [BTN_0] = "Btn0",                       [BTN_1] = "Btn1",
76         [BTN_2] = "Btn2",                       [BTN_3] = "Btn3",
77         [BTN_4] = "Btn4",                       [BTN_5] = "Btn5",
78         [BTN_6] = "Btn6",                       [BTN_7] = "Btn7",
79         [BTN_8] = "Btn8",                       [BTN_9] = "Btn9",
80         [BTN_LEFT] = "LeftBtn",                 [BTN_RIGHT] = "RightBtn",
81         [BTN_MIDDLE] = "MiddleBtn",             [BTN_SIDE] = "SideBtn",
82         [BTN_EXTRA] = "ExtraBtn",               [BTN_FORWARD] = "ForwardBtn",
83         [BTN_BACK] = "BackBtn",                 [BTN_TASK] = "TaskBtn",
84         [BTN_TRIGGER] = "Trigger",              [BTN_THUMB] = "ThumbBtn",
85         [BTN_THUMB2] = "ThumbBtn2",             [BTN_TOP] = "TopBtn",
86         [BTN_TOP2] = "TopBtn2",                 [BTN_PINKIE] = "PinkieBtn",
87         [BTN_BASE] = "BaseBtn",                 [BTN_BASE2] = "BaseBtn2",
88         [BTN_BASE3] = "BaseBtn3",               [BTN_BASE4] = "BaseBtn4",
89         [BTN_BASE5] = "BaseBtn5",               [BTN_BASE6] = "BaseBtn6",
90         [BTN_DEAD] = "BtnDead",                 [BTN_A] = "BtnA",
91         [BTN_B] = "BtnB",                       [BTN_C] = "BtnC",
92         [BTN_X] = "BtnX",                       [BTN_Y] = "BtnY",
93         [BTN_Z] = "BtnZ",                       [BTN_TL] = "BtnTL",
94         [BTN_TR] = "BtnTR",                     [BTN_TL2] = "BtnTL2",
95         [BTN_TR2] = "BtnTR2",                   [BTN_SELECT] = "BtnSelect",
96         [BTN_START] = "BtnStart",               [BTN_MODE] = "BtnMode",
97         [BTN_THUMBL] = "BtnThumbL",             [BTN_THUMBR] = "BtnThumbR",
98         [BTN_TOUCH] = "Touch",                  [BTN_STYLUS] = "Stylus",
99         [BTN_STYLUS2] = "Stylus2",              [BTN_TOOL_DOUBLETAP] = "Tool Doubletap",
100         [BTN_TOOL_TRIPLETAP] = "Tool Tripletap", [BTN_GEAR_DOWN] = "WheelBtn",
101         [BTN_GEAR_UP] = "Gear up",              [KEY_OK] = "Ok",
102 };
103
104
105 int in_evdev_probe(void)
106 {
107         int i;
108
109         for (i = 0;; i++)
110         {
111                 int u, ret, fd, keybits[KEY_MAX/sizeof(int)];
112                 int support = 0, count = 0;
113                 char name[64];
114
115                 snprintf(name, sizeof(name), "/dev/input/event%d", i);
116                 fd = open(name, O_RDONLY|O_NONBLOCK);
117                 if (fd == -1)
118                         break;
119
120                 /* check supported events */
121                 ret = ioctl(fd, EVIOCGBIT(0, sizeof(support)), &support);
122                 if (ret == -1) {
123                         printf("in_evdev: ioctl failed on %s\n", name);
124                         goto skip;
125                 }
126
127                 if (!(support & (1 << EV_KEY)))
128                         goto skip;
129
130                 ret = ioctl(fd, EVIOCGBIT(EV_KEY, sizeof(keybits)), keybits);
131                 if (ret == -1) {
132                         printf("in_evdev: ioctl failed on %s\n", name);
133                         goto skip;
134                 }
135
136                 /* check for interesting keys */
137                 for (u = 0; u < KEY_MAX; u++) {
138                         if (BIT(u) && u != KEY_POWER && u != KEY_SLEEP)
139                                 count++;
140                 }
141
142                 if (count == 0)
143                         goto skip;
144
145                 strcpy(name, "evdev:");
146                 ioctl(fd, EVIOCGNAME(sizeof(name)-6), name+6);
147                 printf("in_evdev: found \"%s\" with %d events (type %08x)\n",
148                         name+6, count, support);
149                 in_register(name, IN_DRVID_EVDEV, (void *)fd);
150                 continue;
151
152 skip:
153                 close(fd);
154         }
155
156         return 0;
157 }
158
159 void in_evdev_free(void *drv_data)
160 {
161         close((int)drv_data);
162 }
163
164 int in_evdev_bind_count(void)
165 {
166         return 512;
167 }
168
169 int in_evdev_update(void *drv_data, int *binds)
170 {
171         struct input_event ev[16];
172         int keybits[KEY_MAX/sizeof(int)];
173         int fd = (int)drv_data;
174         int result = 0, changed = 0;
175         int rd, ret, u;
176
177         while (1) {
178                 rd = read(fd, ev, sizeof(ev));
179                 if (rd < (int)sizeof(ev[0])) {
180                         if (errno != EAGAIN)
181                                 perror("in_evdev: read failed");
182                         break;
183                 }
184
185                 changed = 1;
186         }
187
188 /*
189         if (!changed)
190                 return 0;
191 */
192         ret = ioctl(fd, EVIOCGKEY(sizeof(keybits)), keybits);
193         if (ret == -1) {
194                 perror("in_evdev: ioctl failed");
195                 return 0;
196         }
197
198         printf("#%d: ", fd);
199         for (u = 0; u < KEY_MAX; u++) {
200                 if (BIT(u)) {
201                         printf(" %d", u);
202                         result |= binds[u];
203                 }
204         }
205         printf("\n");
206
207         return result;
208 }
209
210 void in_evdev_set_blocking(void *data, int y)
211 {
212         long flags;
213         int ret;
214
215         flags = (long)fcntl((int)data, F_GETFL);
216         if ((int)flags == -1) {
217                 perror("in_evdev: F_GETFL fcntl failed");
218                 return;
219         }
220         if (y)
221                 flags &= ~O_NONBLOCK;
222         else
223                 flags |=  O_NONBLOCK;
224         ret = fcntl((int)data, F_SETFL, flags);
225         if (ret == -1)
226                 perror("in_evdev: F_SETFL fcntl failed");
227 }
228
229 int in_evdev_update_keycode(void **data, int dcount, int *which, int *is_down)
230 {
231         const int *fds = (const int *)data;
232         int i, fdmax = -1;
233
234         for (i = 0; i < dcount; i++)
235                 if (fds[i] > fdmax) fdmax = fds[i];
236
237         while (1)
238         {
239                 struct input_event ev[64];
240                 int ret, fd = -1, rd;
241                 fd_set fdset;
242
243                 FD_ZERO(&fdset);
244                 for (i = 0; i < dcount; i++)
245                         FD_SET(fds[i], &fdset);
246
247                 ret = select(fdmax + 1, &fdset, NULL, NULL, NULL);
248                 if (ret == -1)
249                 {
250                         perror("in_evdev: select failed");
251                         sleep(1);
252                         return 0;
253                 }
254
255                 for (i = 0; i < dcount; i++)
256                         if (FD_ISSET(fds[i], &fdset))
257                                 *which = i, fd = fds[i];
258
259                 rd = read(fd, ev, sizeof(ev[0]) * 64);
260                 if (rd < (int) sizeof(ev[0])) {
261                         perror("in_evdev: error reading");
262                         sleep(1);
263                         return 0;
264                 }
265
266                 for (i = 0; i < rd / sizeof(ev[0]); i++)
267                 {
268                         if (ev[i].type != EV_KEY || ev[i].value < 0 || ev[i].value > 1)
269                                 continue;
270
271                         if (is_down)
272                                 *is_down = ev[i].value;
273                         return ev[i].code;
274                 }
275         }
276 }
277
278 int in_evdev_menu_translate(int keycode)
279 {
280         switch (keycode) {
281                 /* keyboards */
282                 case KEY_UP:    return PBTN_UP;
283                 case KEY_DOWN:  return PBTN_DOWN;
284                 case KEY_LEFT:  return PBTN_LEFT;
285                 case KEY_RIGHT: return PBTN_RIGHT;
286                 case KEY_ENTER: return PBTN_EAST;
287                 case KEY_ESC:   return PBTN_SOUTH;
288                 default:        return 0;
289         }
290 }
291
292 const char *in_evdev_get_key_name(int keycode)
293 {
294         const char *name = NULL;
295         if (keycode >= 0 && keycode < KEY_MAX)
296                 name = in_evdev_keys[keycode];
297         if (name == NULL)
298                 name = "Unkn";
299         
300         return name;
301 }
302