xref: /freebsd/sys/dev/evdev/evdev.c (revision 911aed94fa3a6b7c99aae26c48c0724ada8ab787)
12b3f6d66SOleksandr Tymoshenko /*-
22b3f6d66SOleksandr Tymoshenko  * Copyright (c) 2014 Jakub Wojciech Klama <jceel@FreeBSD.org>
3e6502802SVladimir Kondratyev  * Copyright (c) 2015-2016 Vladimir Kondratyev <wulf@FreeBSD.org>
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");
53303dbb85SVladimir Kondratyev #ifdef EVDEV_SUPPORT
54303dbb85SVladimir Kondratyev FEATURE(evdev_support, "Evdev support in hybrid drivers");
55303dbb85SVladimir Kondratyev #endif
562b3f6d66SOleksandr Tymoshenko #endif
572b3f6d66SOleksandr Tymoshenko 
582b3f6d66SOleksandr Tymoshenko enum evdev_sparse_result
592b3f6d66SOleksandr Tymoshenko {
602b3f6d66SOleksandr Tymoshenko 	EV_SKIP_EVENT,		/* Event value not changed */
612b3f6d66SOleksandr Tymoshenko 	EV_REPORT_EVENT,	/* Event value changed */
622b3f6d66SOleksandr Tymoshenko 	EV_REPORT_MT_SLOT,	/* Event value and MT slot number changed */
632b3f6d66SOleksandr Tymoshenko };
642b3f6d66SOleksandr Tymoshenko 
652b3f6d66SOleksandr Tymoshenko MALLOC_DEFINE(M_EVDEV, "evdev", "evdev memory");
662b3f6d66SOleksandr Tymoshenko 
672b3f6d66SOleksandr Tymoshenko int evdev_rcpt_mask = EVDEV_RCPT_SYSMOUSE | EVDEV_RCPT_KBDMUX;
684af79d4fSOleksandr Tymoshenko int evdev_sysmouse_t_axis = 0;
692b3f6d66SOleksandr Tymoshenko 
70233e1074SVladimir Kondratyev #ifdef EVDEV_SUPPORT
712b3f6d66SOleksandr Tymoshenko SYSCTL_NODE(_kern, OID_AUTO, evdev, CTLFLAG_RW, 0, "Evdev args");
722b3f6d66SOleksandr Tymoshenko SYSCTL_INT(_kern_evdev, OID_AUTO, rcpt_mask, CTLFLAG_RW, &evdev_rcpt_mask, 0,
732b3f6d66SOleksandr Tymoshenko     "Who is receiving events: bit0 - sysmouse, bit1 - kbdmux, "
742b3f6d66SOleksandr Tymoshenko     "bit2 - mouse hardware, bit3 - keyboard hardware");
754af79d4fSOleksandr Tymoshenko SYSCTL_INT(_kern_evdev, OID_AUTO, sysmouse_t_axis, CTLFLAG_RW,
764af79d4fSOleksandr Tymoshenko     &evdev_sysmouse_t_axis, 0, "Extract T-axis from 0-none, 1-ums, 2-psm");
77233e1074SVladimir Kondratyev #endif
782b3f6d66SOleksandr Tymoshenko 
792b3f6d66SOleksandr Tymoshenko static void evdev_start_repeat(struct evdev_dev *, uint16_t);
802b3f6d66SOleksandr Tymoshenko static void evdev_stop_repeat(struct evdev_dev *);
812b3f6d66SOleksandr Tymoshenko static int evdev_check_event(struct evdev_dev *, uint16_t, uint16_t, int32_t);
822b3f6d66SOleksandr Tymoshenko 
832b3f6d66SOleksandr Tymoshenko static inline void
842b3f6d66SOleksandr Tymoshenko bit_change(bitstr_t *bitstr, int bit, int value)
852b3f6d66SOleksandr Tymoshenko {
862b3f6d66SOleksandr Tymoshenko 	if (value)
872b3f6d66SOleksandr Tymoshenko 		bit_set(bitstr, bit);
882b3f6d66SOleksandr Tymoshenko 	else
892b3f6d66SOleksandr Tymoshenko 		bit_clear(bitstr, bit);
902b3f6d66SOleksandr Tymoshenko }
912b3f6d66SOleksandr Tymoshenko 
922b3f6d66SOleksandr Tymoshenko struct evdev_dev *
932b3f6d66SOleksandr Tymoshenko evdev_alloc(void)
942b3f6d66SOleksandr Tymoshenko {
952b3f6d66SOleksandr Tymoshenko 
962b3f6d66SOleksandr Tymoshenko 	return malloc(sizeof(struct evdev_dev), M_EVDEV, M_WAITOK | M_ZERO);
972b3f6d66SOleksandr Tymoshenko }
982b3f6d66SOleksandr Tymoshenko 
992b3f6d66SOleksandr Tymoshenko void
1002b3f6d66SOleksandr Tymoshenko evdev_free(struct evdev_dev *evdev)
1012b3f6d66SOleksandr Tymoshenko {
1022b3f6d66SOleksandr Tymoshenko 
103c3f2135cSOleksandr Tymoshenko 	if (evdev != NULL && evdev->ev_cdev != NULL &&
104c3f2135cSOleksandr Tymoshenko 	    evdev->ev_cdev->si_drv1 != NULL)
1052b3f6d66SOleksandr Tymoshenko 		evdev_unregister(evdev);
1062b3f6d66SOleksandr Tymoshenko 
1072b3f6d66SOleksandr Tymoshenko 	free(evdev, M_EVDEV);
1082b3f6d66SOleksandr Tymoshenko }
1092b3f6d66SOleksandr Tymoshenko 
1102b3f6d66SOleksandr Tymoshenko static struct input_absinfo *
1112b3f6d66SOleksandr Tymoshenko evdev_alloc_absinfo(void)
1122b3f6d66SOleksandr Tymoshenko {
1132b3f6d66SOleksandr Tymoshenko 
1142b3f6d66SOleksandr Tymoshenko 	return (malloc(sizeof(struct input_absinfo) * ABS_CNT, M_EVDEV,
1152b3f6d66SOleksandr Tymoshenko 	    M_WAITOK | M_ZERO));
1162b3f6d66SOleksandr Tymoshenko }
1172b3f6d66SOleksandr Tymoshenko 
1182b3f6d66SOleksandr Tymoshenko static void
1192b3f6d66SOleksandr Tymoshenko evdev_free_absinfo(struct input_absinfo *absinfo)
1202b3f6d66SOleksandr Tymoshenko {
1212b3f6d66SOleksandr Tymoshenko 
1222b3f6d66SOleksandr Tymoshenko 	free(absinfo, M_EVDEV);
1232b3f6d66SOleksandr Tymoshenko }
1242b3f6d66SOleksandr Tymoshenko 
1252b3f6d66SOleksandr Tymoshenko int
1262b3f6d66SOleksandr Tymoshenko evdev_set_report_size(struct evdev_dev *evdev, size_t report_size)
1272b3f6d66SOleksandr Tymoshenko {
1282b3f6d66SOleksandr Tymoshenko 	if (report_size > KEY_CNT + REL_CNT + ABS_CNT + MAX_MT_SLOTS * MT_CNT +
1292b3f6d66SOleksandr Tymoshenko 	    MSC_CNT + LED_CNT + SND_CNT + SW_CNT + FF_CNT)
1302b3f6d66SOleksandr Tymoshenko 		return (EINVAL);
1312b3f6d66SOleksandr Tymoshenko 
1322b3f6d66SOleksandr Tymoshenko 	evdev->ev_report_size = report_size;
1332b3f6d66SOleksandr Tymoshenko 	return (0);
1342b3f6d66SOleksandr Tymoshenko }
1352b3f6d66SOleksandr Tymoshenko 
1362b3f6d66SOleksandr Tymoshenko static size_t
1372b3f6d66SOleksandr Tymoshenko evdev_estimate_report_size(struct evdev_dev *evdev)
1382b3f6d66SOleksandr Tymoshenko {
1392b3f6d66SOleksandr Tymoshenko 	size_t size = 0;
1402b3f6d66SOleksandr Tymoshenko 	int res;
1412b3f6d66SOleksandr Tymoshenko 
1422b3f6d66SOleksandr Tymoshenko 	/*
1432b3f6d66SOleksandr Tymoshenko 	 * Keyboards generate one event per report but other devices with
1442b3f6d66SOleksandr Tymoshenko 	 * buttons like mouses can report events simultaneously
1452b3f6d66SOleksandr Tymoshenko 	 */
1462b3f6d66SOleksandr Tymoshenko 	bit_ffs_at(evdev->ev_key_flags, KEY_OK, KEY_CNT - KEY_OK, &res);
1472b3f6d66SOleksandr Tymoshenko 	if (res == -1)
1482b3f6d66SOleksandr Tymoshenko 		bit_ffs(evdev->ev_key_flags, BTN_MISC, &res);
1492b3f6d66SOleksandr Tymoshenko 	size += (res != -1);
1502b3f6d66SOleksandr Tymoshenko 	bit_count(evdev->ev_key_flags, BTN_MISC, KEY_OK - BTN_MISC, &res);
1512b3f6d66SOleksandr Tymoshenko 	size += res;
1522b3f6d66SOleksandr Tymoshenko 
1532b3f6d66SOleksandr Tymoshenko 	/* All relative axes can be reported simultaneously */
1542b3f6d66SOleksandr Tymoshenko 	bit_count(evdev->ev_rel_flags, 0, REL_CNT, &res);
1552b3f6d66SOleksandr Tymoshenko 	size += res;
1562b3f6d66SOleksandr Tymoshenko 
1572b3f6d66SOleksandr Tymoshenko 	/*
1582b3f6d66SOleksandr Tymoshenko 	 * All absolute axes can be reported simultaneously.
1592b3f6d66SOleksandr Tymoshenko 	 * Multitouch axes can be reported ABS_MT_SLOT times
1602b3f6d66SOleksandr Tymoshenko 	 */
1612b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_absinfo != NULL) {
1622b3f6d66SOleksandr Tymoshenko 		bit_count(evdev->ev_abs_flags, 0, ABS_CNT, &res);
1632b3f6d66SOleksandr Tymoshenko 		size += res;
1642b3f6d66SOleksandr Tymoshenko 		bit_count(evdev->ev_abs_flags, ABS_MT_FIRST, MT_CNT, &res);
1652b3f6d66SOleksandr Tymoshenko 		if (res > 0) {
1662b3f6d66SOleksandr Tymoshenko 			res++;	/* ABS_MT_SLOT or SYN_MT_REPORT */
1672b3f6d66SOleksandr Tymoshenko 			if (bit_test(evdev->ev_abs_flags, ABS_MT_SLOT))
1682b3f6d66SOleksandr Tymoshenko 				/* MT type B */
1692b3f6d66SOleksandr Tymoshenko 				size += res * MAXIMAL_MT_SLOT(evdev);
1702b3f6d66SOleksandr Tymoshenko 			else
1712b3f6d66SOleksandr Tymoshenko 				/* MT type A */
1722b3f6d66SOleksandr Tymoshenko 				size += res * (MAX_MT_REPORTS - 1);
1732b3f6d66SOleksandr Tymoshenko 		}
1742b3f6d66SOleksandr Tymoshenko 	}
1752b3f6d66SOleksandr Tymoshenko 
1762b3f6d66SOleksandr Tymoshenko 	/* All misc events can be reported simultaneously */
1772b3f6d66SOleksandr Tymoshenko 	bit_count(evdev->ev_msc_flags, 0, MSC_CNT, &res);
1782b3f6d66SOleksandr Tymoshenko 	size += res;
1792b3f6d66SOleksandr Tymoshenko 
1802b3f6d66SOleksandr Tymoshenko 	/* All leds can be reported simultaneously */
1812b3f6d66SOleksandr Tymoshenko 	bit_count(evdev->ev_led_flags, 0, LED_CNT, &res);
1822b3f6d66SOleksandr Tymoshenko 	size += res;
1832b3f6d66SOleksandr Tymoshenko 
1842b3f6d66SOleksandr Tymoshenko 	/* Assume other events are generated once per report */
1852b3f6d66SOleksandr Tymoshenko 	bit_ffs(evdev->ev_snd_flags, SND_CNT, &res);
1862b3f6d66SOleksandr Tymoshenko 	size += (res != -1);
1872b3f6d66SOleksandr Tymoshenko 
1882b3f6d66SOleksandr Tymoshenko 	bit_ffs(evdev->ev_sw_flags, SW_CNT, &res);
1892b3f6d66SOleksandr Tymoshenko 	size += (res != -1);
1902b3f6d66SOleksandr Tymoshenko 
1912b3f6d66SOleksandr Tymoshenko 	/* XXX: FF part is not implemented yet */
1922b3f6d66SOleksandr Tymoshenko 
1932b3f6d66SOleksandr Tymoshenko 	size++;		/* SYN_REPORT */
1942b3f6d66SOleksandr Tymoshenko 	return (size);
1952b3f6d66SOleksandr Tymoshenko }
1962b3f6d66SOleksandr Tymoshenko 
197bfbd1bb7SOleksandr Tymoshenko static int
198bfbd1bb7SOleksandr Tymoshenko evdev_register_common(struct evdev_dev *evdev)
1992b3f6d66SOleksandr Tymoshenko {
2002b3f6d66SOleksandr Tymoshenko 	int ret;
2012b3f6d66SOleksandr Tymoshenko 
2022b3f6d66SOleksandr Tymoshenko 	debugf(evdev, "%s: registered evdev provider: %s <%s>\n",
2032b3f6d66SOleksandr Tymoshenko 	    evdev->ev_shortname, evdev->ev_name, evdev->ev_serial);
2042b3f6d66SOleksandr Tymoshenko 
2052b3f6d66SOleksandr Tymoshenko 	/* Initialize internal structures */
2062b3f6d66SOleksandr Tymoshenko 	LIST_INIT(&evdev->ev_clients);
2072b3f6d66SOleksandr Tymoshenko 
2082b3f6d66SOleksandr Tymoshenko 	if (evdev_event_supported(evdev, EV_REP) &&
2092b3f6d66SOleksandr Tymoshenko 	    bit_test(evdev->ev_flags, EVDEV_FLAG_SOFTREPEAT)) {
2102b3f6d66SOleksandr Tymoshenko 		/* Initialize callout */
2112b3f6d66SOleksandr Tymoshenko 		callout_init_mtx(&evdev->ev_rep_callout, &evdev->ev_mtx, 0);
2122b3f6d66SOleksandr Tymoshenko 
2132b3f6d66SOleksandr Tymoshenko 		if (evdev->ev_rep[REP_DELAY] == 0 &&
2142b3f6d66SOleksandr Tymoshenko 		    evdev->ev_rep[REP_PERIOD] == 0) {
2152b3f6d66SOleksandr Tymoshenko 			/* Supply default values */
2162b3f6d66SOleksandr Tymoshenko 			evdev->ev_rep[REP_DELAY] = 250;
2172b3f6d66SOleksandr Tymoshenko 			evdev->ev_rep[REP_PERIOD] = 33;
2182b3f6d66SOleksandr Tymoshenko 		}
2192b3f6d66SOleksandr Tymoshenko 	}
2202b3f6d66SOleksandr Tymoshenko 
2212b3f6d66SOleksandr Tymoshenko 	/* Initialize multitouch protocol type B states */
2222b3f6d66SOleksandr Tymoshenko 	if (bit_test(evdev->ev_abs_flags, ABS_MT_SLOT) &&
2232b3f6d66SOleksandr Tymoshenko 	    evdev->ev_absinfo != NULL && MAXIMAL_MT_SLOT(evdev) > 0)
2242b3f6d66SOleksandr Tymoshenko 		evdev_mt_init(evdev);
2252b3f6d66SOleksandr Tymoshenko 
2262b3f6d66SOleksandr Tymoshenko 	/* Estimate maximum report size */
2272b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_report_size == 0) {
2282b3f6d66SOleksandr Tymoshenko 		ret = evdev_set_report_size(evdev,
2292b3f6d66SOleksandr Tymoshenko 		    evdev_estimate_report_size(evdev));
2302b3f6d66SOleksandr Tymoshenko 		if (ret != 0)
2312b3f6d66SOleksandr Tymoshenko 			goto bail_out;
2322b3f6d66SOleksandr Tymoshenko 	}
2332b3f6d66SOleksandr Tymoshenko 
2342b3f6d66SOleksandr Tymoshenko 	/* Create char device node */
2352b3f6d66SOleksandr Tymoshenko 	ret = evdev_cdev_create(evdev);
2362b3f6d66SOleksandr Tymoshenko bail_out:
237bfbd1bb7SOleksandr Tymoshenko 	return (ret);
238bfbd1bb7SOleksandr Tymoshenko }
239bfbd1bb7SOleksandr Tymoshenko 
240bfbd1bb7SOleksandr Tymoshenko int
241bfbd1bb7SOleksandr Tymoshenko evdev_register(struct evdev_dev *evdev)
242bfbd1bb7SOleksandr Tymoshenko {
243bfbd1bb7SOleksandr Tymoshenko 	int ret;
244bfbd1bb7SOleksandr Tymoshenko 
245bfbd1bb7SOleksandr Tymoshenko 	evdev->ev_lock_type = EV_LOCK_INTERNAL;
246bfbd1bb7SOleksandr Tymoshenko 	evdev->ev_lock = &evdev->ev_mtx;
247bfbd1bb7SOleksandr Tymoshenko 	mtx_init(&evdev->ev_mtx, "evmtx", NULL, MTX_DEF);
248bfbd1bb7SOleksandr Tymoshenko 
249bfbd1bb7SOleksandr Tymoshenko 	ret = evdev_register_common(evdev);
2502b3f6d66SOleksandr Tymoshenko 	if (ret != 0)
2512b3f6d66SOleksandr Tymoshenko 		mtx_destroy(&evdev->ev_mtx);
2522b3f6d66SOleksandr Tymoshenko 
2532b3f6d66SOleksandr Tymoshenko 	return (ret);
2542b3f6d66SOleksandr Tymoshenko }
2552b3f6d66SOleksandr Tymoshenko 
2562b3f6d66SOleksandr Tymoshenko int
257bfbd1bb7SOleksandr Tymoshenko evdev_register_mtx(struct evdev_dev *evdev, struct mtx *mtx)
258bfbd1bb7SOleksandr Tymoshenko {
259bfbd1bb7SOleksandr Tymoshenko 
260bfbd1bb7SOleksandr Tymoshenko 	evdev->ev_lock_type = EV_LOCK_MTX;
261bfbd1bb7SOleksandr Tymoshenko 	evdev->ev_lock = mtx;
262bfbd1bb7SOleksandr Tymoshenko 	return (evdev_register_common(evdev));
263bfbd1bb7SOleksandr Tymoshenko }
264bfbd1bb7SOleksandr Tymoshenko 
265bfbd1bb7SOleksandr Tymoshenko int
2662b3f6d66SOleksandr Tymoshenko evdev_unregister(struct evdev_dev *evdev)
2672b3f6d66SOleksandr Tymoshenko {
2682b3f6d66SOleksandr Tymoshenko 	struct evdev_client *client;
2692b3f6d66SOleksandr Tymoshenko 	int ret;
2702b3f6d66SOleksandr Tymoshenko 	debugf(evdev, "%s: unregistered evdev provider: %s\n",
2712b3f6d66SOleksandr Tymoshenko 	    evdev->ev_shortname, evdev->ev_name);
2722b3f6d66SOleksandr Tymoshenko 
2732b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK(evdev);
2742b3f6d66SOleksandr Tymoshenko 	evdev->ev_cdev->si_drv1 = NULL;
2752b3f6d66SOleksandr Tymoshenko 	/* Wake up sleepers */
2762b3f6d66SOleksandr Tymoshenko 	LIST_FOREACH(client, &evdev->ev_clients, ec_link) {
2772b3f6d66SOleksandr Tymoshenko 		evdev_revoke_client(client);
2782b3f6d66SOleksandr Tymoshenko 		evdev_dispose_client(evdev, client);
2792b3f6d66SOleksandr Tymoshenko 		EVDEV_CLIENT_LOCKQ(client);
2802b3f6d66SOleksandr Tymoshenko 		evdev_notify_event(client);
2812b3f6d66SOleksandr Tymoshenko 		EVDEV_CLIENT_UNLOCKQ(client);
2822b3f6d66SOleksandr Tymoshenko 	}
2832b3f6d66SOleksandr Tymoshenko 	EVDEV_UNLOCK(evdev);
2842b3f6d66SOleksandr Tymoshenko 
2852b3f6d66SOleksandr Tymoshenko 	/* destroy_dev can sleep so release lock */
2862b3f6d66SOleksandr Tymoshenko 	ret = evdev_cdev_destroy(evdev);
2872b3f6d66SOleksandr Tymoshenko 	evdev->ev_cdev = NULL;
288bfbd1bb7SOleksandr Tymoshenko 	if (ret == 0 && evdev->ev_lock_type == EV_LOCK_INTERNAL)
2892b3f6d66SOleksandr Tymoshenko 		mtx_destroy(&evdev->ev_mtx);
2902b3f6d66SOleksandr Tymoshenko 
2912b3f6d66SOleksandr Tymoshenko 	evdev_free_absinfo(evdev->ev_absinfo);
2922b3f6d66SOleksandr Tymoshenko 	evdev_mt_free(evdev);
2932b3f6d66SOleksandr Tymoshenko 
2942b3f6d66SOleksandr Tymoshenko 	return (ret);
2952b3f6d66SOleksandr Tymoshenko }
2962b3f6d66SOleksandr Tymoshenko 
2972b3f6d66SOleksandr Tymoshenko inline void
2982b3f6d66SOleksandr Tymoshenko evdev_set_name(struct evdev_dev *evdev, const char *name)
2992b3f6d66SOleksandr Tymoshenko {
3002b3f6d66SOleksandr Tymoshenko 
3012b3f6d66SOleksandr Tymoshenko 	snprintf(evdev->ev_name, NAMELEN, "%s", name);
3022b3f6d66SOleksandr Tymoshenko }
3032b3f6d66SOleksandr Tymoshenko 
3042b3f6d66SOleksandr Tymoshenko inline void
3052b3f6d66SOleksandr Tymoshenko evdev_set_id(struct evdev_dev *evdev, uint16_t bustype, uint16_t vendor,
3062b3f6d66SOleksandr Tymoshenko     uint16_t product, uint16_t version)
3072b3f6d66SOleksandr Tymoshenko {
3082b3f6d66SOleksandr Tymoshenko 
3092b3f6d66SOleksandr Tymoshenko 	evdev->ev_id = (struct input_id) {
3102b3f6d66SOleksandr Tymoshenko 		.bustype = bustype,
3112b3f6d66SOleksandr Tymoshenko 		.vendor = vendor,
3122b3f6d66SOleksandr Tymoshenko 		.product = product,
3132b3f6d66SOleksandr Tymoshenko 		.version = version
3142b3f6d66SOleksandr Tymoshenko 	};
3152b3f6d66SOleksandr Tymoshenko }
3162b3f6d66SOleksandr Tymoshenko 
3172b3f6d66SOleksandr Tymoshenko inline void
3182b3f6d66SOleksandr Tymoshenko evdev_set_phys(struct evdev_dev *evdev, const char *name)
3192b3f6d66SOleksandr Tymoshenko {
3202b3f6d66SOleksandr Tymoshenko 
3212b3f6d66SOleksandr Tymoshenko 	snprintf(evdev->ev_shortname, NAMELEN, "%s", name);
3222b3f6d66SOleksandr Tymoshenko }
3232b3f6d66SOleksandr Tymoshenko 
3242b3f6d66SOleksandr Tymoshenko inline void
3252b3f6d66SOleksandr Tymoshenko evdev_set_serial(struct evdev_dev *evdev, const char *serial)
3262b3f6d66SOleksandr Tymoshenko {
3272b3f6d66SOleksandr Tymoshenko 
3282b3f6d66SOleksandr Tymoshenko 	snprintf(evdev->ev_serial, NAMELEN, "%s", serial);
3292b3f6d66SOleksandr Tymoshenko }
3302b3f6d66SOleksandr Tymoshenko 
3312b3f6d66SOleksandr Tymoshenko inline void
3322b3f6d66SOleksandr Tymoshenko evdev_set_methods(struct evdev_dev *evdev, void *softc,
3335163e77fSOleksandr Tymoshenko     const struct evdev_methods *methods)
3342b3f6d66SOleksandr Tymoshenko {
3352b3f6d66SOleksandr Tymoshenko 
3362b3f6d66SOleksandr Tymoshenko 	evdev->ev_methods = methods;
3372b3f6d66SOleksandr Tymoshenko 	evdev->ev_softc = softc;
3382b3f6d66SOleksandr Tymoshenko }
3392b3f6d66SOleksandr Tymoshenko 
340*911aed94SVladimir Kondratyev inline void *
341*911aed94SVladimir Kondratyev evdev_get_softc(struct evdev_dev *evdev)
342*911aed94SVladimir Kondratyev {
343*911aed94SVladimir Kondratyev 
344*911aed94SVladimir Kondratyev 	return (evdev->ev_softc);
345*911aed94SVladimir Kondratyev }
346*911aed94SVladimir Kondratyev 
3472b3f6d66SOleksandr Tymoshenko inline void
3482b3f6d66SOleksandr Tymoshenko evdev_support_prop(struct evdev_dev *evdev, uint16_t prop)
3492b3f6d66SOleksandr Tymoshenko {
3502b3f6d66SOleksandr Tymoshenko 
3512b3f6d66SOleksandr Tymoshenko 	KASSERT(prop < INPUT_PROP_CNT, ("invalid evdev input property"));
3522b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_prop_flags, prop);
3532b3f6d66SOleksandr Tymoshenko }
3542b3f6d66SOleksandr Tymoshenko 
3552b3f6d66SOleksandr Tymoshenko inline void
3562b3f6d66SOleksandr Tymoshenko evdev_support_event(struct evdev_dev *evdev, uint16_t type)
3572b3f6d66SOleksandr Tymoshenko {
3582b3f6d66SOleksandr Tymoshenko 
3592b3f6d66SOleksandr Tymoshenko 	KASSERT(type < EV_CNT, ("invalid evdev event property"));
3602b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_type_flags, type);
3612b3f6d66SOleksandr Tymoshenko }
3622b3f6d66SOleksandr Tymoshenko 
3632b3f6d66SOleksandr Tymoshenko inline void
3642b3f6d66SOleksandr Tymoshenko evdev_support_key(struct evdev_dev *evdev, uint16_t code)
3652b3f6d66SOleksandr Tymoshenko {
3662b3f6d66SOleksandr Tymoshenko 
3672b3f6d66SOleksandr Tymoshenko 	KASSERT(code < KEY_CNT, ("invalid evdev key property"));
3682b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_key_flags, code);
3692b3f6d66SOleksandr Tymoshenko }
3702b3f6d66SOleksandr Tymoshenko 
3712b3f6d66SOleksandr Tymoshenko inline void
3722b3f6d66SOleksandr Tymoshenko evdev_support_rel(struct evdev_dev *evdev, uint16_t code)
3732b3f6d66SOleksandr Tymoshenko {
3742b3f6d66SOleksandr Tymoshenko 
3752b3f6d66SOleksandr Tymoshenko 	KASSERT(code < REL_CNT, ("invalid evdev rel property"));
3762b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_rel_flags, code);
3772b3f6d66SOleksandr Tymoshenko }
3782b3f6d66SOleksandr Tymoshenko 
3792b3f6d66SOleksandr Tymoshenko inline void
3802b3f6d66SOleksandr Tymoshenko evdev_support_abs(struct evdev_dev *evdev, uint16_t code, int32_t value,
3812b3f6d66SOleksandr Tymoshenko     int32_t minimum, int32_t maximum, int32_t fuzz, int32_t flat,
3822b3f6d66SOleksandr Tymoshenko     int32_t resolution)
3832b3f6d66SOleksandr Tymoshenko {
3842b3f6d66SOleksandr Tymoshenko 	struct input_absinfo absinfo;
3852b3f6d66SOleksandr Tymoshenko 
3862b3f6d66SOleksandr Tymoshenko 	KASSERT(code < ABS_CNT, ("invalid evdev abs property"));
3872b3f6d66SOleksandr Tymoshenko 
3882b3f6d66SOleksandr Tymoshenko 	absinfo = (struct input_absinfo) {
3892b3f6d66SOleksandr Tymoshenko 		.value = value,
3902b3f6d66SOleksandr Tymoshenko 		.minimum = minimum,
3912b3f6d66SOleksandr Tymoshenko 		.maximum = maximum,
3922b3f6d66SOleksandr Tymoshenko 		.fuzz = fuzz,
3932b3f6d66SOleksandr Tymoshenko 		.flat = flat,
3942b3f6d66SOleksandr Tymoshenko 		.resolution = resolution,
3952b3f6d66SOleksandr Tymoshenko 	};
3962b3f6d66SOleksandr Tymoshenko 	evdev_set_abs_bit(evdev, code);
3972b3f6d66SOleksandr Tymoshenko 	evdev_set_absinfo(evdev, code, &absinfo);
3982b3f6d66SOleksandr Tymoshenko }
3992b3f6d66SOleksandr Tymoshenko 
4002b3f6d66SOleksandr Tymoshenko inline void
4012b3f6d66SOleksandr Tymoshenko evdev_set_abs_bit(struct evdev_dev *evdev, uint16_t code)
4022b3f6d66SOleksandr Tymoshenko {
4032b3f6d66SOleksandr Tymoshenko 
4042b3f6d66SOleksandr Tymoshenko 	KASSERT(code < ABS_CNT, ("invalid evdev abs property"));
4052b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_absinfo == NULL)
4062b3f6d66SOleksandr Tymoshenko 		evdev->ev_absinfo = evdev_alloc_absinfo();
4072b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_abs_flags, code);
4082b3f6d66SOleksandr Tymoshenko }
4092b3f6d66SOleksandr Tymoshenko 
4102b3f6d66SOleksandr Tymoshenko inline void
4112b3f6d66SOleksandr Tymoshenko evdev_support_msc(struct evdev_dev *evdev, uint16_t code)
4122b3f6d66SOleksandr Tymoshenko {
4132b3f6d66SOleksandr Tymoshenko 
4142b3f6d66SOleksandr Tymoshenko 	KASSERT(code < MSC_CNT, ("invalid evdev msc property"));
4152b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_msc_flags, code);
4162b3f6d66SOleksandr Tymoshenko }
4172b3f6d66SOleksandr Tymoshenko 
4182b3f6d66SOleksandr Tymoshenko 
4192b3f6d66SOleksandr Tymoshenko inline void
4202b3f6d66SOleksandr Tymoshenko evdev_support_led(struct evdev_dev *evdev, uint16_t code)
4212b3f6d66SOleksandr Tymoshenko {
4222b3f6d66SOleksandr Tymoshenko 
4232b3f6d66SOleksandr Tymoshenko 	KASSERT(code < LED_CNT, ("invalid evdev led property"));
4242b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_led_flags, code);
4252b3f6d66SOleksandr Tymoshenko }
4262b3f6d66SOleksandr Tymoshenko 
4272b3f6d66SOleksandr Tymoshenko inline void
4282b3f6d66SOleksandr Tymoshenko evdev_support_snd(struct evdev_dev *evdev, uint16_t code)
4292b3f6d66SOleksandr Tymoshenko {
4302b3f6d66SOleksandr Tymoshenko 
4312b3f6d66SOleksandr Tymoshenko 	KASSERT(code < SND_CNT, ("invalid evdev snd property"));
4322b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_snd_flags, code);
4332b3f6d66SOleksandr Tymoshenko }
4342b3f6d66SOleksandr Tymoshenko 
4352b3f6d66SOleksandr Tymoshenko inline void
4362b3f6d66SOleksandr Tymoshenko evdev_support_sw(struct evdev_dev *evdev, uint16_t code)
4372b3f6d66SOleksandr Tymoshenko {
4382b3f6d66SOleksandr Tymoshenko 
4392b3f6d66SOleksandr Tymoshenko 	KASSERT(code < SW_CNT, ("invalid evdev sw property"));
4402b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_sw_flags, code);
4412b3f6d66SOleksandr Tymoshenko }
4422b3f6d66SOleksandr Tymoshenko 
4432b3f6d66SOleksandr Tymoshenko bool
4442b3f6d66SOleksandr Tymoshenko evdev_event_supported(struct evdev_dev *evdev, uint16_t type)
4452b3f6d66SOleksandr Tymoshenko {
4462b3f6d66SOleksandr Tymoshenko 
4472b3f6d66SOleksandr Tymoshenko 	KASSERT(type < EV_CNT, ("invalid evdev event property"));
4482b3f6d66SOleksandr Tymoshenko 	return (bit_test(evdev->ev_type_flags, type));
4492b3f6d66SOleksandr Tymoshenko }
4502b3f6d66SOleksandr Tymoshenko 
4512b3f6d66SOleksandr Tymoshenko inline void
4522b3f6d66SOleksandr Tymoshenko evdev_set_absinfo(struct evdev_dev *evdev, uint16_t axis,
4532b3f6d66SOleksandr Tymoshenko     struct input_absinfo *absinfo)
4542b3f6d66SOleksandr Tymoshenko {
4552b3f6d66SOleksandr Tymoshenko 
4562b3f6d66SOleksandr Tymoshenko 	KASSERT(axis < ABS_CNT, ("invalid evdev abs property"));
4572b3f6d66SOleksandr Tymoshenko 
4582b3f6d66SOleksandr Tymoshenko 	if (axis == ABS_MT_SLOT &&
4592b3f6d66SOleksandr Tymoshenko 	    (absinfo->maximum < 1 || absinfo->maximum >= MAX_MT_SLOTS))
4602b3f6d66SOleksandr Tymoshenko 		return;
4612b3f6d66SOleksandr Tymoshenko 
4622b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_absinfo == NULL)
4632b3f6d66SOleksandr Tymoshenko 		evdev->ev_absinfo = evdev_alloc_absinfo();
4642b3f6d66SOleksandr Tymoshenko 
4652b3f6d66SOleksandr Tymoshenko 	if (axis == ABS_MT_SLOT)
4662b3f6d66SOleksandr Tymoshenko 		evdev->ev_absinfo[ABS_MT_SLOT].maximum = absinfo->maximum;
4672b3f6d66SOleksandr Tymoshenko 	else
4682b3f6d66SOleksandr Tymoshenko 		memcpy(&evdev->ev_absinfo[axis], absinfo,
4692b3f6d66SOleksandr Tymoshenko 		    sizeof(struct input_absinfo));
4702b3f6d66SOleksandr Tymoshenko }
4712b3f6d66SOleksandr Tymoshenko 
4722b3f6d66SOleksandr Tymoshenko inline void
4732b3f6d66SOleksandr Tymoshenko evdev_set_repeat_params(struct evdev_dev *evdev, uint16_t property, int value)
4742b3f6d66SOleksandr Tymoshenko {
4752b3f6d66SOleksandr Tymoshenko 
4762b3f6d66SOleksandr Tymoshenko 	KASSERT(property < REP_CNT, ("invalid evdev repeat property"));
4772b3f6d66SOleksandr Tymoshenko 	evdev->ev_rep[property] = value;
4782b3f6d66SOleksandr Tymoshenko }
4792b3f6d66SOleksandr Tymoshenko 
4802b3f6d66SOleksandr Tymoshenko inline void
4812b3f6d66SOleksandr Tymoshenko evdev_set_flag(struct evdev_dev *evdev, uint16_t flag)
4822b3f6d66SOleksandr Tymoshenko {
4832b3f6d66SOleksandr Tymoshenko 
4842b3f6d66SOleksandr Tymoshenko 	KASSERT(flag < EVDEV_FLAG_CNT, ("invalid evdev flag property"));
4852b3f6d66SOleksandr Tymoshenko 	bit_set(evdev->ev_flags, flag);
4862b3f6d66SOleksandr Tymoshenko }
4872b3f6d66SOleksandr Tymoshenko 
4882b3f6d66SOleksandr Tymoshenko static int
4892b3f6d66SOleksandr Tymoshenko evdev_check_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
4902b3f6d66SOleksandr Tymoshenko     int32_t value)
4912b3f6d66SOleksandr Tymoshenko {
4922b3f6d66SOleksandr Tymoshenko 
4932b3f6d66SOleksandr Tymoshenko 	if (type >= EV_CNT)
4942b3f6d66SOleksandr Tymoshenko 		return (EINVAL);
4952b3f6d66SOleksandr Tymoshenko 
4962b3f6d66SOleksandr Tymoshenko 	/* Allow SYN events implicitly */
4972b3f6d66SOleksandr Tymoshenko 	if (type != EV_SYN && !evdev_event_supported(evdev, type))
4982b3f6d66SOleksandr Tymoshenko 		return (EINVAL);
4992b3f6d66SOleksandr Tymoshenko 
5002b3f6d66SOleksandr Tymoshenko 	switch (type) {
5012b3f6d66SOleksandr Tymoshenko 	case EV_SYN:
5022b3f6d66SOleksandr Tymoshenko 		if (code >= SYN_CNT)
5032b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5042b3f6d66SOleksandr Tymoshenko 		break;
5052b3f6d66SOleksandr Tymoshenko 
5062b3f6d66SOleksandr Tymoshenko 	case EV_KEY:
5072b3f6d66SOleksandr Tymoshenko 		if (code >= KEY_CNT)
5082b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5092b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_key_flags, code))
5102b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5112b3f6d66SOleksandr Tymoshenko 		break;
5122b3f6d66SOleksandr Tymoshenko 
5132b3f6d66SOleksandr Tymoshenko 	case EV_REL:
5142b3f6d66SOleksandr Tymoshenko 		if (code >= REL_CNT)
5152b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5162b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_rel_flags, code))
5172b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5182b3f6d66SOleksandr Tymoshenko 		break;
5192b3f6d66SOleksandr Tymoshenko 
5202b3f6d66SOleksandr Tymoshenko 	case EV_ABS:
5212b3f6d66SOleksandr Tymoshenko 		if (code >= ABS_CNT)
5222b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5232b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_abs_flags, code))
5242b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5252b3f6d66SOleksandr Tymoshenko 		if (code == ABS_MT_SLOT &&
5262b3f6d66SOleksandr Tymoshenko 		    (value < 0 || value > MAXIMAL_MT_SLOT(evdev)))
5272b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5282b3f6d66SOleksandr Tymoshenko 		if (ABS_IS_MT(code) && evdev->ev_mt == NULL &&
5292b3f6d66SOleksandr Tymoshenko 		    bit_test(evdev->ev_abs_flags, ABS_MT_SLOT))
5302b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5312b3f6d66SOleksandr Tymoshenko 		break;
5322b3f6d66SOleksandr Tymoshenko 
5332b3f6d66SOleksandr Tymoshenko 	case EV_MSC:
5342b3f6d66SOleksandr Tymoshenko 		if (code >= MSC_CNT)
5352b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5362b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_msc_flags, code))
5372b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5382b3f6d66SOleksandr Tymoshenko 		break;
5392b3f6d66SOleksandr Tymoshenko 
5402b3f6d66SOleksandr Tymoshenko 	case EV_LED:
5412b3f6d66SOleksandr Tymoshenko 		if (code >= LED_CNT)
5422b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5432b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_led_flags, code))
5442b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5452b3f6d66SOleksandr Tymoshenko 		break;
5462b3f6d66SOleksandr Tymoshenko 
5472b3f6d66SOleksandr Tymoshenko 	case EV_SND:
5482b3f6d66SOleksandr Tymoshenko 		if (code >= SND_CNT)
5492b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5502b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_snd_flags, code))
5512b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5522b3f6d66SOleksandr Tymoshenko 		break;
5532b3f6d66SOleksandr Tymoshenko 
5542b3f6d66SOleksandr Tymoshenko 	case EV_SW:
5552b3f6d66SOleksandr Tymoshenko 		if (code >= SW_CNT)
5562b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5572b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_sw_flags, code))
5582b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5592b3f6d66SOleksandr Tymoshenko 		break;
5602b3f6d66SOleksandr Tymoshenko 
5612b3f6d66SOleksandr Tymoshenko 	case EV_REP:
5622b3f6d66SOleksandr Tymoshenko 		if (code >= REP_CNT)
5632b3f6d66SOleksandr Tymoshenko 			return (EINVAL);
5642b3f6d66SOleksandr Tymoshenko 		break;
5652b3f6d66SOleksandr Tymoshenko 
5662b3f6d66SOleksandr Tymoshenko 	default:
5672b3f6d66SOleksandr Tymoshenko 		return (EINVAL);
5682b3f6d66SOleksandr Tymoshenko 	}
5692b3f6d66SOleksandr Tymoshenko 
5702b3f6d66SOleksandr Tymoshenko 	return (0);
5712b3f6d66SOleksandr Tymoshenko }
5722b3f6d66SOleksandr Tymoshenko 
5732b3f6d66SOleksandr Tymoshenko static void
5742b3f6d66SOleksandr Tymoshenko evdev_modify_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
5752b3f6d66SOleksandr Tymoshenko     int32_t *value)
5762b3f6d66SOleksandr Tymoshenko {
5772b3f6d66SOleksandr Tymoshenko 
5782b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
5792b3f6d66SOleksandr Tymoshenko 
5802b3f6d66SOleksandr Tymoshenko 	switch (type) {
5812b3f6d66SOleksandr Tymoshenko 	case EV_KEY:
5822b3f6d66SOleksandr Tymoshenko 		if (!evdev_event_supported(evdev, EV_REP))
5832b3f6d66SOleksandr Tymoshenko 			break;
5842b3f6d66SOleksandr Tymoshenko 
5852b3f6d66SOleksandr Tymoshenko 		if (!bit_test(evdev->ev_flags, EVDEV_FLAG_SOFTREPEAT)) {
5862b3f6d66SOleksandr Tymoshenko 			/* Detect driver key repeats. */
5872b3f6d66SOleksandr Tymoshenko 			if (bit_test(evdev->ev_key_states, code) &&
5882b3f6d66SOleksandr Tymoshenko 			    *value == KEY_EVENT_DOWN)
5892b3f6d66SOleksandr Tymoshenko 				*value = KEY_EVENT_REPEAT;
5902b3f6d66SOleksandr Tymoshenko 		} else {
5912b3f6d66SOleksandr Tymoshenko 			/* Start/stop callout for evdev repeats */
59237ff3345SVladimir Kondratyev 			if (bit_test(evdev->ev_key_states, code) == !*value &&
59337ff3345SVladimir Kondratyev 			    !LIST_EMPTY(&evdev->ev_clients)) {
5942b3f6d66SOleksandr Tymoshenko 				if (*value == KEY_EVENT_DOWN)
5952b3f6d66SOleksandr Tymoshenko 					evdev_start_repeat(evdev, code);
5962b3f6d66SOleksandr Tymoshenko 				else
5972b3f6d66SOleksandr Tymoshenko 					evdev_stop_repeat(evdev);
5982b3f6d66SOleksandr Tymoshenko 			}
5992b3f6d66SOleksandr Tymoshenko 		}
6002b3f6d66SOleksandr Tymoshenko 		break;
6012b3f6d66SOleksandr Tymoshenko 
6022b3f6d66SOleksandr Tymoshenko 	case EV_ABS:
6032b3f6d66SOleksandr Tymoshenko 		/* TBD: implement fuzz */
6042b3f6d66SOleksandr Tymoshenko 		break;
6052b3f6d66SOleksandr Tymoshenko 	}
6062b3f6d66SOleksandr Tymoshenko }
6072b3f6d66SOleksandr Tymoshenko 
6082b3f6d66SOleksandr Tymoshenko static enum evdev_sparse_result
6092b3f6d66SOleksandr Tymoshenko evdev_sparse_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
6102b3f6d66SOleksandr Tymoshenko     int32_t value)
6112b3f6d66SOleksandr Tymoshenko {
6122b3f6d66SOleksandr Tymoshenko 	int32_t last_mt_slot;
6132b3f6d66SOleksandr Tymoshenko 
6142b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
6152b3f6d66SOleksandr Tymoshenko 
6162b3f6d66SOleksandr Tymoshenko 	/*
6172b3f6d66SOleksandr Tymoshenko 	 * For certain event types, update device state bits
6182b3f6d66SOleksandr Tymoshenko 	 * and convert level reporting to edge reporting
6192b3f6d66SOleksandr Tymoshenko 	 */
6202b3f6d66SOleksandr Tymoshenko 	switch (type) {
6212b3f6d66SOleksandr Tymoshenko 	case EV_KEY:
6222b3f6d66SOleksandr Tymoshenko 		switch (value) {
6232b3f6d66SOleksandr Tymoshenko 		case KEY_EVENT_UP:
6242b3f6d66SOleksandr Tymoshenko 		case KEY_EVENT_DOWN:
6252b3f6d66SOleksandr Tymoshenko 			if (bit_test(evdev->ev_key_states, code) == value)
6262b3f6d66SOleksandr Tymoshenko 				return (EV_SKIP_EVENT);
6272b3f6d66SOleksandr Tymoshenko 			bit_change(evdev->ev_key_states, code, value);
6282b3f6d66SOleksandr Tymoshenko 			break;
6292b3f6d66SOleksandr Tymoshenko 
6302b3f6d66SOleksandr Tymoshenko 		case KEY_EVENT_REPEAT:
6312b3f6d66SOleksandr Tymoshenko 			if (bit_test(evdev->ev_key_states, code) == 0 ||
6322b3f6d66SOleksandr Tymoshenko 			    !evdev_event_supported(evdev, EV_REP))
6332b3f6d66SOleksandr Tymoshenko 				return (EV_SKIP_EVENT);
6342b3f6d66SOleksandr Tymoshenko 			break;
6352b3f6d66SOleksandr Tymoshenko 
6362b3f6d66SOleksandr Tymoshenko 		default:
6372b3f6d66SOleksandr Tymoshenko 			 return (EV_SKIP_EVENT);
6382b3f6d66SOleksandr Tymoshenko 		}
6392b3f6d66SOleksandr Tymoshenko 		break;
6402b3f6d66SOleksandr Tymoshenko 
6412b3f6d66SOleksandr Tymoshenko 	case EV_LED:
6422b3f6d66SOleksandr Tymoshenko 		if (bit_test(evdev->ev_led_states, code) == value)
6432b3f6d66SOleksandr Tymoshenko 			return (EV_SKIP_EVENT);
6442b3f6d66SOleksandr Tymoshenko 		bit_change(evdev->ev_led_states, code, value);
6452b3f6d66SOleksandr Tymoshenko 		break;
6462b3f6d66SOleksandr Tymoshenko 
6472b3f6d66SOleksandr Tymoshenko 	case EV_SND:
6482b3f6d66SOleksandr Tymoshenko 		bit_change(evdev->ev_snd_states, code, value);
6492b3f6d66SOleksandr Tymoshenko 		break;
6502b3f6d66SOleksandr Tymoshenko 
6512b3f6d66SOleksandr Tymoshenko 	case EV_SW:
6522b3f6d66SOleksandr Tymoshenko 		if (bit_test(evdev->ev_sw_states, code) == value)
6532b3f6d66SOleksandr Tymoshenko 			return (EV_SKIP_EVENT);
6542b3f6d66SOleksandr Tymoshenko 		bit_change(evdev->ev_sw_states, code, value);
6552b3f6d66SOleksandr Tymoshenko 		break;
6562b3f6d66SOleksandr Tymoshenko 
6572b3f6d66SOleksandr Tymoshenko 	case EV_REP:
6582b3f6d66SOleksandr Tymoshenko 		if (evdev->ev_rep[code] == value)
6592b3f6d66SOleksandr Tymoshenko 			return (EV_SKIP_EVENT);
6602b3f6d66SOleksandr Tymoshenko 		evdev_set_repeat_params(evdev, code, value);
6612b3f6d66SOleksandr Tymoshenko 		break;
6622b3f6d66SOleksandr Tymoshenko 
6632b3f6d66SOleksandr Tymoshenko 	case EV_REL:
6642b3f6d66SOleksandr Tymoshenko 		if (value == 0)
6652b3f6d66SOleksandr Tymoshenko 			return (EV_SKIP_EVENT);
6662b3f6d66SOleksandr Tymoshenko 		break;
6672b3f6d66SOleksandr Tymoshenko 
6682b3f6d66SOleksandr Tymoshenko 	/* For EV_ABS, save last value in absinfo and ev_mt_states */
6692b3f6d66SOleksandr Tymoshenko 	case EV_ABS:
6702b3f6d66SOleksandr Tymoshenko 		switch (code) {
6712b3f6d66SOleksandr Tymoshenko 		case ABS_MT_SLOT:
6722b3f6d66SOleksandr Tymoshenko 			/* Postpone ABS_MT_SLOT till next event */
6732b3f6d66SOleksandr Tymoshenko 			evdev_set_last_mt_slot(evdev, value);
6742b3f6d66SOleksandr Tymoshenko 			return (EV_SKIP_EVENT);
6752b3f6d66SOleksandr Tymoshenko 
6762b3f6d66SOleksandr Tymoshenko 		case ABS_MT_FIRST ... ABS_MT_LAST:
6772b3f6d66SOleksandr Tymoshenko 			/* Pass MT protocol type A events as is */
6782b3f6d66SOleksandr Tymoshenko 			if (!bit_test(evdev->ev_abs_flags, ABS_MT_SLOT))
6792b3f6d66SOleksandr Tymoshenko 				break;
6802b3f6d66SOleksandr Tymoshenko 			/* Don`t repeat MT protocol type B events */
6812b3f6d66SOleksandr Tymoshenko 			last_mt_slot = evdev_get_last_mt_slot(evdev);
6822b3f6d66SOleksandr Tymoshenko 			if (evdev_get_mt_value(evdev, last_mt_slot, code)
6832b3f6d66SOleksandr Tymoshenko 			     == value)
6842b3f6d66SOleksandr Tymoshenko 				return (EV_SKIP_EVENT);
6852b3f6d66SOleksandr Tymoshenko 			evdev_set_mt_value(evdev, last_mt_slot, code, value);
6862b3f6d66SOleksandr Tymoshenko 			if (last_mt_slot != CURRENT_MT_SLOT(evdev)) {
6872b3f6d66SOleksandr Tymoshenko 				CURRENT_MT_SLOT(evdev) = last_mt_slot;
6882b3f6d66SOleksandr Tymoshenko 				evdev->ev_report_opened = true;
6892b3f6d66SOleksandr Tymoshenko 				return (EV_REPORT_MT_SLOT);
6902b3f6d66SOleksandr Tymoshenko 			}
6912b3f6d66SOleksandr Tymoshenko 			break;
6922b3f6d66SOleksandr Tymoshenko 
6932b3f6d66SOleksandr Tymoshenko 		default:
6942b3f6d66SOleksandr Tymoshenko 			if (evdev->ev_absinfo[code].value == value)
6952b3f6d66SOleksandr Tymoshenko 				return (EV_SKIP_EVENT);
6962b3f6d66SOleksandr Tymoshenko 			evdev->ev_absinfo[code].value = value;
6972b3f6d66SOleksandr Tymoshenko 		}
6982b3f6d66SOleksandr Tymoshenko 		break;
6992b3f6d66SOleksandr Tymoshenko 
7002b3f6d66SOleksandr Tymoshenko 	case EV_SYN:
7012b3f6d66SOleksandr Tymoshenko 		if (code == SYN_REPORT) {
702c736a757SOleksandr Tymoshenko 			/* Count empty reports as well as non empty */
703c736a757SOleksandr Tymoshenko 			evdev->ev_report_count++;
7042b3f6d66SOleksandr Tymoshenko 			/* Skip empty reports */
7052b3f6d66SOleksandr Tymoshenko 			if (!evdev->ev_report_opened)
7062b3f6d66SOleksandr Tymoshenko 				return (EV_SKIP_EVENT);
7072b3f6d66SOleksandr Tymoshenko 			evdev->ev_report_opened = false;
7082b3f6d66SOleksandr Tymoshenko 			return (EV_REPORT_EVENT);
7092b3f6d66SOleksandr Tymoshenko 		}
7102b3f6d66SOleksandr Tymoshenko 		break;
7112b3f6d66SOleksandr Tymoshenko 	}
7122b3f6d66SOleksandr Tymoshenko 
7132b3f6d66SOleksandr Tymoshenko 	evdev->ev_report_opened = true;
7142b3f6d66SOleksandr Tymoshenko 	return (EV_REPORT_EVENT);
7152b3f6d66SOleksandr Tymoshenko }
7162b3f6d66SOleksandr Tymoshenko 
7172b3f6d66SOleksandr Tymoshenko static void
7182b3f6d66SOleksandr Tymoshenko evdev_propagate_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
7192b3f6d66SOleksandr Tymoshenko     int32_t value)
7202b3f6d66SOleksandr Tymoshenko {
7212b3f6d66SOleksandr Tymoshenko 	struct evdev_client *client;
7222b3f6d66SOleksandr Tymoshenko 
7232b3f6d66SOleksandr Tymoshenko 	debugf(evdev, "%s pushed event %d/%d/%d",
7242b3f6d66SOleksandr Tymoshenko 	    evdev->ev_shortname, type, code, value);
7252b3f6d66SOleksandr Tymoshenko 
7262b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
7272b3f6d66SOleksandr Tymoshenko 
7282b3f6d66SOleksandr Tymoshenko 	/* Propagate event through all clients */
7292b3f6d66SOleksandr Tymoshenko 	LIST_FOREACH(client, &evdev->ev_clients, ec_link) {
7302b3f6d66SOleksandr Tymoshenko 		if (evdev->ev_grabber != NULL && evdev->ev_grabber != client)
7312b3f6d66SOleksandr Tymoshenko 			continue;
7322b3f6d66SOleksandr Tymoshenko 
7332b3f6d66SOleksandr Tymoshenko 		EVDEV_CLIENT_LOCKQ(client);
7342b3f6d66SOleksandr Tymoshenko 		evdev_client_push(client, type, code, value);
7352b3f6d66SOleksandr Tymoshenko 		if (type == EV_SYN && code == SYN_REPORT)
7362b3f6d66SOleksandr Tymoshenko 			evdev_notify_event(client);
7372b3f6d66SOleksandr Tymoshenko 		EVDEV_CLIENT_UNLOCKQ(client);
7382b3f6d66SOleksandr Tymoshenko 	}
7392b3f6d66SOleksandr Tymoshenko 
7402b3f6d66SOleksandr Tymoshenko 	evdev->ev_event_count++;
7412b3f6d66SOleksandr Tymoshenko }
7422b3f6d66SOleksandr Tymoshenko 
7432b3f6d66SOleksandr Tymoshenko void
7442b3f6d66SOleksandr Tymoshenko evdev_send_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
7452b3f6d66SOleksandr Tymoshenko     int32_t value)
7462b3f6d66SOleksandr Tymoshenko {
7472b3f6d66SOleksandr Tymoshenko 	enum evdev_sparse_result sparse;
7482b3f6d66SOleksandr Tymoshenko 
7492b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
7502b3f6d66SOleksandr Tymoshenko 
7512b3f6d66SOleksandr Tymoshenko 	sparse =  evdev_sparse_event(evdev, type, code, value);
7522b3f6d66SOleksandr Tymoshenko 	switch (sparse) {
7532b3f6d66SOleksandr Tymoshenko 	case EV_REPORT_MT_SLOT:
7542b3f6d66SOleksandr Tymoshenko 		/* report postponed ABS_MT_SLOT */
7552b3f6d66SOleksandr Tymoshenko 		evdev_propagate_event(evdev, EV_ABS, ABS_MT_SLOT,
7562b3f6d66SOleksandr Tymoshenko 		    CURRENT_MT_SLOT(evdev));
7572b3f6d66SOleksandr Tymoshenko 		/* FALLTHROUGH */
7582b3f6d66SOleksandr Tymoshenko 	case EV_REPORT_EVENT:
7592b3f6d66SOleksandr Tymoshenko 		evdev_propagate_event(evdev, type, code, value);
7602b3f6d66SOleksandr Tymoshenko 		/* FALLTHROUGH */
7612b3f6d66SOleksandr Tymoshenko 	case EV_SKIP_EVENT:
7622b3f6d66SOleksandr Tymoshenko 		break;
7632b3f6d66SOleksandr Tymoshenko 	}
7642b3f6d66SOleksandr Tymoshenko }
7652b3f6d66SOleksandr Tymoshenko 
7662b3f6d66SOleksandr Tymoshenko int
7672b3f6d66SOleksandr Tymoshenko evdev_push_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
7682b3f6d66SOleksandr Tymoshenko     int32_t value)
7692b3f6d66SOleksandr Tymoshenko {
7702b3f6d66SOleksandr Tymoshenko 
7712b3f6d66SOleksandr Tymoshenko 	if (evdev_check_event(evdev, type, code, value) != 0)
7722b3f6d66SOleksandr Tymoshenko 		return (EINVAL);
7732b3f6d66SOleksandr Tymoshenko 
7744c0a4665SVladimir Kondratyev 	EVDEV_ENTER(evdev);
7754c0a4665SVladimir Kondratyev 
7762b3f6d66SOleksandr Tymoshenko 	evdev_modify_event(evdev, type, code, &value);
777c736a757SOleksandr Tymoshenko 	if (type == EV_SYN && code == SYN_REPORT &&
778c736a757SOleksandr Tymoshenko 	     bit_test(evdev->ev_flags, EVDEV_FLAG_MT_AUTOREL))
779c736a757SOleksandr Tymoshenko 		evdev_send_mt_autorel(evdev);
7802b3f6d66SOleksandr Tymoshenko 	if (type == EV_SYN && code == SYN_REPORT && evdev->ev_report_opened &&
7812b3f6d66SOleksandr Tymoshenko 	    bit_test(evdev->ev_flags, EVDEV_FLAG_MT_STCOMPAT))
7822b3f6d66SOleksandr Tymoshenko 		evdev_send_mt_compat(evdev);
7832b3f6d66SOleksandr Tymoshenko 	evdev_send_event(evdev, type, code, value);
7844c0a4665SVladimir Kondratyev 
7854c0a4665SVladimir Kondratyev 	EVDEV_EXIT(evdev);
7862b3f6d66SOleksandr Tymoshenko 
7872b3f6d66SOleksandr Tymoshenko 	return (0);
7882b3f6d66SOleksandr Tymoshenko }
7892b3f6d66SOleksandr Tymoshenko 
7902b3f6d66SOleksandr Tymoshenko int
7912b3f6d66SOleksandr Tymoshenko evdev_inject_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
7922b3f6d66SOleksandr Tymoshenko     int32_t value)
7932b3f6d66SOleksandr Tymoshenko {
7942b3f6d66SOleksandr Tymoshenko 	int ret = 0;
7952b3f6d66SOleksandr Tymoshenko 
7962b3f6d66SOleksandr Tymoshenko 	switch (type) {
7972b3f6d66SOleksandr Tymoshenko 	case EV_REP:
7982b3f6d66SOleksandr Tymoshenko 		/* evdev repeats should not be processed by hardware driver */
7992b3f6d66SOleksandr Tymoshenko 		if (bit_test(evdev->ev_flags, EVDEV_FLAG_SOFTREPEAT))
8002b3f6d66SOleksandr Tymoshenko 			goto push;
8012b3f6d66SOleksandr Tymoshenko 		/* FALLTHROUGH */
8022b3f6d66SOleksandr Tymoshenko 	case EV_LED:
8032b3f6d66SOleksandr Tymoshenko 	case EV_MSC:
8042b3f6d66SOleksandr Tymoshenko 	case EV_SND:
8052b3f6d66SOleksandr Tymoshenko 	case EV_FF:
8062b3f6d66SOleksandr Tymoshenko 		if (evdev->ev_methods != NULL &&
8072b3f6d66SOleksandr Tymoshenko 		    evdev->ev_methods->ev_event != NULL)
808*911aed94SVladimir Kondratyev 			evdev->ev_methods->ev_event(evdev, type, code, value);
8092b3f6d66SOleksandr Tymoshenko 		/*
8102b3f6d66SOleksandr Tymoshenko 		 * Leds and driver repeats should be reported in ev_event
8112b3f6d66SOleksandr Tymoshenko 		 * method body to interoperate with kbdmux states and rates
8122b3f6d66SOleksandr Tymoshenko 		 * propagation so both ways (ioctl and evdev) of changing it
8132b3f6d66SOleksandr Tymoshenko 		 * will produce only one evdev event report to client.
8142b3f6d66SOleksandr Tymoshenko 		 */
8152b3f6d66SOleksandr Tymoshenko 		if (type == EV_LED || type == EV_REP)
8162b3f6d66SOleksandr Tymoshenko 			break;
8172b3f6d66SOleksandr Tymoshenko 		/* FALLTHROUGH */
8182b3f6d66SOleksandr Tymoshenko 	case EV_SYN:
8192b3f6d66SOleksandr Tymoshenko 	case EV_KEY:
8202b3f6d66SOleksandr Tymoshenko 	case EV_REL:
8212b3f6d66SOleksandr Tymoshenko 	case EV_ABS:
8222b3f6d66SOleksandr Tymoshenko 	case EV_SW:
8232b3f6d66SOleksandr Tymoshenko push:
824f3f80694SVladimir Kondratyev 		if (evdev->ev_lock_type != EV_LOCK_INTERNAL)
825f3f80694SVladimir Kondratyev 			EVDEV_LOCK(evdev);
8262b3f6d66SOleksandr Tymoshenko 		ret = evdev_push_event(evdev, type,  code, value);
827f3f80694SVladimir Kondratyev 		if (evdev->ev_lock_type != EV_LOCK_INTERNAL)
828f3f80694SVladimir Kondratyev 			EVDEV_UNLOCK(evdev);
8292b3f6d66SOleksandr Tymoshenko 		break;
8302b3f6d66SOleksandr Tymoshenko 
8312b3f6d66SOleksandr Tymoshenko 	default:
8322b3f6d66SOleksandr Tymoshenko 		ret = EINVAL;
8332b3f6d66SOleksandr Tymoshenko 	}
8342b3f6d66SOleksandr Tymoshenko 
8352b3f6d66SOleksandr Tymoshenko 	return (ret);
8362b3f6d66SOleksandr Tymoshenko }
8372b3f6d66SOleksandr Tymoshenko 
8382b3f6d66SOleksandr Tymoshenko int
8392b3f6d66SOleksandr Tymoshenko evdev_register_client(struct evdev_dev *evdev, struct evdev_client *client)
8402b3f6d66SOleksandr Tymoshenko {
8412b3f6d66SOleksandr Tymoshenko 	int ret = 0;
8422b3f6d66SOleksandr Tymoshenko 
8432b3f6d66SOleksandr Tymoshenko 	debugf(evdev, "adding new client for device %s", evdev->ev_shortname);
8442b3f6d66SOleksandr Tymoshenko 
8452b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
8462b3f6d66SOleksandr Tymoshenko 
8472b3f6d66SOleksandr Tymoshenko 	if (LIST_EMPTY(&evdev->ev_clients) && evdev->ev_methods != NULL &&
8482b3f6d66SOleksandr Tymoshenko 	    evdev->ev_methods->ev_open != NULL) {
8492b3f6d66SOleksandr Tymoshenko 		debugf(evdev, "calling ev_open() on device %s",
8502b3f6d66SOleksandr Tymoshenko 		    evdev->ev_shortname);
851*911aed94SVladimir Kondratyev 		ret = evdev->ev_methods->ev_open(evdev);
8522b3f6d66SOleksandr Tymoshenko 	}
8532b3f6d66SOleksandr Tymoshenko 	if (ret == 0)
8542b3f6d66SOleksandr Tymoshenko 		LIST_INSERT_HEAD(&evdev->ev_clients, client, ec_link);
8552b3f6d66SOleksandr Tymoshenko 	return (ret);
8562b3f6d66SOleksandr Tymoshenko }
8572b3f6d66SOleksandr Tymoshenko 
8582b3f6d66SOleksandr Tymoshenko void
8592b3f6d66SOleksandr Tymoshenko evdev_dispose_client(struct evdev_dev *evdev, struct evdev_client *client)
8602b3f6d66SOleksandr Tymoshenko {
8612b3f6d66SOleksandr Tymoshenko 	debugf(evdev, "removing client for device %s", evdev->ev_shortname);
8622b3f6d66SOleksandr Tymoshenko 
8632b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
8642b3f6d66SOleksandr Tymoshenko 
8652b3f6d66SOleksandr Tymoshenko 	LIST_REMOVE(client, ec_link);
8662b3f6d66SOleksandr Tymoshenko 	if (LIST_EMPTY(&evdev->ev_clients)) {
8672b3f6d66SOleksandr Tymoshenko 		if (evdev->ev_methods != NULL &&
8682b3f6d66SOleksandr Tymoshenko 		    evdev->ev_methods->ev_close != NULL)
869*911aed94SVladimir Kondratyev 			(void)evdev->ev_methods->ev_close(evdev);
8702b3f6d66SOleksandr Tymoshenko 		if (evdev_event_supported(evdev, EV_REP) &&
8712b3f6d66SOleksandr Tymoshenko 		    bit_test(evdev->ev_flags, EVDEV_FLAG_SOFTREPEAT))
8722b3f6d66SOleksandr Tymoshenko 			evdev_stop_repeat(evdev);
8732b3f6d66SOleksandr Tymoshenko 	}
8742b3f6d66SOleksandr Tymoshenko 	evdev_release_client(evdev, client);
8752b3f6d66SOleksandr Tymoshenko }
8762b3f6d66SOleksandr Tymoshenko 
8772b3f6d66SOleksandr Tymoshenko int
8782b3f6d66SOleksandr Tymoshenko evdev_grab_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 != NULL)
8842b3f6d66SOleksandr Tymoshenko 		return (EBUSY);
8852b3f6d66SOleksandr Tymoshenko 
8862b3f6d66SOleksandr Tymoshenko 	evdev->ev_grabber = client;
8872b3f6d66SOleksandr Tymoshenko 
8882b3f6d66SOleksandr Tymoshenko 	return (0);
8892b3f6d66SOleksandr Tymoshenko }
8902b3f6d66SOleksandr Tymoshenko 
8912b3f6d66SOleksandr Tymoshenko int
8922b3f6d66SOleksandr Tymoshenko evdev_release_client(struct evdev_dev *evdev, struct evdev_client *client)
8932b3f6d66SOleksandr Tymoshenko {
8942b3f6d66SOleksandr Tymoshenko 
8952b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
8962b3f6d66SOleksandr Tymoshenko 
8972b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_grabber != client)
8982b3f6d66SOleksandr Tymoshenko 		return (EINVAL);
8992b3f6d66SOleksandr Tymoshenko 
9002b3f6d66SOleksandr Tymoshenko 	evdev->ev_grabber = NULL;
9012b3f6d66SOleksandr Tymoshenko 
9022b3f6d66SOleksandr Tymoshenko 	return (0);
9032b3f6d66SOleksandr Tymoshenko }
9042b3f6d66SOleksandr Tymoshenko 
9052b3f6d66SOleksandr Tymoshenko static void
9062b3f6d66SOleksandr Tymoshenko evdev_repeat_callout(void *arg)
9072b3f6d66SOleksandr Tymoshenko {
9082b3f6d66SOleksandr Tymoshenko 	struct evdev_dev *evdev = (struct evdev_dev *)arg;
9092b3f6d66SOleksandr Tymoshenko 
9102b3f6d66SOleksandr Tymoshenko 	evdev_send_event(evdev, EV_KEY, evdev->ev_rep_key, KEY_EVENT_REPEAT);
9112b3f6d66SOleksandr Tymoshenko 	evdev_send_event(evdev, EV_SYN, SYN_REPORT, 1);
9122b3f6d66SOleksandr Tymoshenko 
9132b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_rep[REP_PERIOD])
9142b3f6d66SOleksandr Tymoshenko 		callout_reset(&evdev->ev_rep_callout,
9152b3f6d66SOleksandr Tymoshenko 		    evdev->ev_rep[REP_PERIOD] * hz / 1000,
9162b3f6d66SOleksandr Tymoshenko 		    evdev_repeat_callout, evdev);
9172b3f6d66SOleksandr Tymoshenko 	else
9182b3f6d66SOleksandr Tymoshenko 		evdev->ev_rep_key = KEY_RESERVED;
9192b3f6d66SOleksandr Tymoshenko }
9202b3f6d66SOleksandr Tymoshenko 
9212b3f6d66SOleksandr Tymoshenko static void
9222b3f6d66SOleksandr Tymoshenko evdev_start_repeat(struct evdev_dev *evdev, uint16_t key)
9232b3f6d66SOleksandr Tymoshenko {
9242b3f6d66SOleksandr Tymoshenko 
9252b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
9262b3f6d66SOleksandr Tymoshenko 
9272b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_rep[REP_DELAY]) {
9282b3f6d66SOleksandr Tymoshenko 		evdev->ev_rep_key = key;
9292b3f6d66SOleksandr Tymoshenko 		callout_reset(&evdev->ev_rep_callout,
9302b3f6d66SOleksandr Tymoshenko 		    evdev->ev_rep[REP_DELAY] * hz / 1000,
9312b3f6d66SOleksandr Tymoshenko 		    evdev_repeat_callout, evdev);
9322b3f6d66SOleksandr Tymoshenko 	}
9332b3f6d66SOleksandr Tymoshenko }
9342b3f6d66SOleksandr Tymoshenko 
9352b3f6d66SOleksandr Tymoshenko static void
9362b3f6d66SOleksandr Tymoshenko evdev_stop_repeat(struct evdev_dev *evdev)
9372b3f6d66SOleksandr Tymoshenko {
9382b3f6d66SOleksandr Tymoshenko 
9392b3f6d66SOleksandr Tymoshenko 	EVDEV_LOCK_ASSERT(evdev);
9402b3f6d66SOleksandr Tymoshenko 
9412b3f6d66SOleksandr Tymoshenko 	if (evdev->ev_rep_key != KEY_RESERVED) {
9422b3f6d66SOleksandr Tymoshenko 		callout_stop(&evdev->ev_rep_callout);
9432b3f6d66SOleksandr Tymoshenko 		evdev->ev_rep_key = KEY_RESERVED;
9442b3f6d66SOleksandr Tymoshenko 	}
9452b3f6d66SOleksandr Tymoshenko }
946fa26e8edSOleksandr Tymoshenko 
947fa26e8edSOleksandr Tymoshenko MODULE_VERSION(evdev, 1);
948