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