2 * Copyright (c) 2016 Vladimir Kondratyev <wulf@cicgroup.ru>
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 #include <sys/param.h>
30 #include <sys/malloc.h>
32 #include <sys/mutex.h>
33 #include <sys/systm.h>
35 #include <dev/evdev/input.h>
36 #include <dev/evdev/evdev.h>
37 #include <dev/evdev/evdev_private.h>
40 #define debugf(fmt, args...) printf("evdev: " fmt "\n", ##args)
42 #define debugf(fmt, args...)
45 static uint16_t evdev_fngmap[] = {
53 static uint16_t evdev_mtstmap[][2] = {
54 { ABS_MT_POSITION_X, ABS_X },
55 { ABS_MT_POSITION_Y, ABS_Y },
56 { ABS_MT_PRESSURE, ABS_PRESSURE },
57 { ABS_MT_TOUCH_MAJOR, ABS_TOOL_WIDTH },
60 struct evdev_mt_slot {
62 int32_t ev_mt_states[MT_CNT];
66 int32_t ev_mt_last_reported_slot;
67 struct evdev_mt_slot ev_mt_slots[];
71 evdev_mt_init(struct evdev_dev *evdev)
75 slots = MAXIMAL_MT_SLOT(evdev) + 1;
77 evdev->ev_mt = malloc(offsetof(struct evdev_mt, ev_mt_slots) +
78 sizeof(struct evdev_mt_slot) * slots, M_EVDEV, M_WAITOK | M_ZERO);
80 /* Initialize multitouch protocol type B states */
81 for (slot = 0; slot < slots; slot++) {
83 * .ev_report should not be initialized to initial value of
84 * report counter (0) as it brokes free slot detection in
85 * evdev_get_mt_slot_by_tracking_id. So initialize it to -1
87 evdev->ev_mt->ev_mt_slots[slot] = (struct evdev_mt_slot) {
88 .ev_report = 0xFFFFFFFFFFFFFFFFULL,
89 .ev_mt_states[ABS_MT_INDEX(ABS_MT_TRACKING_ID)] = -1,
93 if (bit_test(evdev->ev_flags, EVDEV_FLAG_MT_STCOMPAT))
94 evdev_support_mt_compat(evdev);
98 evdev_mt_free(struct evdev_dev *evdev)
101 free(evdev->ev_mt, M_EVDEV);
105 evdev_get_last_mt_slot(struct evdev_dev *evdev)
108 return (evdev->ev_mt->ev_mt_last_reported_slot);
112 evdev_set_last_mt_slot(struct evdev_dev *evdev, int32_t slot)
115 evdev->ev_mt->ev_mt_slots[slot].ev_report = evdev->ev_report_count;
116 evdev->ev_mt->ev_mt_last_reported_slot = slot;
120 evdev_get_mt_value(struct evdev_dev *evdev, int32_t slot, int16_t code)
123 return (evdev->ev_mt->
124 ev_mt_slots[slot].ev_mt_states[ABS_MT_INDEX(code)]);
128 evdev_set_mt_value(struct evdev_dev *evdev, int32_t slot, int16_t code,
132 evdev->ev_mt->ev_mt_slots[slot].ev_mt_states[ABS_MT_INDEX(code)] =
137 evdev_get_mt_slot_by_tracking_id(struct evdev_dev *evdev, int32_t tracking_id)
139 int32_t tr_id, slot, free_slot = -1;
141 for (slot = 0; slot <= MAXIMAL_MT_SLOT(evdev); slot++) {
142 tr_id = evdev_get_mt_value(evdev, slot, ABS_MT_TRACKING_ID);
143 if (tr_id == tracking_id)
146 * Its possible that slot will be reassigned in a place of just
147 * released one within the same report. To avoid this compare
148 * report counter with slot`s report number updated with each
149 * ABS_MT_TRACKING_ID change.
151 if (free_slot == -1 && tr_id == -1 &&
152 evdev->ev_mt->ev_mt_slots[slot].ev_report !=
153 evdev->ev_report_count)
161 evdev_support_nfingers(struct evdev_dev *evdev, int32_t nfingers)
165 for (i = 0; i < MIN(nitems(evdev_fngmap), nfingers); i++)
166 evdev_support_key(evdev, evdev_fngmap[i]);
170 evdev_support_mt_compat(struct evdev_dev *evdev)
174 if (evdev->ev_absinfo == NULL)
177 evdev_support_event(evdev, EV_KEY);
178 evdev_support_key(evdev, BTN_TOUCH);
180 /* Touchscreens should not advertise tap tool capabilities */
181 if (!bit_test(evdev->ev_prop_flags, INPUT_PROP_DIRECT))
182 evdev_support_nfingers(evdev, MAXIMAL_MT_SLOT(evdev) + 1);
184 /* Echo 0-th MT-slot as ST-slot */
185 for (i = 0; i < nitems(evdev_mtstmap); i++)
186 if (bit_test(evdev->ev_abs_flags, evdev_mtstmap[i][0]))
187 evdev_support_abs(evdev, evdev_mtstmap[i][1],
188 evdev->ev_absinfo[evdev_mtstmap[i][0]].value,
189 evdev->ev_absinfo[evdev_mtstmap[i][0]].minimum,
190 evdev->ev_absinfo[evdev_mtstmap[i][0]].maximum,
191 evdev->ev_absinfo[evdev_mtstmap[i][0]].fuzz,
192 evdev->ev_absinfo[evdev_mtstmap[i][0]].flat,
193 evdev->ev_absinfo[evdev_mtstmap[i][0]].resolution);
197 evdev_count_fingers(struct evdev_dev *evdev)
199 int32_t nfingers = 0, i;
201 for (i = 0; i <= MAXIMAL_MT_SLOT(evdev); i++)
202 if (evdev_get_mt_value(evdev, i, ABS_MT_TRACKING_ID) != -1)
209 evdev_send_nfingers(struct evdev_dev *evdev, int32_t nfingers)
213 EVDEV_LOCK_ASSERT(evdev);
215 if (nfingers > nitems(evdev_fngmap))
216 nfingers = nitems(evdev_fngmap);
218 for (i = 0; i < nitems(evdev_fngmap); i++)
219 evdev_send_event(evdev, EV_KEY, evdev_fngmap[i],
224 evdev_push_nfingers(struct evdev_dev *evdev, int32_t nfingers)
227 if (evdev->ev_lock_type == EV_LOCK_INTERNAL)
230 EVDEV_LOCK_ASSERT(evdev);
231 evdev_send_nfingers(evdev, nfingers);
232 if (evdev->ev_lock_type == EV_LOCK_INTERNAL)
237 evdev_send_mt_compat(struct evdev_dev *evdev)
241 EVDEV_LOCK_ASSERT(evdev);
243 nfingers = evdev_count_fingers(evdev);
244 evdev_send_event(evdev, EV_KEY, BTN_TOUCH, nfingers > 0);
246 if (evdev_get_mt_value(evdev, 0, ABS_MT_TRACKING_ID) != -1)
247 /* Echo 0-th MT-slot as ST-slot */
248 for (i = 0; i < nitems(evdev_mtstmap); i++)
249 if (bit_test(evdev->ev_abs_flags, evdev_mtstmap[i][1]))
250 evdev_send_event(evdev, EV_ABS,
252 evdev_get_mt_value(evdev, 0,
253 evdev_mtstmap[i][0]));
255 /* Touchscreens should not report tool taps */
256 if (!bit_test(evdev->ev_prop_flags, INPUT_PROP_DIRECT))
257 evdev_send_nfingers(evdev, nfingers);
260 evdev_send_event(evdev, EV_ABS, ABS_PRESSURE, 0);
264 evdev_push_mt_compat(struct evdev_dev *evdev)
267 if (evdev->ev_lock_type == EV_LOCK_INTERNAL)
270 EVDEV_LOCK_ASSERT(evdev);
271 evdev_send_mt_compat(evdev);
272 if (evdev->ev_lock_type == EV_LOCK_INTERNAL)
277 evdev_send_mt_autorel(struct evdev_dev *evdev)
281 EVDEV_LOCK_ASSERT(evdev);
283 for (slot = 0; slot <= MAXIMAL_MT_SLOT(evdev); slot++) {
284 if (evdev->ev_mt->ev_mt_slots[slot].ev_report !=
285 evdev->ev_report_count &&
286 evdev_get_mt_value(evdev, slot, ABS_MT_TRACKING_ID) != -1){
287 evdev_send_event(evdev, EV_ABS, ABS_MT_SLOT, slot);
288 evdev_send_event(evdev, EV_ABS, ABS_MT_TRACKING_ID,