xref: /freebsd/sys/dev/evdev/evdev.c (revision 4c0a4665b8c58b5df0b0b4851733cc9ad94cff87)
12b3f6d66SOleksandr Tymoshenko /*-
22b3f6d66SOleksandr Tymoshenko  * Copyright (c) 2014 Jakub Wojciech Klama <jceel@FreeBSD.org>
32b3f6d66SOleksandr Tymoshenko  * Copyright (c) 2015-2016 Vladimir Kondratyev <wulf@cicgroup.ru>
42b3f6d66SOleksandr Tymoshenko  * All rights reserved.
52b3f6d66SOleksandr Tymoshenko  *
62b3f6d66SOleksandr Tymoshenko  * Redistribution and use in source and binary forms, with or without
72b3f6d66SOleksandr Tymoshenko  * modification, are permitted provided that the following conditions
82b3f6d66SOleksandr Tymoshenko  * are met:
92b3f6d66SOleksandr Tymoshenko  * 1. Redistributions of source code must retain the above copyright
102b3f6d66SOleksandr Tymoshenko  *    notice, this list of conditions and the following disclaimer.
112b3f6d66SOleksandr Tymoshenko  * 2. Redistributions in binary form must reproduce the above copyright
122b3f6d66SOleksandr Tymoshenko  *    notice, this list of conditions and the following disclaimer in the
132b3f6d66SOleksandr Tymoshenko  *    documentation and/or other materials provided with the distribution.
142b3f6d66SOleksandr Tymoshenko  *
152b3f6d66SOleksandr Tymoshenko  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
162b3f6d66SOleksandr Tymoshenko  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
172b3f6d66SOleksandr Tymoshenko  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
182b3f6d66SOleksandr Tymoshenko  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
192b3f6d66SOleksandr Tymoshenko  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
202b3f6d66SOleksandr Tymoshenko  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
212b3f6d66SOleksandr Tymoshenko  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
222b3f6d66SOleksandr Tymoshenko  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
232b3f6d66SOleksandr Tymoshenko  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
242b3f6d66SOleksandr Tymoshenko  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
252b3f6d66SOleksandr Tymoshenko  * SUCH DAMAGE.
262b3f6d66SOleksandr Tymoshenko  *
272b3f6d66SOleksandr Tymoshenko  * $FreeBSD$
282b3f6d66SOleksandr Tymoshenko  */
292b3f6d66SOleksandr Tymoshenko 
302b3f6d66SOleksandr Tymoshenko #include "opt_evdev.h"
312b3f6d66SOleksandr Tymoshenko 
322b3f6d66SOleksandr Tymoshenko #include <sys/param.h>
332b3f6d66SOleksandr Tymoshenko #include <sys/bitstring.h>
34ea2e26b1SVladimir Kondratyev #include <sys/conf.h>
35ea2e26b1SVladimir Kondratyev #include <sys/kernel.h>
36ea2e26b1SVladimir Kondratyev #include <sys/malloc.h>
37ea2e26b1SVladimir Kondratyev #include <sys/module.h>
382b3f6d66SOleksandr Tymoshenko #include <sys/sysctl.h>
39ea2e26b1SVladimir Kondratyev #include <sys/systm.h>
402b3f6d66SOleksandr Tymoshenko 
412b3f6d66SOleksandr Tymoshenko #include <dev/evdev/evdev.h>
422b3f6d66SOleksandr Tymoshenko #include <dev/evdev/evdev_private.h>
43ea2e26b1SVladimir Kondratyev #include <dev/evdev/input.h>
442b3f6d66SOleksandr Tymoshenko 
452b3f6d66SOleksandr Tymoshenko #ifdef EVDEV_DEBUG
462b3f6d66SOleksandr Tymoshenko #define	debugf(evdev, fmt, args...)	printf("evdev: " fmt "\n", ##args)
472b3f6d66SOleksandr Tymoshenko #else
482b3f6d66SOleksandr Tymoshenko #define	debugf(evdev, fmt, args...)
492b3f6d66SOleksandr Tymoshenko #endif
502b3f6d66SOleksandr Tymoshenko 
512b3f6d66SOleksandr Tymoshenko #ifdef FEATURE
522b3f6d66SOleksandr Tymoshenko FEATURE(evdev, "Input event devices support");
532b3f6d66SOleksandr Tymoshenko #endif
542b3f6d66SOleksandr Tymoshenko 
552b3f6d66SOleksandr Tymoshenko enum evdev_sparse_result
562b3f6d66SOleksandr Tymoshenko {
572b3f6d66SOleksandr Tymoshenko 	EV_SKIP_EVENT,		/* Event value not changed */
582b3f6d66SOleksandr Tymoshenko 	EV_REPORT_EVENT,	/* Event value changed */
592b3f6d66SOleksandr Tymoshenko 	EV_REPORT_MT_SLOT,	/* Event value and MT slot number changed */
602b3f6d66SOleksandr Tymoshenko };
612b3f6d66SOleksandr Tymoshenko 
622b3f6d66SOleksandr Tymoshenko MALLOC_DEFINE(M_EVDEV, "evdev", "evdev memory");
632b3f6d66SOleksandr Tymoshenko 
642b3f6d66SOleksandr Tymoshenko int evdev_rcpt_mask = EVDEV_RCPT_SYSMOUSE | EVDEV_RCPT_KBDMUX;
654af79d4fSOleksandr Tymoshenko int evdev_sysmouse_t_axis = 0;
662b3f6d66SOleksandr Tymoshenko 
672b3f6d66SOleksandr Tymoshenko SYSCTL_NODE(_kern, OID_AUTO, evdev, CTLFLAG_RW, 0, "Evdev args");
682b3f6d66SOleksandr Tymoshenko SYSCTL_INT(_kern_evdev, OID_AUTO, rcpt_mask, CTLFLAG_RW, &evdev_rcpt_mask, 0,
692b3f6d66SOleksandr Tymoshenko     "Who is receiving events: bit0 - sysmouse, bit1 - kbdmux, "
702b3f6d66SOleksandr Tymoshenko     "bit2 - mouse hardware, bit3 - keyboard hardware");
714af79d4fSOleksandr Tymoshenko SYSCTL_INT(_kern_evdev, OID_AUTO, sysmouse_t_axis, CTLFLAG_RW,
724af79d4fSOleksandr Tymoshenko     &evdev_sysmouse_t_axis, 0, "Extract T-axis from 0-none, 1-ums, 2-psm");
732b3f6d66SOleksandr Tymoshenko 
742b3f6d66SOleksandr Tymoshenko static void evdev_start_repeat(struct evdev_dev *, uint16_t);
752b3f6d66SOleksandr Tymoshenko static void evdev_stop_repeat(struct evdev_dev *);
762b3f6d66SOleksandr Tymoshenko static int evdev_check_event(struct evdev_dev *, uint16_t, uint16_t, int32_t);
772b3f6d66SOleksandr Tymoshenko 
782b3f6d66SOleksandr Tymoshenko static inline void
792b3f6d66SOleksandr Tymoshenko bit_change(bitstr_t *bitstr, int bit, int value)
802b3f6d66SOleksandr Tymoshenko {
812b3f6d66SOleksandr Tymoshenko 	if (value)
822b3f6d66SOleksandr Tymoshenko 		bit_set(bitstr, bit);
832b3f6d66SOleksandr Tymoshenko 	else
842b3f6d66SOleksandr Tymoshenko 		bit_clear(bitstr, bit);
852b3f6d66SOleksandr Tymoshenko }
862b3f6d66SOleksandr Tymoshenko 
872b3f6d66SOleksandr Tymoshenko struct evdev_dev *
882b3f6d66SOleksandr Tymoshenko evdev_alloc(void)
892b3f6d66SOleksandr Tymoshenko {
902b3f6d66SOleksandr Tymoshenko 
912b3f6d66SOleksandr Tymoshenko 	return malloc(sizeof(struct evdev_dev), M_EVDEV, M_WAITOK | M_ZERO);
922b3f6d66SOleksandr Tymoshenko }
932b3f6d66SOleksandr Tymoshenko 
942b3f6d66SOleksandr Tymoshenko void
952b3f6d66SOleksandr Tymoshenko evdev_free(struct evdev_dev *evdev)
962b3f6d66SOleksandr Tymoshenko {
972b3f6d66SOleksandr Tymoshenko 
98c3f2135cSOleksandr Tymoshenko 	if (evdev != NULL && evdev->ev_cdev != NULL &&
99c3f2135cSOleksandr Tymoshenko 	    evdev->ev_cdev->si_drv1 != NULL)
1002b3f6d66SOleksandr Tymoshenko 		evdev_unregister(evdev);
1012b3f6d66SOleksandr Tymoshenko 
1022b3f6d66SOleksandr Tymoshenko 	free(evdev, M_EVDEV);
1032b3f6d66SOleksandr Tymoshenko }
1042b3f6d66SOleksandr Tymoshenko 
1052b3f6d66SOleksandr Tymoshenko static struct input_absinfo *
1062b3f6d66SOleksandr Tymoshenko evdev_alloc_absinfo(void)
1072b3f6d66SOleksandr Tymoshenko {
1082b3f6d66SOleksandr Tymoshenko 
1092b3f6d66SOleksandr Tymoshenko 	return (malloc(sizeof(struct input_absinfo) * ABS_CNT, M_EVDEV,
1102b3f6d66SOleksandr Tymoshenko 	    M_WAITOK | M_ZERO));
1112b3f6d66SOleksandr Tymoshenko }
1122b3f6d66SOleksandr Tymoshenko 
1132b3f6d66SOleksandr Tymoshenko static void
1142b3f6d66SOleksandr Tymoshenko evdev_free_absinfo(struct input_absinfo *absinfo)
1152b3f6d66SOleksandr Tymoshenko {
1162b3f6d66SOleksandr Tymoshenko 
1172b3f6d66SOleksandr Tymoshenko 	free(absinfo, M_EVDEV);
1182b3f6d66SOleksandr Tymoshenko }
1192b3f6d66SOleksandr Tymoshenko 
1202b3f6d66SOleksandr Tymoshenko int
1212b3f6d66SOleksandr Tymoshenko evdev_set_report_size(struct evdev_dev *evdev, size_t report_size)
1222b3f6d66SOleksandr Tymoshenko {
1232b3f6d66SOleksandr Tymoshenko 	if (report_size > KEY_CNT + REL_CNT + ABS_CNT + MAX_MT_SLOTS * MT_CNT +
1242b3f6d66SOleksandr Tymoshenko 	    MSC_CNT + LED_CNT + SND_CNT + SW_CNT + FF_CNT)
1252b3f6d66SOleksandr Tymoshenko 		return (EINVAL);
1262b3f6d66SOleksandr Tymoshenko 
1272b3f6d66SOleksandr Tymoshenko 	evdev->ev_report_size = report_size;
1282b3f6d66SOleksandr Tymoshenko 	return (0);
1292b3f6d66SOleksandr Tymoshenko }
1302b3f6d66SOleksandr Tymoshenko 
1312b3f6d66SOleksandr Tymoshenko static size_t
1322b3f6d66SOleksandr Tymoshenko evdev_estimate_report_size(struct evdev_dev *evdev)
1332b3f6d66SOleksandr Tymoshenko {
1342b3f6d66SOleksandr Tymoshenko 	size_t size = 0;
1352b3f6d66SOleksandr Tymoshenko 	int res;
1362b3f6d66SOleksandr Tymoshenko 
1372b3f6d66SOleksandr Tymoshenko 	/*
1382b3f6d66SOleksandr Tymoshenko 	 * Keyboards generate one event per report but other devices with
1392b3f6d66SOleksandr Tymoshenko 	 * buttons like mouses can report events simultaneously
1402b3f6d66SOleksandr Tymoshenko 	 */
1412b3f6d66SOleksandr Tymoshenko 	bit_ffs_at(evdev->ev_key_flags, KEY_OK, KEY_CNT - KEY_OK, &res);
1422b3f6d66SOleksandr Tymoshenko 	if (res == -1)
1432b3f6d66SOleksandr Tymoshenko 		bit_ffs(evdev->ev_key_flags, BTN_MISC, &res);
1442b3f6d66SOleksandr Tymoshenko 	size += (res != -1);
1452b3f6d66SOleksandr Tymoshenko 	bit_count(evdev->ev_key_flags, BTN_MISC, KEY_OK - BTN_MISC, &res);
1462b3f6d66SOleksandr Tymoshenko 	size += res;
1472b3f6d66SOleksandr Tymoshenko 
1482b3f6d66SOleksandr Tymoshenko 	/* All relative axes can be reported simultaneously */
1492b3f6d66SOleksandr Tymoshenko 	bit_count(evdev->ev_rel_flags, 0, REL_CNT, &res);
1502b3f6d66SOleksandr Tymoshenko 	size += res;
1512b3f6d66SOleksandr Tymoshenko 
1522b3f6d66SOleksandr Tymoshenko 	/*
1532b3f6d66SOleksandr Tymoshenko 	 * All absolute axes can be reported simultaneously.
1542b3f6d66SOleksandr Tymoshenko 	 * Multitouch axes can be reported ABS_MT_SLOT times
1552b3f6d66SOleksandr Tymoshenko 	 */
1562b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_absinfo != NULL) {
1572b3f6d66SOleksandr Tymoshenko 		bit_count(evdev->ev_abs_flags, 0, ABS_CNT, &res);
1582b3f6d66SOleksandr Tymoshenko 		size += res;
1592b3f6d66SOleksandr Tymoshenko 		bit_count(evdev->ev_abs_flags, ABS_MT_FIRST, MT_CNT, &res);
1602b3f6d66SOleksandr Tymoshenko 		if (res > 0) {
1612b3f6d66SOleksandr Tymoshenko 			res++;	/* ABS_MT_SLOT or SYN_MT_REPORT */
1622b3f6d66SOleksandr Tymoshenko 			if (bit_test(evdev->ev_abs_flags, ABS_MT_SLOT))
1632b3f6d66SOleksandr Tymoshenko 				/* MT type B */
1642b3f6d66SOleksandr Tymoshenko 				size += res * MAXIMAL_MT_SLOT(evdev);
1652b3f6d66SOleksandr Tymoshenko 			else
1662b3f6d66SOleksandr Tymoshenko 				/* MT type A */
1672b3f6d66SOleksandr Tymoshenko 				size += res * (MAX_MT_REPORTS - 1);
1682b3f6d66SOleksandr Tymoshenko 		}
1692b3f6d66SOleksandr Tymoshenko 	}
1702b3f6d66SOleksandr Tymoshenko 
1712b3f6d66SOleksandr Tymoshenko 	/* All misc events can be reported simultaneously */
1722b3f6d66SOleksandr Tymoshenko 	bit_count(evdev->ev_msc_flags, 0, MSC_CNT, &res);
1732b3f6d66SOleksandr Tymoshenko 	size += res;
1742b3f6d66SOleksandr Tymoshenko 
1752b3f6d66SOleksandr Tymoshenko 	/* All leds can be reported simultaneously */
1762b3f6d66SOleksandr Tymoshenko 	bit_count(evdev->ev_led_flags, 0, LED_CNT, &res);
1772b3f6d66SOleksandr Tymoshenko 	size += res;
1782b3f6d66SOleksandr Tymoshenko 
1792b3f6d66SOleksandr Tymoshenko 	/* Assume other events are generated once per report */
1802b3f6d66SOleksandr Tymoshenko 	bit_ffs(evdev->ev_snd_flags, SND_CNT, &res);
1812b3f6d66SOleksandr Tymoshenko 	size += (res != -1);
1822b3f6d66SOleksandr Tymoshenko 
1832b3f6d66SOleksandr Tymoshenko 	bit_ffs(evdev->ev_sw_flags, SW_CNT, &res);
1842b3f6d66SOleksandr Tymoshenko 	size += (res != -1);
1852b3f6d66SOleksandr Tymoshenko 
1862b3f6d66SOleksandr Tymoshenko 	/* XXX: FF part is not implemented yet */
1872b3f6d66SOleksandr Tymoshenko 
1882b3f6d66SOleksandr Tymoshenko 	size++;		/* SYN_REPORT */
1892b3f6d66SOleksandr Tymoshenko 	return (size);
1902b3f6d66SOleksandr Tymoshenko }
1912b3f6d66SOleksandr Tymoshenko 
192bfbd1bb7SOleksandr Tymoshenko static int
193bfbd1bb7SOleksandr Tymoshenko evdev_register_common(struct evdev_dev *evdev)
1942b3f6d66SOleksandr Tymoshenko {
1952b3f6d66SOleksandr Tymoshenko 	int ret;
1962b3f6d66SOleksandr Tymoshenko 
1972b3f6d66SOleksandr Tymoshenko 	debugf(evdev, "%s: registered evdev provider: %s <%s>\n",
1982b3f6d66SOleksandr Tymoshenko 	    evdev->ev_shortname, evdev->ev_name, evdev->ev_serial);
1992b3f6d66SOleksandr Tymoshenko 
2002b3f6d66SOleksandr Tymoshenko 	/* Initialize internal structures */
2012b3f6d66SOleksandr Tymoshenko 	LIST_INIT(&evdev->ev_clients);
2022b3f6d66SOleksandr Tymoshenko 
2032b3f6d66SOleksandr Tymoshenko 	if (evdev_event_supported(evdev, EV_REP) &&
2042b3f6d66SOleksandr Tymoshenko 	    bit_test(evdev->ev_flags, EVDEV_FLAG_SOFTREPEAT)) {
2052b3f6d66SOleksandr Tymoshenko 		/* Initialize callout */
2062b3f6d66SOleksandr Tymoshenko 		callout_init_mtx(&evdev->ev_rep_callout, &evdev->ev_mtx, 0);
2072b3f6d66SOleksandr Tymoshenko 
2082b3f6d66SOleksandr Tymoshenko 		if (evdev->ev_rep[REP_DELAY] == 0 &&
2092b3f6d66SOleksandr Tymoshenko 		    evdev->ev_rep[REP_PERIOD] == 0) {
2102b3f6d66SOleksandr Tymoshenko 			/* Supply default values */
2112b3f6d66SOleksandr Tymoshenko 			evdev->ev_rep[REP_DELAY] = 250;
2122b3f6d66SOleksandr Tymoshenko 			evdev->ev_rep[REP_PERIOD] = 33;
2132b3f6d66SOleksandr Tymoshenko 		}
2142b3f6d66SOleksandr Tymoshenko 	}
2152b3f6d66SOleksandr Tymoshenko 
2162b3f6d66SOleksandr Tymoshenko 	/* Initialize multitouch protocol type B states */
2172b3f6d66SOleksandr Tymoshenko 	if (bit_test(evdev->ev_abs_flags, ABS_MT_SLOT) &&
2182b3f6d66SOleksandr Tymoshenko 	    evdev->ev_absinfo != NULL && MAXIMAL_MT_SLOT(evdev) > 0)
2192b3f6d66SOleksandr Tymoshenko 		evdev_mt_init(evdev);
2202b3f6d66SOleksandr Tymoshenko 
2212b3f6d66SOleksandr Tymoshenko 	/* Estimate maximum report size */
2222b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_report_size == 0) {
2232b3f6d66SOleksandr Tymoshenko 		ret = evdev_set_report_size(evdev,
2242b3f6d66SOleksandr Tymoshenko 		    evdev_estimate_report_size(evdev));
2252b3f6d66SOleksandr Tymoshenko 		if (ret != 0)
2262b3f6d66SOleksandr Tymoshenko 			goto bail_out;
2272b3f6d66SOleksandr Tymoshenko 	}
2282b3f6d66SOleksandr Tymoshenko 
2292b3f6d66SOleksandr Tymoshenko 	/* Create char device node */
2302b3f6d66SOleksandr Tymoshenko 	ret = evdev_cdev_create(evdev);
2312b3f6d66SOleksandr Tymoshenko bail_out:
232bfbd1bb7SOleksandr Tymoshenko 	return (ret);
233bfbd1bb7SOleksandr Tymoshenko }
234bfbd1bb7SOleksandr Tymoshenko 
235bfbd1bb7SOleksandr Tymoshenko int
236bfbd1bb7SOleksandr Tymoshenko evdev_register(struct evdev_dev *evdev)
237bfbd1bb7SOleksandr Tymoshenko {
238bfbd1bb7SOleksandr Tymoshenko 	int ret;
239bfbd1bb7SOleksandr Tymoshenko 
240bfbd1bb7SOleksandr Tymoshenko 	evdev->ev_lock_type = EV_LOCK_INTERNAL;
241bfbd1bb7SOleksandr Tymoshenko 	evdev->ev_lock = &evdev->ev_mtx;
242bfbd1bb7SOleksandr Tymoshenko 	mtx_init(&evdev->ev_mtx, "evmtx", NULL, MTX_DEF);
243bfbd1bb7SOleksandr Tymoshenko 
244bfbd1bb7SOleksandr Tymoshenko 	ret = evdev_register_common(evdev);
2452b3f6d66SOleksandr Tymoshenko 	if (ret != 0)
2462b3f6d66SOleksandr Tymoshenko 		mtx_destroy(&evdev->ev_mtx);
2472b3f6d66SOleksandr Tymoshenko 
2482b3f6d66SOleksandr Tymoshenko 	return (ret);
2492b3f6d66SOleksandr Tymoshenko }
2502b3f6d66SOleksandr Tymoshenko 
2512b3f6d66SOleksandr Tymoshenko int
252bfbd1bb7SOleksandr Tymoshenko evdev_register_mtx(struct evdev_dev *evdev, struct mtx *mtx)
253bfbd1bb7SOleksandr Tymoshenko {
254bfbd1bb7SOleksandr Tymoshenko 
255bfbd1bb7SOleksandr Tymoshenko 	evdev->ev_lock_type = EV_LOCK_MTX;
256bfbd1bb7SOleksandr Tymoshenko 	evdev->ev_lock = mtx;
257bfbd1bb7SOleksandr Tymoshenko 	return (evdev_register_common(evdev));
258bfbd1bb7SOleksandr Tymoshenko }
259bfbd1bb7SOleksandr Tymoshenko 
260bfbd1bb7SOleksandr Tymoshenko int
2612b3f6d66SOleksandr Tymoshenko evdev_unregister(struct evdev_dev *evdev)
2622b3f6d66SOleksandr Tymoshenko {
2632b3f6d66SOleksandr Tymoshenko 	struct evdev_client *client;
2642b3f6d66SOleksandr Tymoshenko 	int ret;
2652b3f6d66SOleksandr Tymoshenko 	debugf(evdev, "%s: unregistered evdev provider: %s\n",
2662b3f6d66SOleksandr Tymoshenko 	    evdev->ev_shortname, evdev->ev_name);
2672b3f6d66SOleksandr Tymoshenko 
2682b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK(evdev);
2692b3f6d66SOleksandr Tymoshenko 	evdev->ev_cdev->si_drv1 = NULL;
2702b3f6d66SOleksandr Tymoshenko 	/* Wake up sleepers */
2712b3f6d66SOleksandr Tymoshenko 	LIST_FOREACH(client, &evdev->ev_clients, ec_link) {
2722b3f6d66SOleksandr Tymoshenko 		evdev_revoke_client(client);
2732b3f6d66SOleksandr Tymoshenko 		evdev_dispose_client(evdev, client);
2742b3f6d66SOleksandr Tymoshenko 		EVDEV_CLIENT_LOCKQ(client);
2752b3f6d66SOleksandr Tymoshenko 		evdev_notify_event(client);
2762b3f6d66SOleksandr Tymoshenko 		EVDEV_CLIENT_UNLOCKQ(client);
2772b3f6d66SOleksandr Tymoshenko 	}
2782b3f6d66SOleksandr Tymoshenko 	EVDEV_UNLOCK(evdev);
2792b3f6d66SOleksandr Tymoshenko 
2802b3f6d66SOleksandr Tymoshenko 	/* destroy_dev can sleep so release lock */
2812b3f6d66SOleksandr Tymoshenko 	ret = evdev_cdev_destroy(evdev);
2822b3f6d66SOleksandr Tymoshenko 	evdev->ev_cdev = NULL;
283bfbd1bb7SOleksandr Tymoshenko 	if (ret == 0 && evdev->ev_lock_type == EV_LOCK_INTERNAL)
2842b3f6d66SOleksandr Tymoshenko 		mtx_destroy(&evdev->ev_mtx);
2852b3f6d66SOleksandr Tymoshenko 
2862b3f6d66SOleksandr Tymoshenko 	evdev_free_absinfo(evdev->ev_absinfo);
2872b3f6d66SOleksandr Tymoshenko 	evdev_mt_free(evdev);
2882b3f6d66SOleksandr Tymoshenko 
2892b3f6d66SOleksandr Tymoshenko 	return (ret);
2902b3f6d66SOleksandr Tymoshenko }
2912b3f6d66SOleksandr Tymoshenko 
2922b3f6d66SOleksandr Tymoshenko inline void
2932b3f6d66SOleksandr Tymoshenko evdev_set_name(struct evdev_dev *evdev, const char *name)
2942b3f6d66SOleksandr Tymoshenko {
2952b3f6d66SOleksandr Tymoshenko 
2962b3f6d66SOleksandr Tymoshenko 	snprintf(evdev->ev_name, NAMELEN, "%s", name);
2972b3f6d66SOleksandr Tymoshenko }
2982b3f6d66SOleksandr Tymoshenko 
2992b3f6d66SOleksandr Tymoshenko inline void
3002b3f6d66SOleksandr Tymoshenko evdev_set_id(struct evdev_dev *evdev, uint16_t bustype, uint16_t vendor,
3012b3f6d66SOleksandr Tymoshenko     uint16_t product, uint16_t version)
3022b3f6d66SOleksandr Tymoshenko {
3032b3f6d66SOleksandr Tymoshenko 
3042b3f6d66SOleksandr Tymoshenko 	evdev->ev_id = (struct input_id) {
3052b3f6d66SOleksandr Tymoshenko 		.bustype = bustype,
3062b3f6d66SOleksandr Tymoshenko 		.vendor = vendor,
3072b3f6d66SOleksandr Tymoshenko 		.product = product,
3082b3f6d66SOleksandr Tymoshenko 		.version = version
3092b3f6d66SOleksandr Tymoshenko 	};
3102b3f6d66SOleksandr Tymoshenko }
3112b3f6d66SOleksandr Tymoshenko 
3122b3f6d66SOleksandr Tymoshenko inline void
3132b3f6d66SOleksandr Tymoshenko evdev_set_phys(struct evdev_dev *evdev, const char *name)
3142b3f6d66SOleksandr Tymoshenko {
3152b3f6d66SOleksandr Tymoshenko 
3162b3f6d66SOleksandr Tymoshenko 	snprintf(evdev->ev_shortname, NAMELEN, "%s", name);
3172b3f6d66SOleksandr Tymoshenko }
3182b3f6d66SOleksandr Tymoshenko 
3192b3f6d66SOleksandr Tymoshenko inline void
3202b3f6d66SOleksandr Tymoshenko evdev_set_serial(struct evdev_dev *evdev, const char *serial)
3212b3f6d66SOleksandr Tymoshenko {
3222b3f6d66SOleksandr Tymoshenko 
3232b3f6d66SOleksandr Tymoshenko 	snprintf(evdev->ev_serial, NAMELEN, "%s", serial);
3242b3f6d66SOleksandr Tymoshenko }
3252b3f6d66SOleksandr Tymoshenko 
3262b3f6d66SOleksandr Tymoshenko inline void
3272b3f6d66SOleksandr Tymoshenko evdev_set_methods(struct evdev_dev *evdev, void *softc,
3285163e77fSOleksandr Tymoshenko     const struct evdev_methods *methods)
3292b3f6d66SOleksandr Tymoshenko {
3302b3f6d66SOleksandr Tymoshenko 
3312b3f6d66SOleksandr Tymoshenko 	evdev->ev_methods = methods;
3322b3f6d66SOleksandr Tymoshenko 	evdev->ev_softc = softc;
3332b3f6d66SOleksandr Tymoshenko }
3342b3f6d66SOleksandr Tymoshenko 
3352b3f6d66SOleksandr Tymoshenko inline void
3362b3f6d66SOleksandr Tymoshenko evdev_support_prop(struct evdev_dev *evdev, uint16_t prop)
3372b3f6d66SOleksandr Tymoshenko {
3382b3f6d66SOleksandr Tymoshenko 
3392b3f6d66SOleksandr Tymoshenko 	KASSERT(prop < INPUT_PROP_CNT, ("invalid evdev input property"));
3402b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_prop_flags, prop);
3412b3f6d66SOleksandr Tymoshenko }
3422b3f6d66SOleksandr Tymoshenko 
3432b3f6d66SOleksandr Tymoshenko inline void
3442b3f6d66SOleksandr Tymoshenko evdev_support_event(struct evdev_dev *evdev, uint16_t type)
3452b3f6d66SOleksandr Tymoshenko {
3462b3f6d66SOleksandr Tymoshenko 
3472b3f6d66SOleksandr Tymoshenko 	KASSERT(type < EV_CNT, ("invalid evdev event property"));
3482b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_type_flags, type);
3492b3f6d66SOleksandr Tymoshenko }
3502b3f6d66SOleksandr Tymoshenko 
3512b3f6d66SOleksandr Tymoshenko inline void
3522b3f6d66SOleksandr Tymoshenko evdev_support_key(struct evdev_dev *evdev, uint16_t code)
3532b3f6d66SOleksandr Tymoshenko {
3542b3f6d66SOleksandr Tymoshenko 
3552b3f6d66SOleksandr Tymoshenko 	KASSERT(code < KEY_CNT, ("invalid evdev key property"));
3562b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_key_flags, code);
3572b3f6d66SOleksandr Tymoshenko }
3582b3f6d66SOleksandr Tymoshenko 
3592b3f6d66SOleksandr Tymoshenko inline void
3602b3f6d66SOleksandr Tymoshenko evdev_support_rel(struct evdev_dev *evdev, uint16_t code)
3612b3f6d66SOleksandr Tymoshenko {
3622b3f6d66SOleksandr Tymoshenko 
3632b3f6d66SOleksandr Tymoshenko 	KASSERT(code < REL_CNT, ("invalid evdev rel property"));
3642b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_rel_flags, code);
3652b3f6d66SOleksandr Tymoshenko }
3662b3f6d66SOleksandr Tymoshenko 
3672b3f6d66SOleksandr Tymoshenko inline void
3682b3f6d66SOleksandr Tymoshenko evdev_support_abs(struct evdev_dev *evdev, uint16_t code, int32_t value,
3692b3f6d66SOleksandr Tymoshenko     int32_t minimum, int32_t maximum, int32_t fuzz, int32_t flat,
3702b3f6d66SOleksandr Tymoshenko     int32_t resolution)
3712b3f6d66SOleksandr Tymoshenko {
3722b3f6d66SOleksandr Tymoshenko 	struct input_absinfo absinfo;
3732b3f6d66SOleksandr Tymoshenko 
3742b3f6d66SOleksandr Tymoshenko 	KASSERT(code < ABS_CNT, ("invalid evdev abs property"));
3752b3f6d66SOleksandr Tymoshenko 
3762b3f6d66SOleksandr Tymoshenko 	absinfo = (struct input_absinfo) {
3772b3f6d66SOleksandr Tymoshenko 		.value = value,
3782b3f6d66SOleksandr Tymoshenko 		.minimum = minimum,
3792b3f6d66SOleksandr Tymoshenko 		.maximum = maximum,
3802b3f6d66SOleksandr Tymoshenko 		.fuzz = fuzz,
3812b3f6d66SOleksandr Tymoshenko 		.flat = flat,
3822b3f6d66SOleksandr Tymoshenko 		.resolution = resolution,
3832b3f6d66SOleksandr Tymoshenko 	};
3842b3f6d66SOleksandr Tymoshenko 	evdev_set_abs_bit(evdev, code);
3852b3f6d66SOleksandr Tymoshenko 	evdev_set_absinfo(evdev, code, &absinfo);
3862b3f6d66SOleksandr Tymoshenko }
3872b3f6d66SOleksandr Tymoshenko 
3882b3f6d66SOleksandr Tymoshenko inline void
3892b3f6d66SOleksandr Tymoshenko evdev_set_abs_bit(struct evdev_dev *evdev, uint16_t code)
3902b3f6d66SOleksandr Tymoshenko {
3912b3f6d66SOleksandr Tymoshenko 
3922b3f6d66SOleksandr Tymoshenko 	KASSERT(code < ABS_CNT, ("invalid evdev abs property"));
3932b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_absinfo == NULL)
3942b3f6d66SOleksandr Tymoshenko 		evdev->ev_absinfo = evdev_alloc_absinfo();
3952b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_abs_flags, code);
3962b3f6d66SOleksandr Tymoshenko }
3972b3f6d66SOleksandr Tymoshenko 
3982b3f6d66SOleksandr Tymoshenko inline void
3992b3f6d66SOleksandr Tymoshenko evdev_support_msc(struct evdev_dev *evdev, uint16_t code)
4002b3f6d66SOleksandr Tymoshenko {
4012b3f6d66SOleksandr Tymoshenko 
4022b3f6d66SOleksandr Tymoshenko 	KASSERT(code < MSC_CNT, ("invalid evdev msc property"));
4032b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_msc_flags, code);
4042b3f6d66SOleksandr Tymoshenko }
4052b3f6d66SOleksandr Tymoshenko 
4062b3f6d66SOleksandr Tymoshenko 
4072b3f6d66SOleksandr Tymoshenko inline void
4082b3f6d66SOleksandr Tymoshenko evdev_support_led(struct evdev_dev *evdev, uint16_t code)
4092b3f6d66SOleksandr Tymoshenko {
4102b3f6d66SOleksandr Tymoshenko 
4112b3f6d66SOleksandr Tymoshenko 	KASSERT(code < LED_CNT, ("invalid evdev led property"));
4122b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_led_flags, code);
4132b3f6d66SOleksandr Tymoshenko }
4142b3f6d66SOleksandr Tymoshenko 
4152b3f6d66SOleksandr Tymoshenko inline void
4162b3f6d66SOleksandr Tymoshenko evdev_support_snd(struct evdev_dev *evdev, uint16_t code)
4172b3f6d66SOleksandr Tymoshenko {
4182b3f6d66SOleksandr Tymoshenko 
4192b3f6d66SOleksandr Tymoshenko 	KASSERT(code < SND_CNT, ("invalid evdev snd property"));
4202b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_snd_flags, code);
4212b3f6d66SOleksandr Tymoshenko }
4222b3f6d66SOleksandr Tymoshenko 
4232b3f6d66SOleksandr Tymoshenko inline void
4242b3f6d66SOleksandr Tymoshenko evdev_support_sw(struct evdev_dev *evdev, uint16_t code)
4252b3f6d66SOleksandr Tymoshenko {
4262b3f6d66SOleksandr Tymoshenko 
4272b3f6d66SOleksandr Tymoshenko 	KASSERT(code < SW_CNT, ("invalid evdev sw property"));
4282b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_sw_flags, code);
4292b3f6d66SOleksandr Tymoshenko }
4302b3f6d66SOleksandr Tymoshenko 
4312b3f6d66SOleksandr Tymoshenko bool
4322b3f6d66SOleksandr Tymoshenko evdev_event_supported(struct evdev_dev *evdev, uint16_t type)
4332b3f6d66SOleksandr Tymoshenko {
4342b3f6d66SOleksandr Tymoshenko 
4352b3f6d66SOleksandr Tymoshenko 	KASSERT(type < EV_CNT, ("invalid evdev event property"));
4362b3f6d66SOleksandr Tymoshenko 	return (bit_test(evdev->ev_type_flags, type));
4372b3f6d66SOleksandr Tymoshenko }
4382b3f6d66SOleksandr Tymoshenko 
4392b3f6d66SOleksandr Tymoshenko inline void
4402b3f6d66SOleksandr Tymoshenko evdev_set_absinfo(struct evdev_dev *evdev, uint16_t axis,
4412b3f6d66SOleksandr Tymoshenko     struct input_absinfo *absinfo)
4422b3f6d66SOleksandr Tymoshenko {
4432b3f6d66SOleksandr Tymoshenko 
4442b3f6d66SOleksandr Tymoshenko 	KASSERT(axis < ABS_CNT, ("invalid evdev abs property"));
4452b3f6d66SOleksandr Tymoshenko 
4462b3f6d66SOleksandr Tymoshenko 	if (axis == ABS_MT_SLOT &&
4472b3f6d66SOleksandr Tymoshenko 	    (absinfo->maximum < 1 || absinfo->maximum >= MAX_MT_SLOTS))
4482b3f6d66SOleksandr Tymoshenko 		return;
4492b3f6d66SOleksandr Tymoshenko 
4502b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_absinfo == NULL)
4512b3f6d66SOleksandr Tymoshenko 		evdev->ev_absinfo = evdev_alloc_absinfo();
4522b3f6d66SOleksandr Tymoshenko 
4532b3f6d66SOleksandr Tymoshenko 	if (axis == ABS_MT_SLOT)
4542b3f6d66SOleksandr Tymoshenko 		evdev->ev_absinfo[ABS_MT_SLOT].maximum = absinfo->maximum;
4552b3f6d66SOleksandr Tymoshenko 	else
4562b3f6d66SOleksandr Tymoshenko 		memcpy(&evdev->ev_absinfo[axis], absinfo,
4572b3f6d66SOleksandr Tymoshenko 		    sizeof(struct input_absinfo));
4582b3f6d66SOleksandr Tymoshenko }
4592b3f6d66SOleksandr Tymoshenko 
4602b3f6d66SOleksandr Tymoshenko inline void
4612b3f6d66SOleksandr Tymoshenko evdev_set_repeat_params(struct evdev_dev *evdev, uint16_t property, int value)
4622b3f6d66SOleksandr Tymoshenko {
4632b3f6d66SOleksandr Tymoshenko 
4642b3f6d66SOleksandr Tymoshenko 	KASSERT(property < REP_CNT, ("invalid evdev repeat property"));
4652b3f6d66SOleksandr Tymoshenko 	evdev->ev_rep[property] = value;
4662b3f6d66SOleksandr Tymoshenko }
4672b3f6d66SOleksandr Tymoshenko 
4682b3f6d66SOleksandr Tymoshenko inline void
4692b3f6d66SOleksandr Tymoshenko evdev_set_flag(struct evdev_dev *evdev, uint16_t flag)
4702b3f6d66SOleksandr Tymoshenko {
4712b3f6d66SOleksandr Tymoshenko 
4722b3f6d66SOleksandr Tymoshenko 	KASSERT(flag < EVDEV_FLAG_CNT, ("invalid evdev flag property"));
4732b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_flags, flag);
4742b3f6d66SOleksandr Tymoshenko }
4752b3f6d66SOleksandr Tymoshenko 
4762b3f6d66SOleksandr Tymoshenko static int
4772b3f6d66SOleksandr Tymoshenko evdev_check_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
4782b3f6d66SOleksandr Tymoshenko     int32_t value)
4792b3f6d66SOleksandr Tymoshenko {
4802b3f6d66SOleksandr Tymoshenko 
4812b3f6d66SOleksandr Tymoshenko 	if (type >= EV_CNT)
4822b3f6d66SOleksandr Tymoshenko 		return (EINVAL);
4832b3f6d66SOleksandr Tymoshenko 
4842b3f6d66SOleksandr Tymoshenko 	/* Allow SYN events implicitly */
4852b3f6d66SOleksandr Tymoshenko 	if (type != EV_SYN && !evdev_event_supported(evdev, type))
4862b3f6d66SOleksandr Tymoshenko 		return (EINVAL);
4872b3f6d66SOleksandr Tymoshenko 
4882b3f6d66SOleksandr Tymoshenko 	switch (type) {
4892b3f6d66SOleksandr Tymoshenko 	case EV_SYN:
4902b3f6d66SOleksandr Tymoshenko 		if (code >= SYN_CNT)
4912b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
4922b3f6d66SOleksandr Tymoshenko 		break;
4932b3f6d66SOleksandr Tymoshenko 
4942b3f6d66SOleksandr Tymoshenko 	case EV_KEY:
4952b3f6d66SOleksandr Tymoshenko 		if (code >= KEY_CNT)
4962b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
4972b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_key_flags, code))
4982b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
4992b3f6d66SOleksandr Tymoshenko 		break;
5002b3f6d66SOleksandr Tymoshenko 
5012b3f6d66SOleksandr Tymoshenko 	case EV_REL:
5022b3f6d66SOleksandr Tymoshenko 		if (code >= REL_CNT)
5032b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5042b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_rel_flags, code))
5052b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5062b3f6d66SOleksandr Tymoshenko 		break;
5072b3f6d66SOleksandr Tymoshenko 
5082b3f6d66SOleksandr Tymoshenko 	case EV_ABS:
5092b3f6d66SOleksandr Tymoshenko 		if (code >= ABS_CNT)
5102b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5112b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_abs_flags, code))
5122b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5132b3f6d66SOleksandr Tymoshenko 		if (code == ABS_MT_SLOT &&
5142b3f6d66SOleksandr Tymoshenko 		    (value < 0 || value > MAXIMAL_MT_SLOT(evdev)))
5152b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5162b3f6d66SOleksandr Tymoshenko 		if (ABS_IS_MT(code) && evdev->ev_mt == NULL &&
5172b3f6d66SOleksandr Tymoshenko 		    bit_test(evdev->ev_abs_flags, ABS_MT_SLOT))
5182b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5192b3f6d66SOleksandr Tymoshenko 		break;
5202b3f6d66SOleksandr Tymoshenko 
5212b3f6d66SOleksandr Tymoshenko 	case EV_MSC:
5222b3f6d66SOleksandr Tymoshenko 		if (code >= MSC_CNT)
5232b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5242b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_msc_flags, code))
5252b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5262b3f6d66SOleksandr Tymoshenko 		break;
5272b3f6d66SOleksandr Tymoshenko 
5282b3f6d66SOleksandr Tymoshenko 	case EV_LED:
5292b3f6d66SOleksandr Tymoshenko 		if (code >= LED_CNT)
5302b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5312b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_led_flags, code))
5322b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5332b3f6d66SOleksandr Tymoshenko 		break;
5342b3f6d66SOleksandr Tymoshenko 
5352b3f6d66SOleksandr Tymoshenko 	case EV_SND:
5362b3f6d66SOleksandr Tymoshenko 		if (code >= SND_CNT)
5372b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5382b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_snd_flags, code))
5392b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5402b3f6d66SOleksandr Tymoshenko 		break;
5412b3f6d66SOleksandr Tymoshenko 
5422b3f6d66SOleksandr Tymoshenko 	case EV_SW:
5432b3f6d66SOleksandr Tymoshenko 		if (code >= SW_CNT)
5442b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5452b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_sw_flags, code))
5462b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5472b3f6d66SOleksandr Tymoshenko 		break;
5482b3f6d66SOleksandr Tymoshenko 
5492b3f6d66SOleksandr Tymoshenko 	case EV_REP:
5502b3f6d66SOleksandr Tymoshenko 		if (code >= REP_CNT)
5512b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5522b3f6d66SOleksandr Tymoshenko 		break;
5532b3f6d66SOleksandr Tymoshenko 
5542b3f6d66SOleksandr Tymoshenko 	default:
5552b3f6d66SOleksandr Tymoshenko 		return (EINVAL);
5562b3f6d66SOleksandr Tymoshenko 	}
5572b3f6d66SOleksandr Tymoshenko 
5582b3f6d66SOleksandr Tymoshenko 	return (0);
5592b3f6d66SOleksandr Tymoshenko }
5602b3f6d66SOleksandr Tymoshenko 
5612b3f6d66SOleksandr Tymoshenko static void
5622b3f6d66SOleksandr Tymoshenko evdev_modify_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
5632b3f6d66SOleksandr Tymoshenko     int32_t *value)
5642b3f6d66SOleksandr Tymoshenko {
5652b3f6d66SOleksandr Tymoshenko 
5662b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
5672b3f6d66SOleksandr Tymoshenko 
5682b3f6d66SOleksandr Tymoshenko 	switch (type) {
5692b3f6d66SOleksandr Tymoshenko 	case EV_KEY:
5702b3f6d66SOleksandr Tymoshenko 		if (!evdev_event_supported(evdev, EV_REP))
5712b3f6d66SOleksandr Tymoshenko 			break;
5722b3f6d66SOleksandr Tymoshenko 
5732b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_flags, EVDEV_FLAG_SOFTREPEAT)) {
5742b3f6d66SOleksandr Tymoshenko 			/* Detect driver key repeats. */
5752b3f6d66SOleksandr Tymoshenko 			if (bit_test(evdev->ev_key_states, code) &&
5762b3f6d66SOleksandr Tymoshenko 			    *value == KEY_EVENT_DOWN)
5772b3f6d66SOleksandr Tymoshenko 				*value = KEY_EVENT_REPEAT;
5782b3f6d66SOleksandr Tymoshenko 		} else {
5792b3f6d66SOleksandr Tymoshenko 			/* Start/stop callout for evdev repeats */
5802b3f6d66SOleksandr Tymoshenko 			if (bit_test(evdev->ev_key_states, code) == !*value) {
5812b3f6d66SOleksandr Tymoshenko 				if (*value == KEY_EVENT_DOWN)
5822b3f6d66SOleksandr Tymoshenko 					evdev_start_repeat(evdev, code);
5832b3f6d66SOleksandr Tymoshenko 				else
5842b3f6d66SOleksandr Tymoshenko 					evdev_stop_repeat(evdev);
5852b3f6d66SOleksandr Tymoshenko 			}
5862b3f6d66SOleksandr Tymoshenko 		}
5872b3f6d66SOleksandr Tymoshenko 		break;
5882b3f6d66SOleksandr Tymoshenko 
5892b3f6d66SOleksandr Tymoshenko 	case EV_ABS:
5902b3f6d66SOleksandr Tymoshenko 		/* TBD: implement fuzz */
5912b3f6d66SOleksandr Tymoshenko 		break;
5922b3f6d66SOleksandr Tymoshenko 	}
5932b3f6d66SOleksandr Tymoshenko }
5942b3f6d66SOleksandr Tymoshenko 
5952b3f6d66SOleksandr Tymoshenko static enum evdev_sparse_result
5962b3f6d66SOleksandr Tymoshenko evdev_sparse_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
5972b3f6d66SOleksandr Tymoshenko     int32_t value)
5982b3f6d66SOleksandr Tymoshenko {
5992b3f6d66SOleksandr Tymoshenko 	int32_t last_mt_slot;
6002b3f6d66SOleksandr Tymoshenko 
6012b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
6022b3f6d66SOleksandr Tymoshenko 
6032b3f6d66SOleksandr Tymoshenko 	/*
6042b3f6d66SOleksandr Tymoshenko 	 * For certain event types, update device state bits
6052b3f6d66SOleksandr Tymoshenko 	 * and convert level reporting to edge reporting
6062b3f6d66SOleksandr Tymoshenko 	 */
6072b3f6d66SOleksandr Tymoshenko 	switch (type) {
6082b3f6d66SOleksandr Tymoshenko 	case EV_KEY:
6092b3f6d66SOleksandr Tymoshenko 		switch (value) {
6102b3f6d66SOleksandr Tymoshenko 		case KEY_EVENT_UP:
6112b3f6d66SOleksandr Tymoshenko 		case KEY_EVENT_DOWN:
6122b3f6d66SOleksandr Tymoshenko 			if (bit_test(evdev->ev_key_states, code) == value)
6132b3f6d66SOleksandr Tymoshenko 				return (EV_SKIP_EVENT);
6142b3f6d66SOleksandr Tymoshenko 			bit_change(evdev->ev_key_states, code, value);
6152b3f6d66SOleksandr Tymoshenko 			break;
6162b3f6d66SOleksandr Tymoshenko 
6172b3f6d66SOleksandr Tymoshenko 		case KEY_EVENT_REPEAT:
6182b3f6d66SOleksandr Tymoshenko 			if (bit_test(evdev->ev_key_states, code) == 0 ||
6192b3f6d66SOleksandr Tymoshenko 			    !evdev_event_supported(evdev, EV_REP))
6202b3f6d66SOleksandr Tymoshenko 				return (EV_SKIP_EVENT);
6212b3f6d66SOleksandr Tymoshenko 			break;
6222b3f6d66SOleksandr Tymoshenko 
6232b3f6d66SOleksandr Tymoshenko 		default:
6242b3f6d66SOleksandr Tymoshenko 			 return (EV_SKIP_EVENT);
6252b3f6d66SOleksandr Tymoshenko 		}
6262b3f6d66SOleksandr Tymoshenko 		break;
6272b3f6d66SOleksandr Tymoshenko 
6282b3f6d66SOleksandr Tymoshenko 	case EV_LED:
6292b3f6d66SOleksandr Tymoshenko 		if (bit_test(evdev->ev_led_states, code) == value)
6302b3f6d66SOleksandr Tymoshenko 			return (EV_SKIP_EVENT);
6312b3f6d66SOleksandr Tymoshenko 		bit_change(evdev->ev_led_states, code, value);
6322b3f6d66SOleksandr Tymoshenko 		break;
6332b3f6d66SOleksandr Tymoshenko 
6342b3f6d66SOleksandr Tymoshenko 	case EV_SND:
6352b3f6d66SOleksandr Tymoshenko 		if (bit_test(evdev->ev_snd_states, code) == value)
6362b3f6d66SOleksandr Tymoshenko 			return (EV_SKIP_EVENT);
6372b3f6d66SOleksandr Tymoshenko 		bit_change(evdev->ev_snd_states, code, value);
6382b3f6d66SOleksandr Tymoshenko 		break;
6392b3f6d66SOleksandr Tymoshenko 
6402b3f6d66SOleksandr Tymoshenko 	case EV_SW:
6412b3f6d66SOleksandr Tymoshenko 		if (bit_test(evdev->ev_sw_states, code) == value)
6422b3f6d66SOleksandr Tymoshenko 			return (EV_SKIP_EVENT);
6432b3f6d66SOleksandr Tymoshenko 		bit_change(evdev->ev_sw_states, code, value);
6442b3f6d66SOleksandr Tymoshenko 		break;
6452b3f6d66SOleksandr Tymoshenko 
6462b3f6d66SOleksandr Tymoshenko 	case EV_REP:
6472b3f6d66SOleksandr Tymoshenko 		if (evdev->ev_rep[code] == value)
6482b3f6d66SOleksandr Tymoshenko 			return (EV_SKIP_EVENT);
6492b3f6d66SOleksandr Tymoshenko 		evdev_set_repeat_params(evdev, code, value);
6502b3f6d66SOleksandr Tymoshenko 		break;
6512b3f6d66SOleksandr Tymoshenko 
6522b3f6d66SOleksandr Tymoshenko 	case EV_REL:
6532b3f6d66SOleksandr Tymoshenko 		if (value == 0)
6542b3f6d66SOleksandr Tymoshenko 			return (EV_SKIP_EVENT);
6552b3f6d66SOleksandr Tymoshenko 		break;
6562b3f6d66SOleksandr Tymoshenko 
6572b3f6d66SOleksandr Tymoshenko 	/* For EV_ABS, save last value in absinfo and ev_mt_states */
6582b3f6d66SOleksandr Tymoshenko 	case EV_ABS:
6592b3f6d66SOleksandr Tymoshenko 		switch (code) {
6602b3f6d66SOleksandr Tymoshenko 		case ABS_MT_SLOT:
6612b3f6d66SOleksandr Tymoshenko 			/* Postpone ABS_MT_SLOT till next event */
6622b3f6d66SOleksandr Tymoshenko 			evdev_set_last_mt_slot(evdev, value);
6632b3f6d66SOleksandr Tymoshenko 			return (EV_SKIP_EVENT);
6642b3f6d66SOleksandr Tymoshenko 
6652b3f6d66SOleksandr Tymoshenko 		case ABS_MT_FIRST ... ABS_MT_LAST:
6662b3f6d66SOleksandr Tymoshenko 			/* Pass MT protocol type A events as is */
6672b3f6d66SOleksandr Tymoshenko 			if (!bit_test(evdev->ev_abs_flags, ABS_MT_SLOT))
6682b3f6d66SOleksandr Tymoshenko 				break;
6692b3f6d66SOleksandr Tymoshenko 			/* Don`t repeat MT protocol type B events */
6702b3f6d66SOleksandr Tymoshenko 			last_mt_slot = evdev_get_last_mt_slot(evdev);
6712b3f6d66SOleksandr Tymoshenko 			if (evdev_get_mt_value(evdev, last_mt_slot, code)
6722b3f6d66SOleksandr Tymoshenko 			     == value)
6732b3f6d66SOleksandr Tymoshenko 				return (EV_SKIP_EVENT);
6742b3f6d66SOleksandr Tymoshenko 			evdev_set_mt_value(evdev, last_mt_slot, code, value);
6752b3f6d66SOleksandr Tymoshenko 			if (last_mt_slot != CURRENT_MT_SLOT(evdev)) {
6762b3f6d66SOleksandr Tymoshenko 				CURRENT_MT_SLOT(evdev) = last_mt_slot;
6772b3f6d66SOleksandr Tymoshenko 				evdev->ev_report_opened = true;
6782b3f6d66SOleksandr Tymoshenko 				return (EV_REPORT_MT_SLOT);
6792b3f6d66SOleksandr Tymoshenko 			}
6802b3f6d66SOleksandr Tymoshenko 			break;
6812b3f6d66SOleksandr Tymoshenko 
6822b3f6d66SOleksandr Tymoshenko 		default:
6832b3f6d66SOleksandr Tymoshenko 			if (evdev->ev_absinfo[code].value == value)
6842b3f6d66SOleksandr Tymoshenko 				return (EV_SKIP_EVENT);
6852b3f6d66SOleksandr Tymoshenko 			evdev->ev_absinfo[code].value = value;
6862b3f6d66SOleksandr Tymoshenko 		}
6872b3f6d66SOleksandr Tymoshenko 		break;
6882b3f6d66SOleksandr Tymoshenko 
6892b3f6d66SOleksandr Tymoshenko 	case EV_SYN:
6902b3f6d66SOleksandr Tymoshenko 		if (code == SYN_REPORT) {
691c736a757SOleksandr Tymoshenko 			/* Count empty reports as well as non empty */
692c736a757SOleksandr Tymoshenko 			evdev->ev_report_count++;
6932b3f6d66SOleksandr Tymoshenko 			/* Skip empty reports */
6942b3f6d66SOleksandr Tymoshenko 			if (!evdev->ev_report_opened)
6952b3f6d66SOleksandr Tymoshenko 				return (EV_SKIP_EVENT);
6962b3f6d66SOleksandr Tymoshenko 			evdev->ev_report_opened = false;
6972b3f6d66SOleksandr Tymoshenko 			return (EV_REPORT_EVENT);
6982b3f6d66SOleksandr Tymoshenko 		}
6992b3f6d66SOleksandr Tymoshenko 		break;
7002b3f6d66SOleksandr Tymoshenko 	}
7012b3f6d66SOleksandr Tymoshenko 
7022b3f6d66SOleksandr Tymoshenko 	evdev->ev_report_opened = true;
7032b3f6d66SOleksandr Tymoshenko 	return (EV_REPORT_EVENT);
7042b3f6d66SOleksandr Tymoshenko }
7052b3f6d66SOleksandr Tymoshenko 
7062b3f6d66SOleksandr Tymoshenko static void
7072b3f6d66SOleksandr Tymoshenko evdev_propagate_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
7082b3f6d66SOleksandr Tymoshenko     int32_t value)
7092b3f6d66SOleksandr Tymoshenko {
7102b3f6d66SOleksandr Tymoshenko 	struct evdev_client *client;
7112b3f6d66SOleksandr Tymoshenko 
7122b3f6d66SOleksandr Tymoshenko 	debugf(evdev, "%s pushed event %d/%d/%d",
7132b3f6d66SOleksandr Tymoshenko 	    evdev->ev_shortname, type, code, value);
7142b3f6d66SOleksandr Tymoshenko 
7152b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
7162b3f6d66SOleksandr Tymoshenko 
7172b3f6d66SOleksandr Tymoshenko 	/* Propagate event through all clients */
7182b3f6d66SOleksandr Tymoshenko 	LIST_FOREACH(client, &evdev->ev_clients, ec_link) {
7192b3f6d66SOleksandr Tymoshenko 		if (evdev->ev_grabber != NULL && evdev->ev_grabber != client)
7202b3f6d66SOleksandr Tymoshenko 			continue;
7212b3f6d66SOleksandr Tymoshenko 
7222b3f6d66SOleksandr Tymoshenko 		EVDEV_CLIENT_LOCKQ(client);
7232b3f6d66SOleksandr Tymoshenko 		evdev_client_push(client, type, code, value);
7242b3f6d66SOleksandr Tymoshenko 		if (type == EV_SYN && code == SYN_REPORT)
7252b3f6d66SOleksandr Tymoshenko 			evdev_notify_event(client);
7262b3f6d66SOleksandr Tymoshenko 		EVDEV_CLIENT_UNLOCKQ(client);
7272b3f6d66SOleksandr Tymoshenko 	}
7282b3f6d66SOleksandr Tymoshenko 
7292b3f6d66SOleksandr Tymoshenko 	evdev->ev_event_count++;
7302b3f6d66SOleksandr Tymoshenko }
7312b3f6d66SOleksandr Tymoshenko 
7322b3f6d66SOleksandr Tymoshenko void
7332b3f6d66SOleksandr Tymoshenko evdev_send_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
7342b3f6d66SOleksandr Tymoshenko     int32_t value)
7352b3f6d66SOleksandr Tymoshenko {
7362b3f6d66SOleksandr Tymoshenko 	enum evdev_sparse_result sparse;
7372b3f6d66SOleksandr Tymoshenko 
7382b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
7392b3f6d66SOleksandr Tymoshenko 
7402b3f6d66SOleksandr Tymoshenko 	sparse =  evdev_sparse_event(evdev, type, code, value);
7412b3f6d66SOleksandr Tymoshenko 	switch (sparse) {
7422b3f6d66SOleksandr Tymoshenko 	case EV_REPORT_MT_SLOT:
7432b3f6d66SOleksandr Tymoshenko 		/* report postponed ABS_MT_SLOT */
7442b3f6d66SOleksandr Tymoshenko 		evdev_propagate_event(evdev, EV_ABS, ABS_MT_SLOT,
7452b3f6d66SOleksandr Tymoshenko 		    CURRENT_MT_SLOT(evdev));
7462b3f6d66SOleksandr Tymoshenko 		/* FALLTHROUGH */
7472b3f6d66SOleksandr Tymoshenko 	case EV_REPORT_EVENT:
7482b3f6d66SOleksandr Tymoshenko 		evdev_propagate_event(evdev, type, code, value);
7492b3f6d66SOleksandr Tymoshenko 		/* FALLTHROUGH */
7502b3f6d66SOleksandr Tymoshenko 	case EV_SKIP_EVENT:
7512b3f6d66SOleksandr Tymoshenko 		break;
7522b3f6d66SOleksandr Tymoshenko 	}
7532b3f6d66SOleksandr Tymoshenko }
7542b3f6d66SOleksandr Tymoshenko 
7552b3f6d66SOleksandr Tymoshenko int
7562b3f6d66SOleksandr Tymoshenko evdev_push_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
7572b3f6d66SOleksandr Tymoshenko     int32_t value)
7582b3f6d66SOleksandr Tymoshenko {
7592b3f6d66SOleksandr Tymoshenko 
7602b3f6d66SOleksandr Tymoshenko 	if (evdev_check_event(evdev, type, code, value) != 0)
7612b3f6d66SOleksandr Tymoshenko 		return (EINVAL);
7622b3f6d66SOleksandr Tymoshenko 
763*4c0a4665SVladimir Kondratyev 	EVDEV_ENTER(evdev);
764*4c0a4665SVladimir Kondratyev 
7652b3f6d66SOleksandr Tymoshenko 	evdev_modify_event(evdev, type, code, &value);
766c736a757SOleksandr Tymoshenko 	if (type == EV_SYN && code == SYN_REPORT &&
767c736a757SOleksandr Tymoshenko 	     bit_test(evdev->ev_flags, EVDEV_FLAG_MT_AUTOREL))
768c736a757SOleksandr Tymoshenko 		evdev_send_mt_autorel(evdev);
7692b3f6d66SOleksandr Tymoshenko 	if (type == EV_SYN && code == SYN_REPORT && evdev->ev_report_opened &&
7702b3f6d66SOleksandr Tymoshenko 	    bit_test(evdev->ev_flags, EVDEV_FLAG_MT_STCOMPAT))
7712b3f6d66SOleksandr Tymoshenko 		evdev_send_mt_compat(evdev);
7722b3f6d66SOleksandr Tymoshenko 	evdev_send_event(evdev, type, code, value);
773*4c0a4665SVladimir Kondratyev 
774*4c0a4665SVladimir Kondratyev 	EVDEV_EXIT(evdev);
7752b3f6d66SOleksandr Tymoshenko 
7762b3f6d66SOleksandr Tymoshenko 	return (0);
7772b3f6d66SOleksandr Tymoshenko }
7782b3f6d66SOleksandr Tymoshenko 
7792b3f6d66SOleksandr Tymoshenko int
7802b3f6d66SOleksandr Tymoshenko evdev_inject_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
7812b3f6d66SOleksandr Tymoshenko     int32_t value)
7822b3f6d66SOleksandr Tymoshenko {
7832b3f6d66SOleksandr Tymoshenko 	int ret = 0;
7842b3f6d66SOleksandr Tymoshenko 
7852b3f6d66SOleksandr Tymoshenko 	switch (type) {
7862b3f6d66SOleksandr Tymoshenko 	case EV_REP:
7872b3f6d66SOleksandr Tymoshenko 		/* evdev repeats should not be processed by hardware driver */
7882b3f6d66SOleksandr Tymoshenko 		if (bit_test(evdev->ev_flags, EVDEV_FLAG_SOFTREPEAT))
7892b3f6d66SOleksandr Tymoshenko 			goto push;
7902b3f6d66SOleksandr Tymoshenko 		/* FALLTHROUGH */
7912b3f6d66SOleksandr Tymoshenko 	case EV_LED:
7922b3f6d66SOleksandr Tymoshenko 	case EV_MSC:
7932b3f6d66SOleksandr Tymoshenko 	case EV_SND:
7942b3f6d66SOleksandr Tymoshenko 	case EV_FF:
7952b3f6d66SOleksandr Tymoshenko 		if (evdev->ev_methods != NULL &&
7962b3f6d66SOleksandr Tymoshenko 		    evdev->ev_methods->ev_event != NULL)
7972b3f6d66SOleksandr Tymoshenko 			evdev->ev_methods->ev_event(evdev, evdev->ev_softc,
7982b3f6d66SOleksandr Tymoshenko 			    type, code, value);
7992b3f6d66SOleksandr Tymoshenko 		/*
8002b3f6d66SOleksandr Tymoshenko 		 * Leds and driver repeats should be reported in ev_event
8012b3f6d66SOleksandr Tymoshenko 		 * method body to interoperate with kbdmux states and rates
8022b3f6d66SOleksandr Tymoshenko 		 * propagation so both ways (ioctl and evdev) of changing it
8032b3f6d66SOleksandr Tymoshenko 		 * will produce only one evdev event report to client.
8042b3f6d66SOleksandr Tymoshenko 		 */
8052b3f6d66SOleksandr Tymoshenko 		if (type == EV_LED || type == EV_REP)
8062b3f6d66SOleksandr Tymoshenko 			break;
8072b3f6d66SOleksandr Tymoshenko 		/* FALLTHROUGH */
8082b3f6d66SOleksandr Tymoshenko 	case EV_SYN:
8092b3f6d66SOleksandr Tymoshenko 	case EV_KEY:
8102b3f6d66SOleksandr Tymoshenko 	case EV_REL:
8112b3f6d66SOleksandr Tymoshenko 	case EV_ABS:
8122b3f6d66SOleksandr Tymoshenko 	case EV_SW:
8132b3f6d66SOleksandr Tymoshenko push:
8142b3f6d66SOleksandr Tymoshenko 		ret = evdev_push_event(evdev, type,  code, value);
8152b3f6d66SOleksandr Tymoshenko 		break;
8162b3f6d66SOleksandr Tymoshenko 
8172b3f6d66SOleksandr Tymoshenko 	default:
8182b3f6d66SOleksandr Tymoshenko 		ret = EINVAL;
8192b3f6d66SOleksandr Tymoshenko 	}
8202b3f6d66SOleksandr Tymoshenko 
8212b3f6d66SOleksandr Tymoshenko 	return (ret);
8222b3f6d66SOleksandr Tymoshenko }
8232b3f6d66SOleksandr Tymoshenko 
8242b3f6d66SOleksandr Tymoshenko int
8252b3f6d66SOleksandr Tymoshenko evdev_register_client(struct evdev_dev *evdev, struct evdev_client *client)
8262b3f6d66SOleksandr Tymoshenko {
8272b3f6d66SOleksandr Tymoshenko 	int ret = 0;
8282b3f6d66SOleksandr Tymoshenko 
8292b3f6d66SOleksandr Tymoshenko 	debugf(evdev, "adding new client for device %s", evdev->ev_shortname);
8302b3f6d66SOleksandr Tymoshenko 
8312b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
8322b3f6d66SOleksandr Tymoshenko 
8332b3f6d66SOleksandr Tymoshenko 	if (LIST_EMPTY(&evdev->ev_clients) && evdev->ev_methods != NULL &&
8342b3f6d66SOleksandr Tymoshenko 	    evdev->ev_methods->ev_open != NULL) {
8352b3f6d66SOleksandr Tymoshenko 		debugf(evdev, "calling ev_open() on device %s",
8362b3f6d66SOleksandr Tymoshenko 		    evdev->ev_shortname);
8372b3f6d66SOleksandr Tymoshenko 		ret = evdev->ev_methods->ev_open(evdev, evdev->ev_softc);
8382b3f6d66SOleksandr Tymoshenko 	}
8392b3f6d66SOleksandr Tymoshenko 	if (ret == 0)
8402b3f6d66SOleksandr Tymoshenko 		LIST_INSERT_HEAD(&evdev->ev_clients, client, ec_link);
8412b3f6d66SOleksandr Tymoshenko 	return (ret);
8422b3f6d66SOleksandr Tymoshenko }
8432b3f6d66SOleksandr Tymoshenko 
8442b3f6d66SOleksandr Tymoshenko void
8452b3f6d66SOleksandr Tymoshenko evdev_dispose_client(struct evdev_dev *evdev, struct evdev_client *client)
8462b3f6d66SOleksandr Tymoshenko {
8472b3f6d66SOleksandr Tymoshenko 	debugf(evdev, "removing client for device %s", evdev->ev_shortname);
8482b3f6d66SOleksandr Tymoshenko 
8492b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
8502b3f6d66SOleksandr Tymoshenko 
8512b3f6d66SOleksandr Tymoshenko 	LIST_REMOVE(client, ec_link);
8522b3f6d66SOleksandr Tymoshenko 	if (LIST_EMPTY(&evdev->ev_clients)) {
8532b3f6d66SOleksandr Tymoshenko 		if (evdev->ev_methods != NULL &&
8542b3f6d66SOleksandr Tymoshenko 		    evdev->ev_methods->ev_close != NULL)
8552b3f6d66SOleksandr Tymoshenko 			evdev->ev_methods->ev_close(evdev, evdev->ev_softc);
8562b3f6d66SOleksandr Tymoshenko 		if (evdev_event_supported(evdev, EV_REP) &&
8572b3f6d66SOleksandr Tymoshenko 		    bit_test(evdev->ev_flags, EVDEV_FLAG_SOFTREPEAT))
8582b3f6d66SOleksandr Tymoshenko 			evdev_stop_repeat(evdev);
8592b3f6d66SOleksandr Tymoshenko 	}
8602b3f6d66SOleksandr Tymoshenko 	evdev_release_client(evdev, client);
8612b3f6d66SOleksandr Tymoshenko }
8622b3f6d66SOleksandr Tymoshenko 
8632b3f6d66SOleksandr Tymoshenko int
8642b3f6d66SOleksandr Tymoshenko evdev_grab_client(struct evdev_dev *evdev, struct evdev_client *client)
8652b3f6d66SOleksandr Tymoshenko {
8662b3f6d66SOleksandr Tymoshenko 
8672b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
8682b3f6d66SOleksandr Tymoshenko 
8692b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_grabber != NULL)
8702b3f6d66SOleksandr Tymoshenko 		return (EBUSY);
8712b3f6d66SOleksandr Tymoshenko 
8722b3f6d66SOleksandr Tymoshenko 	evdev->ev_grabber = client;
8732b3f6d66SOleksandr Tymoshenko 
8742b3f6d66SOleksandr Tymoshenko 	return (0);
8752b3f6d66SOleksandr Tymoshenko }
8762b3f6d66SOleksandr Tymoshenko 
8772b3f6d66SOleksandr Tymoshenko int
8782b3f6d66SOleksandr Tymoshenko evdev_release_client(struct evdev_dev *evdev, struct evdev_client *client)
8792b3f6d66SOleksandr Tymoshenko {
8802b3f6d66SOleksandr Tymoshenko 
8812b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
8822b3f6d66SOleksandr Tymoshenko 
8832b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_grabber != client)
8842b3f6d66SOleksandr Tymoshenko 		return (EINVAL);
8852b3f6d66SOleksandr Tymoshenko 
8862b3f6d66SOleksandr Tymoshenko 	evdev->ev_grabber = NULL;
8872b3f6d66SOleksandr Tymoshenko 
8882b3f6d66SOleksandr Tymoshenko 	return (0);
8892b3f6d66SOleksandr Tymoshenko }
8902b3f6d66SOleksandr Tymoshenko 
8912b3f6d66SOleksandr Tymoshenko static void
8922b3f6d66SOleksandr Tymoshenko evdev_repeat_callout(void *arg)
8932b3f6d66SOleksandr Tymoshenko {
8942b3f6d66SOleksandr Tymoshenko 	struct evdev_dev *evdev = (struct evdev_dev *)arg;
8952b3f6d66SOleksandr Tymoshenko 
8962b3f6d66SOleksandr Tymoshenko 	evdev_send_event(evdev, EV_KEY, evdev->ev_rep_key, KEY_EVENT_REPEAT);
8972b3f6d66SOleksandr Tymoshenko 	evdev_send_event(evdev, EV_SYN, SYN_REPORT, 1);
8982b3f6d66SOleksandr Tymoshenko 
8992b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_rep[REP_PERIOD])
9002b3f6d66SOleksandr Tymoshenko 		callout_reset(&evdev->ev_rep_callout,
9012b3f6d66SOleksandr Tymoshenko 		    evdev->ev_rep[REP_PERIOD] * hz / 1000,
9022b3f6d66SOleksandr Tymoshenko 		    evdev_repeat_callout, evdev);
9032b3f6d66SOleksandr Tymoshenko 	else
9042b3f6d66SOleksandr Tymoshenko 		evdev->ev_rep_key = KEY_RESERVED;
9052b3f6d66SOleksandr Tymoshenko }
9062b3f6d66SOleksandr Tymoshenko 
9072b3f6d66SOleksandr Tymoshenko static void
9082b3f6d66SOleksandr Tymoshenko evdev_start_repeat(struct evdev_dev *evdev, uint16_t key)
9092b3f6d66SOleksandr Tymoshenko {
9102b3f6d66SOleksandr Tymoshenko 
9112b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
9122b3f6d66SOleksandr Tymoshenko 
9132b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_rep[REP_DELAY]) {
9142b3f6d66SOleksandr Tymoshenko 		evdev->ev_rep_key = key;
9152b3f6d66SOleksandr Tymoshenko 		callout_reset(&evdev->ev_rep_callout,
9162b3f6d66SOleksandr Tymoshenko 		    evdev->ev_rep[REP_DELAY] * hz / 1000,
9172b3f6d66SOleksandr Tymoshenko 		    evdev_repeat_callout, evdev);
9182b3f6d66SOleksandr Tymoshenko 	}
9192b3f6d66SOleksandr Tymoshenko }
9202b3f6d66SOleksandr Tymoshenko 
9212b3f6d66SOleksandr Tymoshenko static void
9222b3f6d66SOleksandr Tymoshenko evdev_stop_repeat(struct evdev_dev *evdev)
9232b3f6d66SOleksandr Tymoshenko {
9242b3f6d66SOleksandr Tymoshenko 
9252b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
9262b3f6d66SOleksandr Tymoshenko 
9272b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_rep_key != KEY_RESERVED) {
9282b3f6d66SOleksandr Tymoshenko 		callout_stop(&evdev->ev_rep_callout);
9292b3f6d66SOleksandr Tymoshenko 		evdev->ev_rep_key = KEY_RESERVED;
9302b3f6d66SOleksandr Tymoshenko 	}
9312b3f6d66SOleksandr Tymoshenko }
932fa26e8edSOleksandr Tymoshenko 
933fa26e8edSOleksandr Tymoshenko MODULE_VERSION(evdev, 1);
934