evdev: check for ABS_MT_POSITION_X/Y to determine mt devices
[platform/upstream/libinput.git] / src / evdev.c
1 /*
2  * Copyright © 2010 Intel Corporation
3  *
4  * Permission to use, copy, modify, distribute, and sell this software and
5  * its documentation for any purpose is hereby granted without fee, provided
6  * that the above copyright notice appear in all copies and that both that
7  * copyright notice and this permission notice appear in supporting
8  * documentation, and that the name of the copyright holders not be used in
9  * advertising or publicity pertaining to distribution of the software
10  * without specific, written prior permission.  The copyright holders make
11  * no representations about the suitability of this software for any
12  * purpose.  It is provided "as is" without express or implied warranty.
13  *
14  * THE COPYRIGHT HOLDERS DISCLAIM ALL WARRANTIES WITH REGARD TO THIS
15  * SOFTWARE, INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND
16  * FITNESS, IN NO EVENT SHALL THE COPYRIGHT HOLDERS BE LIABLE FOR ANY
17  * SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER
18  * RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF
19  * CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
20  * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
21  */
22
23 #include "config.h"
24
25 #include <stdlib.h>
26 #include <string.h>
27 #include <linux/input.h>
28 #include <unistd.h>
29 #include <fcntl.h>
30 #include <mtdev.h>
31
32 #include "compositor.h"
33 #include "evdev.h"
34
35 #define DEFAULT_AXIS_STEP_DISTANCE wl_fixed_from_int(10)
36
37 void
38 evdev_led_update(struct evdev_device *device, enum weston_led leds)
39 {
40         static const struct {
41                 enum weston_led weston;
42                 int evdev;
43         } map[] = {
44                 { LED_NUM_LOCK, LED_NUML },
45                 { LED_CAPS_LOCK, LED_CAPSL },
46                 { LED_SCROLL_LOCK, LED_SCROLLL },
47         };
48         struct input_event ev[ARRAY_LENGTH(map)];
49         unsigned int i;
50
51         if (!device->caps & EVDEV_KEYBOARD)
52                 return;
53
54         memset(ev, 0, sizeof(ev));
55         for (i = 0; i < ARRAY_LENGTH(map); i++) {
56                 ev[i].type = EV_LED;
57                 ev[i].code = map[i].evdev;
58                 ev[i].value = !!(leds & map[i].weston);
59         }
60
61         i = write(device->fd, ev, sizeof ev);
62         (void)i; /* no, we really don't care about the return value */
63 }
64
65 static inline void
66 evdev_process_key(struct evdev_device *device, struct input_event *e, int time)
67 {
68         if (e->value == 2)
69                 return;
70
71         switch (e->code) {
72         case BTN_LEFT:
73         case BTN_RIGHT:
74         case BTN_MIDDLE:
75         case BTN_SIDE:
76         case BTN_EXTRA:
77         case BTN_FORWARD:
78         case BTN_BACK:
79         case BTN_TASK:
80                 notify_button(device->seat,
81                               time, e->code,
82                               e->value ? WL_POINTER_BUTTON_STATE_PRESSED :
83                                          WL_POINTER_BUTTON_STATE_RELEASED);
84                 break;
85
86         case BTN_TOUCH:
87                 if (e->value == 0 && !device->is_mt)
88                         notify_touch(device->seat, time, device->mt.slot, 0, 0,
89                                      WL_TOUCH_UP);
90                 break;
91         default:
92                 notify_key(device->seat,
93                            time, e->code,
94                            e->value ? WL_KEYBOARD_KEY_STATE_PRESSED :
95                                       WL_KEYBOARD_KEY_STATE_RELEASED,
96                            STATE_UPDATE_AUTOMATIC);
97                 break;
98         }
99 }
100
101 static void
102 evdev_process_touch(struct evdev_device *device, struct input_event *e)
103 {
104         const int screen_width = device->output->current->width;
105         const int screen_height = device->output->current->height;
106
107         switch (e->code) {
108         case ABS_MT_SLOT:
109                 device->mt.slot = e->value;
110                 break;
111         case ABS_MT_TRACKING_ID:
112                 if (e->value >= 0)
113                         device->pending_events |= EVDEV_ABSOLUTE_MT_DOWN;
114                 else
115                         device->pending_events |= EVDEV_ABSOLUTE_MT_UP;
116                 break;
117         case ABS_MT_POSITION_X:
118                 device->mt.x[device->mt.slot] =
119                         (e->value - device->abs.min_x) * screen_width /
120                         (device->abs.max_x - device->abs.min_x);
121                 device->pending_events |= EVDEV_ABSOLUTE_MT_MOTION;
122                 break;
123         case ABS_MT_POSITION_Y:
124                 device->mt.y[device->mt.slot] =
125                         (e->value - device->abs.min_y) * screen_height /
126                         (device->abs.max_y - device->abs.min_y);
127                 device->pending_events |= EVDEV_ABSOLUTE_MT_MOTION;
128                 break;
129         }
130 }
131
132 static inline void
133 evdev_process_absolute_motion(struct evdev_device *device,
134                               struct input_event *e)
135 {
136         const int screen_width = device->output->current->width;
137         const int screen_height = device->output->current->height;
138
139         switch (e->code) {
140         case ABS_X:
141                 device->abs.x =
142                         (e->value - device->abs.min_x) * screen_width /
143                         (device->abs.max_x - device->abs.min_x);
144                 device->pending_events |= EVDEV_ABSOLUTE_MOTION;
145                 break;
146         case ABS_Y:
147                 device->abs.y =
148                         (e->value - device->abs.min_y) * screen_height /
149                         (device->abs.max_y - device->abs.min_y);
150                 device->pending_events |= EVDEV_ABSOLUTE_MOTION;
151                 break;
152         }
153 }
154
155 static inline void
156 evdev_process_relative(struct evdev_device *device,
157                        struct input_event *e, uint32_t time)
158 {
159         switch (e->code) {
160         case REL_X:
161                 device->rel.dx += wl_fixed_from_int(e->value);
162                 device->pending_events |= EVDEV_RELATIVE_MOTION;
163                 break;
164         case REL_Y:
165                 device->rel.dy += wl_fixed_from_int(e->value);
166                 device->pending_events |= EVDEV_RELATIVE_MOTION;
167                 break;
168         case REL_WHEEL:
169                 switch (e->value) {
170                 case -1:
171                         /* Scroll down */
172                 case 1:
173                         /* Scroll up */
174                         notify_axis(device->seat,
175                                     time,
176                                     WL_POINTER_AXIS_VERTICAL_SCROLL,
177                                     -1 * e->value * DEFAULT_AXIS_STEP_DISTANCE);
178                         break;
179                 default:
180                         break;
181                 }
182                 break;
183         case REL_HWHEEL:
184                 switch (e->value) {
185                 case -1:
186                         /* Scroll left */
187                 case 1:
188                         /* Scroll right */
189                         notify_axis(device->seat,
190                                     time,
191                                     WL_POINTER_AXIS_HORIZONTAL_SCROLL,
192                                     e->value * DEFAULT_AXIS_STEP_DISTANCE);
193                         break;
194                 default:
195                         break;
196
197                 }
198         }
199 }
200
201 static inline void
202 evdev_process_absolute(struct evdev_device *device, struct input_event *e)
203 {
204         if (device->is_mt) {
205                 evdev_process_touch(device, e);
206         } else {
207                 evdev_process_absolute_motion(device, e);
208         }
209 }
210
211 static int
212 is_motion_event(struct input_event *e)
213 {
214         switch (e->type) {
215         case EV_REL:
216                 switch (e->code) {
217                 case REL_X:
218                 case REL_Y:
219                         return 1;
220                 }
221                 break;
222         case EV_ABS:
223                 switch (e->code) {
224                 case ABS_X:
225                 case ABS_Y:
226                 case ABS_MT_POSITION_X:
227                 case ABS_MT_POSITION_Y:
228                         return 1;
229                 }
230         }
231
232         return 0;
233 }
234
235 static void
236 transform_absolute(struct evdev_device *device)
237 {
238         int32_t x, y;
239
240         if (!device->abs.apply_calibration)
241                 return;
242
243         x = device->abs.x * device->abs.calibration[0] +
244                 device->abs.y * device->abs.calibration[1] +
245                 device->abs.calibration[2];
246
247         y = device->abs.x * device->abs.calibration[3] +
248                 device->abs.y * device->abs.calibration[4] +
249                 device->abs.calibration[5];
250
251         device->abs.x = x;
252         device->abs.y = y;
253 }
254
255 static void
256 evdev_flush_motion(struct evdev_device *device, uint32_t time)
257 {
258         struct weston_seat *master = device->seat;
259         wl_fixed_t x, y;
260         int slot;
261
262         if (!(device->pending_events & EVDEV_SYN))
263                 return;
264
265         slot = device->mt.slot;
266         device->pending_events &= ~EVDEV_SYN;
267         if (device->pending_events & EVDEV_RELATIVE_MOTION) {
268                 notify_motion(master, time, device->rel.dx, device->rel.dy);
269                 device->pending_events &= ~EVDEV_RELATIVE_MOTION;
270                 device->rel.dx = 0;
271                 device->rel.dy = 0;
272         }
273         if (device->pending_events & EVDEV_ABSOLUTE_MT_DOWN) {
274                 weston_output_transform_coordinate(device->output,
275                                                    device->mt.x[slot],
276                                                    device->mt.y[slot],
277                                                    &x, &y);
278                 notify_touch(master, time,
279                              device->mt.slot, x, y, WL_TOUCH_DOWN);
280                 device->pending_events &= ~EVDEV_ABSOLUTE_MT_DOWN;
281                 device->pending_events &= ~EVDEV_ABSOLUTE_MT_MOTION;
282         }
283         if (device->pending_events & EVDEV_ABSOLUTE_MT_MOTION) {
284                 weston_output_transform_coordinate(device->output,
285                                                    device->mt.x[slot],
286                                                    device->mt.y[slot],
287                                                    &x, &y);
288                 notify_touch(master, time,
289                              device->mt.slot, x, y, WL_TOUCH_MOTION);
290                 device->pending_events &= ~EVDEV_ABSOLUTE_MT_DOWN;
291                 device->pending_events &= ~EVDEV_ABSOLUTE_MT_MOTION;
292         }
293         if (device->pending_events & EVDEV_ABSOLUTE_MT_UP) {
294                 notify_touch(master, time, device->mt.slot, 0, 0,
295                              WL_TOUCH_UP);
296                 device->pending_events &= ~EVDEV_ABSOLUTE_MT_UP;
297         }
298         if (device->pending_events & EVDEV_ABSOLUTE_MOTION) {
299                 transform_absolute(device);
300                 weston_output_transform_coordinate(device->output,
301                                                    device->abs.x,
302                                                    device->abs.y, &x, &y);
303
304                 if (device->caps & EVDEV_TOUCH) {
305                         if (master->num_tp == 0)
306                                 notify_touch(master, time, 0,
307                                              x, y, WL_TOUCH_DOWN);
308                         else
309                                 notify_touch(master, time, 0,
310                                              x, y, WL_TOUCH_MOTION);
311                 } else
312                         notify_motion_absolute(master, time, x, y);
313                 device->pending_events &= ~EVDEV_ABSOLUTE_MOTION;
314         }
315 }
316
317 static void
318 fallback_process(struct evdev_dispatch *dispatch,
319                  struct evdev_device *device,
320                  struct input_event *event,
321                  uint32_t time)
322 {
323         switch (event->type) {
324         case EV_REL:
325                 evdev_process_relative(device, event, time);
326                 break;
327         case EV_ABS:
328                 evdev_process_absolute(device, event);
329                 break;
330         case EV_KEY:
331                 evdev_process_key(device, event, time);
332                 break;
333         case EV_SYN:
334                 device->pending_events |= EVDEV_SYN;
335                 break;
336         }
337 }
338
339 static void
340 fallback_destroy(struct evdev_dispatch *dispatch)
341 {
342         free(dispatch);
343 }
344
345 struct evdev_dispatch_interface fallback_interface = {
346         fallback_process,
347         fallback_destroy
348 };
349
350 static struct evdev_dispatch *
351 fallback_dispatch_create(void)
352 {
353         struct evdev_dispatch *dispatch = malloc(sizeof *dispatch);
354         if (dispatch == NULL)
355                 return NULL;
356
357         dispatch->interface = &fallback_interface;
358
359         return dispatch;
360 }
361
362 static void
363 evdev_process_events(struct evdev_device *device,
364                      struct input_event *ev, int count)
365 {
366         struct evdev_dispatch *dispatch = device->dispatch;
367         struct input_event *e, *end;
368         uint32_t time = 0;
369
370         device->pending_events = 0;
371
372         e = ev;
373         end = e + count;
374         for (e = ev; e < end; e++) {
375                 time = e->time.tv_sec * 1000 + e->time.tv_usec / 1000;
376
377                 /* we try to minimize the amount of notifications to be
378                  * forwarded to the compositor, so we accumulate motion
379                  * events and send as a bunch */
380                 if (!is_motion_event(e))
381                         evdev_flush_motion(device, time);
382
383                 dispatch->interface->process(dispatch, device, e, time);
384         }
385
386         evdev_flush_motion(device, time);
387 }
388
389 static int
390 evdev_device_data(int fd, uint32_t mask, void *data)
391 {
392         struct weston_compositor *ec;
393         struct evdev_device *device = data;
394         struct input_event ev[32];
395         int len;
396
397         ec = device->seat->compositor;
398         if (!ec->focus)
399                 return 1;
400
401         /* If the compositor is repainting, this function is called only once
402          * per frame and we have to process all the events available on the
403          * fd, otherwise there will be input lag. */
404         do {
405                 if (device->mtdev)
406                         len = mtdev_get(device->mtdev, fd, ev,
407                                         ARRAY_LENGTH(ev)) *
408                                 sizeof (struct input_event);
409                 else
410                         len = read(fd, &ev, sizeof ev);
411
412                 if (len < 0 || len % sizeof ev[0] != 0) {
413                         /* FIXME: call evdev_device_destroy when errno is ENODEV. */
414                         return 1;
415                 }
416
417                 evdev_process_events(device, ev, len / sizeof ev[0]);
418
419         } while (len > 0);
420
421         return 1;
422 }
423
424 static int
425 evdev_handle_device(struct evdev_device *device)
426 {
427         struct input_absinfo absinfo;
428         unsigned long ev_bits[NBITS(EV_MAX)];
429         unsigned long abs_bits[NBITS(ABS_MAX)];
430         unsigned long rel_bits[NBITS(REL_MAX)];
431         unsigned long key_bits[NBITS(KEY_MAX)];
432         int has_key, has_abs;
433         unsigned int i;
434
435         has_key = 0;
436         has_abs = 0;
437         device->caps = 0;
438
439         ioctl(device->fd, EVIOCGBIT(0, sizeof(ev_bits)), ev_bits);
440         if (TEST_BIT(ev_bits, EV_ABS)) {
441                 has_abs = 1;
442
443                 ioctl(device->fd, EVIOCGBIT(EV_ABS, sizeof(abs_bits)),
444                       abs_bits);
445                 if (TEST_BIT(abs_bits, ABS_X)) {
446                         ioctl(device->fd, EVIOCGABS(ABS_X), &absinfo);
447                         device->abs.min_x = absinfo.minimum;
448                         device->abs.max_x = absinfo.maximum;
449                         device->caps |= EVDEV_MOTION_ABS;
450                 }
451                 if (TEST_BIT(abs_bits, ABS_Y)) {
452                         ioctl(device->fd, EVIOCGABS(ABS_Y), &absinfo);
453                         device->abs.min_y = absinfo.minimum;
454                         device->abs.max_y = absinfo.maximum;
455                         device->caps |= EVDEV_MOTION_ABS;
456                 }
457                 /* We only handle the slotted Protocol B in weston.
458                    Devices with ABS_MT_POSITION_* but not ABS_MT_SLOT
459                    require mtdev for conversion. */
460                 if (TEST_BIT(abs_bits, ABS_MT_POSITION_X) &&
461                     TEST_BIT(abs_bits, ABS_MT_POSITION_Y)) {
462                         ioctl(device->fd, EVIOCGABS(ABS_MT_POSITION_X),
463                               &absinfo);
464                         device->abs.min_x = absinfo.minimum;
465                         device->abs.max_x = absinfo.maximum;
466                         ioctl(device->fd, EVIOCGABS(ABS_MT_POSITION_Y),
467                               &absinfo);
468                         device->abs.min_y = absinfo.minimum;
469                         device->abs.max_y = absinfo.maximum;
470                         device->is_mt = 1;
471                         device->mt.slot = 0;
472                         device->caps |= EVDEV_TOUCH;
473                 }
474         }
475         if (TEST_BIT(ev_bits, EV_REL)) {
476                 ioctl(device->fd, EVIOCGBIT(EV_REL, sizeof(rel_bits)),
477                       rel_bits);
478                 if (TEST_BIT(rel_bits, REL_X) || TEST_BIT(rel_bits, REL_Y))
479                         device->caps |= EVDEV_MOTION_REL;
480         }
481         if (TEST_BIT(ev_bits, EV_KEY)) {
482                 has_key = 1;
483                 ioctl(device->fd, EVIOCGBIT(EV_KEY, sizeof(key_bits)),
484                       key_bits);
485                 if (TEST_BIT(key_bits, BTN_TOOL_FINGER) &&
486                     !TEST_BIT(key_bits, BTN_TOOL_PEN) &&
487                     has_abs)
488                         device->dispatch = evdev_touchpad_create(device);
489                 for (i = KEY_ESC; i < KEY_MAX; i++) {
490                         if (i >= BTN_MISC && i < KEY_OK)
491                                 continue;
492                         if (TEST_BIT(key_bits, i)) {
493                                 device->caps |= EVDEV_KEYBOARD;
494                                 break;
495                         }
496                 }
497                 for (i = BTN_MISC; i < KEY_OK; i++) {
498                         if (TEST_BIT(key_bits, i)) {
499                                 device->caps |= EVDEV_BUTTON;
500                                 break;
501                         }
502                 }
503                 if (TEST_BIT(key_bits, BTN_TOUCH)) {
504                         device->caps |= EVDEV_TOUCH;
505                 }
506
507         }
508         if (TEST_BIT(ev_bits, EV_LED)) {
509                 device->caps |= EVDEV_KEYBOARD;
510         }
511
512         /* This rule tries to catch accelerometer devices and opt out. We may
513          * want to adjust the protocol later adding a proper event for dealing
514          * with accelerometers and implement here accordingly */
515         if (has_abs && !has_key && !device->is_mt) {
516                 weston_log("input device %s, %s "
517                            "ignored: unsupported device type\n",
518                            device->devname, device->devnode);
519                 return 0;
520         }
521
522         return 1;
523 }
524
525 static int
526 evdev_configure_device(struct evdev_device *device)
527 {
528         if ((device->caps &
529              (EVDEV_MOTION_ABS | EVDEV_MOTION_REL | EVDEV_BUTTON))) {
530                 weston_seat_init_pointer(device->seat);
531                 weston_log("input device %s, %s is a pointer caps =%s%s%s\n",
532                            device->devname, device->devnode,
533                            device->caps & EVDEV_MOTION_ABS ? " absolute-motion" : "",
534                            device->caps & EVDEV_MOTION_REL ? " relative-motion": "",
535                            device->caps & EVDEV_BUTTON ? " button" : "");
536         }
537         if ((device->caps & EVDEV_KEYBOARD)) {
538                 if (weston_seat_init_keyboard(device->seat, NULL) < 0)
539                         return -1;
540                 weston_log("input device %s, %s is a keyboard\n",
541                            device->devname, device->devnode);
542         }
543         if ((device->caps & EVDEV_TOUCH)) {
544                 weston_seat_init_touch(device->seat);
545                 weston_log("input device %s, %s is a touch device\n",
546                            device->devname, device->devnode);
547         }
548
549         return 0;
550 }
551
552 struct evdev_device *
553 evdev_device_create(struct weston_seat *seat, const char *path, int device_fd)
554 {
555         struct evdev_device *device;
556         struct weston_compositor *ec;
557         char devname[256] = "unknown";
558
559         device = zalloc(sizeof *device);
560         if (device == NULL)
561                 return NULL;
562
563         ec = seat->compositor;
564         device->output =
565                 container_of(ec->output_list.next, struct weston_output, link);
566
567         device->seat = seat;
568         device->is_mt = 0;
569         device->mtdev = NULL;
570         device->devnode = strdup(path);
571         device->mt.slot = -1;
572         device->rel.dx = 0;
573         device->rel.dy = 0;
574         device->dispatch = NULL;
575         device->fd = device_fd;
576
577         ioctl(device->fd, EVIOCGNAME(sizeof(devname)), devname);
578         device->devname = strdup(devname);
579
580         if (!evdev_handle_device(device)) {
581                 free(device->devnode);
582                 free(device->devname);
583                 free(device);
584                 return EVDEV_UNHANDLED_DEVICE;
585         }
586
587         if (evdev_configure_device(device) == -1)
588                 goto err1;
589
590         /* If the dispatch was not set up use the fallback. */
591         if (device->dispatch == NULL)
592                 device->dispatch = fallback_dispatch_create();
593         if (device->dispatch == NULL)
594                 goto err1;
595
596
597         if (device->is_mt) {
598                 device->mtdev = mtdev_new_open(device->fd);
599                 if (!device->mtdev)
600                         weston_log("mtdev failed to open for %s\n", path);
601         }
602
603         device->source = wl_event_loop_add_fd(ec->input_loop, device->fd,
604                                               WL_EVENT_READABLE,
605                                               evdev_device_data, device);
606         if (device->source == NULL)
607                 goto err2;
608
609         return device;
610
611 err2:
612         device->dispatch->interface->destroy(device->dispatch);
613 err1:
614         free(device->devname);
615         free(device->devnode);
616         free(device);
617         return NULL;
618 }
619
620 void
621 evdev_device_destroy(struct evdev_device *device)
622 {
623         struct evdev_dispatch *dispatch;
624
625         dispatch = device->dispatch;
626         if (dispatch)
627                 dispatch->interface->destroy(dispatch);
628
629         wl_event_source_remove(device->source);
630         wl_list_remove(&device->link);
631         if (device->mtdev)
632                 mtdev_close_delete(device->mtdev);
633         close(device->fd);
634         free(device->devname);
635         free(device->devnode);
636         free(device);
637 }
638
639 void
640 evdev_notify_keyboard_focus(struct weston_seat *seat,
641                             struct wl_list *evdev_devices)
642 {
643         struct evdev_device *device;
644         struct wl_array keys;
645         unsigned int i, set;
646         char evdev_keys[(KEY_CNT + 7) / 8];
647         char all_keys[(KEY_CNT + 7) / 8];
648         uint32_t *k;
649         int ret;
650
651         if (!seat->keyboard)
652                 return;
653
654         memset(all_keys, 0, sizeof all_keys);
655         wl_list_for_each(device, evdev_devices, link) {
656                 memset(evdev_keys, 0, sizeof evdev_keys);
657                 ret = ioctl(device->fd,
658                             EVIOCGKEY(sizeof evdev_keys), evdev_keys);
659                 if (ret < 0) {
660                         weston_log("failed to get keys for device %s\n",
661                                 device->devnode);
662                         continue;
663                 }
664                 for (i = 0; i < ARRAY_LENGTH(evdev_keys); i++)
665                         all_keys[i] |= evdev_keys[i];
666         }
667
668         wl_array_init(&keys);
669         for (i = 0; i < KEY_CNT; i++) {
670                 set = all_keys[i >> 3] & (1 << (i & 7));
671                 if (set) {
672                         k = wl_array_add(&keys, sizeof *k);
673                         *k = i;
674                 }
675         }
676
677         notify_keyboard_focus_in(seat, &keys, STATE_UPDATE_AUTOMATIC);
678
679         wl_array_release(&keys);
680 }