summaryrefslogtreecommitdiff
path: root/sys/dev/evdev/evdev.c
diff options
context:
space:
mode:
authorOleksandr Tymoshenko <gonzo@FreeBSD.org>2016-10-22 01:38:21 +0000
committerOleksandr Tymoshenko <gonzo@FreeBSD.org>2016-10-22 01:38:21 +0000
commit0a53c4be5e547c67e7bedb5646a4f276c075ea8f (patch)
tree62c3e6d01a3529321a3ac5b4fe3cfaa8fe88204f /sys/dev/evdev/evdev.c
parent152d791f66e291ba51bfab8dafe275d4c6fd5a80 (diff)
Notes
Diffstat (limited to 'sys/dev/evdev/evdev.c')
-rw-r--r--sys/dev/evdev/evdev.c918
1 files changed, 918 insertions, 0 deletions
diff --git a/sys/dev/evdev/evdev.c b/sys/dev/evdev/evdev.c
new file mode 100644
index 000000000000..a2d2a92fd851
--- /dev/null
+++ b/sys/dev/evdev/evdev.c
@@ -0,0 +1,918 @@
+/*-
+ * Copyright (c) 2014 Jakub Wojciech Klama <jceel@FreeBSD.org>
+ * Copyright (c) 2015-2016 Vladimir Kondratyev <wulf@cicgroup.ru>
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ *
+ * $FreeBSD$
+ */
+
+#include "opt_evdev.h"
+
+#include <sys/types.h>
+#include <sys/systm.h>
+#include <sys/param.h>
+#include <sys/kernel.h>
+#include <sys/conf.h>
+#include <sys/malloc.h>
+#include <sys/bitstring.h>
+#include <sys/sysctl.h>
+
+#include <dev/evdev/input.h>
+#include <dev/evdev/evdev.h>
+#include <dev/evdev/evdev_private.h>
+
+#ifdef EVDEV_DEBUG
+#define debugf(evdev, fmt, args...) printf("evdev: " fmt "\n", ##args)
+#else
+#define debugf(evdev, fmt, args...)
+#endif
+
+#ifdef FEATURE
+FEATURE(evdev, "Input event devices support");
+#endif
+
+enum evdev_sparse_result
+{
+ EV_SKIP_EVENT, /* Event value not changed */
+ EV_REPORT_EVENT, /* Event value changed */
+ EV_REPORT_MT_SLOT, /* Event value and MT slot number changed */
+};
+
+MALLOC_DEFINE(M_EVDEV, "evdev", "evdev memory");
+
+int evdev_rcpt_mask = EVDEV_RCPT_SYSMOUSE | EVDEV_RCPT_KBDMUX;
+
+SYSCTL_NODE(_kern, OID_AUTO, evdev, CTLFLAG_RW, 0, "Evdev args");
+SYSCTL_INT(_kern_evdev, OID_AUTO, rcpt_mask, CTLFLAG_RW, &evdev_rcpt_mask, 0,
+ "Who is receiving events: bit0 - sysmouse, bit1 - kbdmux, "
+ "bit2 - mouse hardware, bit3 - keyboard hardware");
+
+static void evdev_start_repeat(struct evdev_dev *, uint16_t);
+static void evdev_stop_repeat(struct evdev_dev *);
+static int evdev_check_event(struct evdev_dev *, uint16_t, uint16_t, int32_t);
+
+static inline void
+bit_change(bitstr_t *bitstr, int bit, int value)
+{
+ if (value)
+ bit_set(bitstr, bit);
+ else
+ bit_clear(bitstr, bit);
+}
+
+struct evdev_dev *
+evdev_alloc(void)
+{
+
+ return malloc(sizeof(struct evdev_dev), M_EVDEV, M_WAITOK | M_ZERO);
+}
+
+void
+evdev_free(struct evdev_dev *evdev)
+{
+
+ if (evdev != NULL && evdev->ev_cdev != NULL &&
+ evdev->ev_cdev->si_drv1 != NULL)
+ evdev_unregister(evdev);
+
+ free(evdev, M_EVDEV);
+}
+
+static struct input_absinfo *
+evdev_alloc_absinfo(void)
+{
+
+ return (malloc(sizeof(struct input_absinfo) * ABS_CNT, M_EVDEV,
+ M_WAITOK | M_ZERO));
+}
+
+static void
+evdev_free_absinfo(struct input_absinfo *absinfo)
+{
+
+ free(absinfo, M_EVDEV);
+}
+
+int
+evdev_set_report_size(struct evdev_dev *evdev, size_t report_size)
+{
+ if (report_size > KEY_CNT + REL_CNT + ABS_CNT + MAX_MT_SLOTS * MT_CNT +
+ MSC_CNT + LED_CNT + SND_CNT + SW_CNT + FF_CNT)
+ return (EINVAL);
+
+ evdev->ev_report_size = report_size;
+ return (0);
+}
+
+static size_t
+evdev_estimate_report_size(struct evdev_dev *evdev)
+{
+ size_t size = 0;
+ int res;
+
+ /*
+ * Keyboards generate one event per report but other devices with
+ * buttons like mouses can report events simultaneously
+ */
+ bit_ffs_at(evdev->ev_key_flags, KEY_OK, KEY_CNT - KEY_OK, &res);
+ if (res == -1)
+ bit_ffs(evdev->ev_key_flags, BTN_MISC, &res);
+ size += (res != -1);
+ bit_count(evdev->ev_key_flags, BTN_MISC, KEY_OK - BTN_MISC, &res);
+ size += res;
+
+ /* All relative axes can be reported simultaneously */
+ bit_count(evdev->ev_rel_flags, 0, REL_CNT, &res);
+ size += res;
+
+ /*
+ * All absolute axes can be reported simultaneously.
+ * Multitouch axes can be reported ABS_MT_SLOT times
+ */
+ if (evdev->ev_absinfo != NULL) {
+ bit_count(evdev->ev_abs_flags, 0, ABS_CNT, &res);
+ size += res;
+ bit_count(evdev->ev_abs_flags, ABS_MT_FIRST, MT_CNT, &res);
+ if (res > 0) {
+ res++; /* ABS_MT_SLOT or SYN_MT_REPORT */
+ if (bit_test(evdev->ev_abs_flags, ABS_MT_SLOT))
+ /* MT type B */
+ size += res * MAXIMAL_MT_SLOT(evdev);
+ else
+ /* MT type A */
+ size += res * (MAX_MT_REPORTS - 1);
+ }
+ }
+
+ /* All misc events can be reported simultaneously */
+ bit_count(evdev->ev_msc_flags, 0, MSC_CNT, &res);
+ size += res;
+
+ /* All leds can be reported simultaneously */
+ bit_count(evdev->ev_led_flags, 0, LED_CNT, &res);
+ size += res;
+
+ /* Assume other events are generated once per report */
+ bit_ffs(evdev->ev_snd_flags, SND_CNT, &res);
+ size += (res != -1);
+
+ bit_ffs(evdev->ev_sw_flags, SW_CNT, &res);
+ size += (res != -1);
+
+ /* XXX: FF part is not implemented yet */
+
+ size++; /* SYN_REPORT */
+ return (size);
+}
+
+int
+evdev_register(struct evdev_dev *evdev)
+{
+ int ret;
+
+ debugf(evdev, "%s: registered evdev provider: %s <%s>\n",
+ evdev->ev_shortname, evdev->ev_name, evdev->ev_serial);
+
+ /* Initialize internal structures */
+ mtx_init(&evdev->ev_mtx, "evmtx", NULL, MTX_DEF);
+ LIST_INIT(&evdev->ev_clients);
+
+ if (evdev_event_supported(evdev, EV_REP) &&
+ bit_test(evdev->ev_flags, EVDEV_FLAG_SOFTREPEAT)) {
+ /* Initialize callout */
+ callout_init_mtx(&evdev->ev_rep_callout, &evdev->ev_mtx, 0);
+
+ if (evdev->ev_rep[REP_DELAY] == 0 &&
+ evdev->ev_rep[REP_PERIOD] == 0) {
+ /* Supply default values */
+ evdev->ev_rep[REP_DELAY] = 250;
+ evdev->ev_rep[REP_PERIOD] = 33;
+ }
+ }
+
+ /* Initialize multitouch protocol type B states */
+ if (bit_test(evdev->ev_abs_flags, ABS_MT_SLOT) &&
+ evdev->ev_absinfo != NULL && MAXIMAL_MT_SLOT(evdev) > 0)
+ evdev_mt_init(evdev);
+
+ /* Estimate maximum report size */
+ if (evdev->ev_report_size == 0) {
+ ret = evdev_set_report_size(evdev,
+ evdev_estimate_report_size(evdev));
+ if (ret != 0)
+ goto bail_out;
+ }
+
+ /* Create char device node */
+ ret = evdev_cdev_create(evdev);
+bail_out:
+ if (ret != 0)
+ mtx_destroy(&evdev->ev_mtx);
+
+ return (ret);
+}
+
+int
+evdev_unregister(struct evdev_dev *evdev)
+{
+ struct evdev_client *client;
+ int ret;
+ debugf(evdev, "%s: unregistered evdev provider: %s\n",
+ evdev->ev_shortname, evdev->ev_name);
+
+ EVDEV_LOCK(evdev);
+ evdev->ev_cdev->si_drv1 = NULL;
+ /* Wake up sleepers */
+ LIST_FOREACH(client, &evdev->ev_clients, ec_link) {
+ evdev_revoke_client(client);
+ evdev_dispose_client(evdev, client);
+ EVDEV_CLIENT_LOCKQ(client);
+ evdev_notify_event(client);
+ EVDEV_CLIENT_UNLOCKQ(client);
+ }
+ EVDEV_UNLOCK(evdev);
+
+ /* destroy_dev can sleep so release lock */
+ ret = evdev_cdev_destroy(evdev);
+ evdev->ev_cdev = NULL;
+ if (ret == 0)
+ mtx_destroy(&evdev->ev_mtx);
+
+ evdev_free_absinfo(evdev->ev_absinfo);
+ evdev_mt_free(evdev);
+
+ return (ret);
+}
+
+inline void
+evdev_set_name(struct evdev_dev *evdev, const char *name)
+{
+
+ snprintf(evdev->ev_name, NAMELEN, "%s", name);
+}
+
+inline void
+evdev_set_id(struct evdev_dev *evdev, uint16_t bustype, uint16_t vendor,
+ uint16_t product, uint16_t version)
+{
+
+ evdev->ev_id = (struct input_id) {
+ .bustype = bustype,
+ .vendor = vendor,
+ .product = product,
+ .version = version
+ };
+}
+
+inline void
+evdev_set_phys(struct evdev_dev *evdev, const char *name)
+{
+
+ snprintf(evdev->ev_shortname, NAMELEN, "%s", name);
+}
+
+inline void
+evdev_set_serial(struct evdev_dev *evdev, const char *serial)
+{
+
+ snprintf(evdev->ev_serial, NAMELEN, "%s", serial);
+}
+
+inline void
+evdev_set_methods(struct evdev_dev *evdev, void *softc,
+ struct evdev_methods *methods)
+{
+
+ evdev->ev_methods = methods;
+ evdev->ev_softc = softc;
+}
+
+inline void
+evdev_support_prop(struct evdev_dev *evdev, uint16_t prop)
+{
+
+ KASSERT(prop < INPUT_PROP_CNT, ("invalid evdev input property"));
+ bit_set(evdev->ev_prop_flags, prop);
+}
+
+inline void
+evdev_support_event(struct evdev_dev *evdev, uint16_t type)
+{
+
+ KASSERT(type < EV_CNT, ("invalid evdev event property"));
+ bit_set(evdev->ev_type_flags, type);
+}
+
+inline void
+evdev_support_key(struct evdev_dev *evdev, uint16_t code)
+{
+
+ KASSERT(code < KEY_CNT, ("invalid evdev key property"));
+ bit_set(evdev->ev_key_flags, code);
+}
+
+inline void
+evdev_support_rel(struct evdev_dev *evdev, uint16_t code)
+{
+
+ KASSERT(code < REL_CNT, ("invalid evdev rel property"));
+ bit_set(evdev->ev_rel_flags, code);
+}
+
+inline void
+evdev_support_abs(struct evdev_dev *evdev, uint16_t code, int32_t value,
+ int32_t minimum, int32_t maximum, int32_t fuzz, int32_t flat,
+ int32_t resolution)
+{
+ struct input_absinfo absinfo;
+
+ KASSERT(code < ABS_CNT, ("invalid evdev abs property"));
+
+ absinfo = (struct input_absinfo) {
+ .value = value,
+ .minimum = minimum,
+ .maximum = maximum,
+ .fuzz = fuzz,
+ .flat = flat,
+ .resolution = resolution,
+ };
+ evdev_set_abs_bit(evdev, code);
+ evdev_set_absinfo(evdev, code, &absinfo);
+}
+
+inline void
+evdev_set_abs_bit(struct evdev_dev *evdev, uint16_t code)
+{
+
+ KASSERT(code < ABS_CNT, ("invalid evdev abs property"));
+ if (evdev->ev_absinfo == NULL)
+ evdev->ev_absinfo = evdev_alloc_absinfo();
+ bit_set(evdev->ev_abs_flags, code);
+}
+
+inline void
+evdev_support_msc(struct evdev_dev *evdev, uint16_t code)
+{
+
+ KASSERT(code < MSC_CNT, ("invalid evdev msc property"));
+ bit_set(evdev->ev_msc_flags, code);
+}
+
+
+inline void
+evdev_support_led(struct evdev_dev *evdev, uint16_t code)
+{
+
+ KASSERT(code < LED_CNT, ("invalid evdev led property"));
+ bit_set(evdev->ev_led_flags, code);
+}
+
+inline void
+evdev_support_snd(struct evdev_dev *evdev, uint16_t code)
+{
+
+ KASSERT(code < SND_CNT, ("invalid evdev snd property"));
+ bit_set(evdev->ev_snd_flags, code);
+}
+
+inline void
+evdev_support_sw(struct evdev_dev *evdev, uint16_t code)
+{
+
+ KASSERT(code < SW_CNT, ("invalid evdev sw property"));
+ bit_set(evdev->ev_sw_flags, code);
+}
+
+bool
+evdev_event_supported(struct evdev_dev *evdev, uint16_t type)
+{
+
+ KASSERT(type < EV_CNT, ("invalid evdev event property"));
+ return (bit_test(evdev->ev_type_flags, type));
+}
+
+inline void
+evdev_set_absinfo(struct evdev_dev *evdev, uint16_t axis,
+ struct input_absinfo *absinfo)
+{
+
+ KASSERT(axis < ABS_CNT, ("invalid evdev abs property"));
+
+ if (axis == ABS_MT_SLOT &&
+ (absinfo->maximum < 1 || absinfo->maximum >= MAX_MT_SLOTS))
+ return;
+
+ if (evdev->ev_absinfo == NULL)
+ evdev->ev_absinfo = evdev_alloc_absinfo();
+
+ if (axis == ABS_MT_SLOT)
+ evdev->ev_absinfo[ABS_MT_SLOT].maximum = absinfo->maximum;
+ else
+ memcpy(&evdev->ev_absinfo[axis], absinfo,
+ sizeof(struct input_absinfo));
+}
+
+inline void
+evdev_set_repeat_params(struct evdev_dev *evdev, uint16_t property, int value)
+{
+
+ KASSERT(property < REP_CNT, ("invalid evdev repeat property"));
+ evdev->ev_rep[property] = value;
+}
+
+inline void
+evdev_set_flag(struct evdev_dev *evdev, uint16_t flag)
+{
+
+ KASSERT(flag < EVDEV_FLAG_CNT, ("invalid evdev flag property"));
+ bit_set(evdev->ev_flags, flag);
+}
+
+static int
+evdev_check_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
+ int32_t value)
+{
+
+ if (type >= EV_CNT)
+ return (EINVAL);
+
+ /* Allow SYN events implicitly */
+ if (type != EV_SYN && !evdev_event_supported(evdev, type))
+ return (EINVAL);
+
+ switch (type) {
+ case EV_SYN:
+ if (code >= SYN_CNT)
+ return (EINVAL);
+ break;
+
+ case EV_KEY:
+ if (code >= KEY_CNT)
+ return (EINVAL);
+ if (!bit_test(evdev->ev_key_flags, code))
+ return (EINVAL);
+ break;
+
+ case EV_REL:
+ if (code >= REL_CNT)
+ return (EINVAL);
+ if (!bit_test(evdev->ev_rel_flags, code))
+ return (EINVAL);
+ break;
+
+ case EV_ABS:
+ if (code >= ABS_CNT)
+ return (EINVAL);
+ if (!bit_test(evdev->ev_abs_flags, code))
+ return (EINVAL);
+ if (code == ABS_MT_SLOT &&
+ (value < 0 || value > MAXIMAL_MT_SLOT(evdev)))
+ return (EINVAL);
+ if (ABS_IS_MT(code) && evdev->ev_mt == NULL &&
+ bit_test(evdev->ev_abs_flags, ABS_MT_SLOT))
+ return (EINVAL);
+ break;
+
+ case EV_MSC:
+ if (code >= MSC_CNT)
+ return (EINVAL);
+ if (!bit_test(evdev->ev_msc_flags, code))
+ return (EINVAL);
+ break;
+
+ case EV_LED:
+ if (code >= LED_CNT)
+ return (EINVAL);
+ if (!bit_test(evdev->ev_led_flags, code))
+ return (EINVAL);
+ break;
+
+ case EV_SND:
+ if (code >= SND_CNT)
+ return (EINVAL);
+ if (!bit_test(evdev->ev_snd_flags, code))
+ return (EINVAL);
+ break;
+
+ case EV_SW:
+ if (code >= SW_CNT)
+ return (EINVAL);
+ if (!bit_test(evdev->ev_sw_flags, code))
+ return (EINVAL);
+ break;
+
+ case EV_REP:
+ if (code >= REP_CNT)
+ return (EINVAL);
+ break;
+
+ default:
+ return (EINVAL);
+ }
+
+ return (0);
+}
+
+static void
+evdev_modify_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
+ int32_t *value)
+{
+
+ EVDEV_LOCK_ASSERT(evdev);
+
+ switch (type) {
+ case EV_KEY:
+ if (!evdev_event_supported(evdev, EV_REP))
+ break;
+
+ if (!bit_test(evdev->ev_flags, EVDEV_FLAG_SOFTREPEAT)) {
+ /* Detect driver key repeats. */
+ if (bit_test(evdev->ev_key_states, code) &&
+ *value == KEY_EVENT_DOWN)
+ *value = KEY_EVENT_REPEAT;
+ } else {
+ /* Start/stop callout for evdev repeats */
+ if (bit_test(evdev->ev_key_states, code) == !*value) {
+ if (*value == KEY_EVENT_DOWN)
+ evdev_start_repeat(evdev, code);
+ else
+ evdev_stop_repeat(evdev);
+ }
+ }
+ break;
+
+ case EV_ABS:
+ /* TBD: implement fuzz */
+ break;
+ }
+}
+
+static enum evdev_sparse_result
+evdev_sparse_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
+ int32_t value)
+{
+ int32_t last_mt_slot;
+
+ EVDEV_LOCK_ASSERT(evdev);
+
+ /*
+ * For certain event types, update device state bits
+ * and convert level reporting to edge reporting
+ */
+ switch (type) {
+ case EV_KEY:
+ switch (value) {
+ case KEY_EVENT_UP:
+ case KEY_EVENT_DOWN:
+ if (bit_test(evdev->ev_key_states, code) == value)
+ return (EV_SKIP_EVENT);
+ bit_change(evdev->ev_key_states, code, value);
+ break;
+
+ case KEY_EVENT_REPEAT:
+ if (bit_test(evdev->ev_key_states, code) == 0 ||
+ !evdev_event_supported(evdev, EV_REP))
+ return (EV_SKIP_EVENT);
+ break;
+
+ default:
+ return (EV_SKIP_EVENT);
+ }
+ break;
+
+ case EV_LED:
+ if (bit_test(evdev->ev_led_states, code) == value)
+ return (EV_SKIP_EVENT);
+ bit_change(evdev->ev_led_states, code, value);
+ break;
+
+ case EV_SND:
+ if (bit_test(evdev->ev_snd_states, code) == value)
+ return (EV_SKIP_EVENT);
+ bit_change(evdev->ev_snd_states, code, value);
+ break;
+
+ case EV_SW:
+ if (bit_test(evdev->ev_sw_states, code) == value)
+ return (EV_SKIP_EVENT);
+ bit_change(evdev->ev_sw_states, code, value);
+ break;
+
+ case EV_REP:
+ if (evdev->ev_rep[code] == value)
+ return (EV_SKIP_EVENT);
+ evdev_set_repeat_params(evdev, code, value);
+ break;
+
+ case EV_REL:
+ if (value == 0)
+ return (EV_SKIP_EVENT);
+ break;
+
+ /* For EV_ABS, save last value in absinfo and ev_mt_states */
+ case EV_ABS:
+ switch (code) {
+ case ABS_MT_SLOT:
+ /* Postpone ABS_MT_SLOT till next event */
+ evdev_set_last_mt_slot(evdev, value);
+ return (EV_SKIP_EVENT);
+
+ case ABS_MT_FIRST ... ABS_MT_LAST:
+ /* Pass MT protocol type A events as is */
+ if (!bit_test(evdev->ev_abs_flags, ABS_MT_SLOT))
+ break;
+ /* Don`t repeat MT protocol type B events */
+ last_mt_slot = evdev_get_last_mt_slot(evdev);
+ if (evdev_get_mt_value(evdev, last_mt_slot, code)
+ == value)
+ return (EV_SKIP_EVENT);
+ evdev_set_mt_value(evdev, last_mt_slot, code, value);
+ if (last_mt_slot != CURRENT_MT_SLOT(evdev)) {
+ CURRENT_MT_SLOT(evdev) = last_mt_slot;
+ evdev->ev_report_opened = true;
+ return (EV_REPORT_MT_SLOT);
+ }
+ break;
+
+ default:
+ if (evdev->ev_absinfo[code].value == value)
+ return (EV_SKIP_EVENT);
+ evdev->ev_absinfo[code].value = value;
+ }
+ break;
+
+ case EV_SYN:
+ if (code == SYN_REPORT) {
+ /* Skip empty reports */
+ if (!evdev->ev_report_opened)
+ return (EV_SKIP_EVENT);
+ evdev->ev_report_opened = false;
+ return (EV_REPORT_EVENT);
+ }
+ break;
+ }
+
+ evdev->ev_report_opened = true;
+ return (EV_REPORT_EVENT);
+}
+
+static void
+evdev_propagate_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
+ int32_t value)
+{
+ struct evdev_client *client;
+
+ debugf(evdev, "%s pushed event %d/%d/%d",
+ evdev->ev_shortname, type, code, value);
+
+ EVDEV_LOCK_ASSERT(evdev);
+
+ /* Propagate event through all clients */
+ LIST_FOREACH(client, &evdev->ev_clients, ec_link) {
+ if (evdev->ev_grabber != NULL && evdev->ev_grabber != client)
+ continue;
+
+ EVDEV_CLIENT_LOCKQ(client);
+ evdev_client_push(client, type, code, value);
+ if (type == EV_SYN && code == SYN_REPORT)
+ evdev_notify_event(client);
+ EVDEV_CLIENT_UNLOCKQ(client);
+ }
+
+ /* Update counters */
+ evdev->ev_event_count++;
+ if (type == EV_SYN && code == SYN_REPORT)
+ evdev->ev_report_count++;
+}
+
+void
+evdev_send_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
+ int32_t value)
+{
+ enum evdev_sparse_result sparse;
+
+ EVDEV_LOCK_ASSERT(evdev);
+
+ sparse = evdev_sparse_event(evdev, type, code, value);
+ switch (sparse) {
+ case EV_REPORT_MT_SLOT:
+ /* report postponed ABS_MT_SLOT */
+ evdev_propagate_event(evdev, EV_ABS, ABS_MT_SLOT,
+ CURRENT_MT_SLOT(evdev));
+ /* FALLTHROUGH */
+ case EV_REPORT_EVENT:
+ evdev_propagate_event(evdev, type, code, value);
+ /* FALLTHROUGH */
+ case EV_SKIP_EVENT:
+ break;
+ }
+}
+
+int
+evdev_push_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
+ int32_t value)
+{
+
+ if (evdev_check_event(evdev, type, code, value) != 0)
+ return (EINVAL);
+
+ EVDEV_LOCK(evdev);
+ evdev_modify_event(evdev, type, code, &value);
+ if (type == EV_SYN && code == SYN_REPORT && evdev->ev_report_opened &&
+ bit_test(evdev->ev_flags, EVDEV_FLAG_MT_STCOMPAT))
+ evdev_send_mt_compat(evdev);
+ evdev_send_event(evdev, type, code, value);
+ EVDEV_UNLOCK(evdev);
+
+ return (0);
+}
+
+int
+evdev_inject_event(struct evdev_dev *evdev, uint16_t type, uint16_t code,
+ int32_t value)
+{
+ int ret = 0;
+
+ switch (type) {
+ case EV_REP:
+ /* evdev repeats should not be processed by hardware driver */
+ if (bit_test(evdev->ev_flags, EVDEV_FLAG_SOFTREPEAT))
+ goto push;
+ /* FALLTHROUGH */
+ case EV_LED:
+ case EV_MSC:
+ case EV_SND:
+ case EV_FF:
+ if (evdev->ev_methods != NULL &&
+ evdev->ev_methods->ev_event != NULL)
+ evdev->ev_methods->ev_event(evdev, evdev->ev_softc,
+ type, code, value);
+ /*
+ * Leds and driver repeats should be reported in ev_event
+ * method body to interoperate with kbdmux states and rates
+ * propagation so both ways (ioctl and evdev) of changing it
+ * will produce only one evdev event report to client.
+ */
+ if (type == EV_LED || type == EV_REP)
+ break;
+ /* FALLTHROUGH */
+ case EV_SYN:
+ case EV_KEY:
+ case EV_REL:
+ case EV_ABS:
+ case EV_SW:
+push:
+ ret = evdev_push_event(evdev, type, code, value);
+ break;
+
+ default:
+ ret = EINVAL;
+ }
+
+ return (ret);
+}
+
+inline int
+evdev_sync(struct evdev_dev *evdev)
+{
+
+ return (evdev_push_event(evdev, EV_SYN, SYN_REPORT, 1));
+}
+
+
+inline int
+evdev_mt_sync(struct evdev_dev *evdev)
+{
+
+ return (evdev_push_event(evdev, EV_SYN, SYN_MT_REPORT, 1));
+}
+
+int
+evdev_register_client(struct evdev_dev *evdev, struct evdev_client *client)
+{
+ int ret = 0;
+
+ debugf(evdev, "adding new client for device %s", evdev->ev_shortname);
+
+ EVDEV_LOCK_ASSERT(evdev);
+
+ if (LIST_EMPTY(&evdev->ev_clients) && evdev->ev_methods != NULL &&
+ evdev->ev_methods->ev_open != NULL) {
+ debugf(evdev, "calling ev_open() on device %s",
+ evdev->ev_shortname);
+ ret = evdev->ev_methods->ev_open(evdev, evdev->ev_softc);
+ }
+ if (ret == 0)
+ LIST_INSERT_HEAD(&evdev->ev_clients, client, ec_link);
+ return (ret);
+}
+
+void
+evdev_dispose_client(struct evdev_dev *evdev, struct evdev_client *client)
+{
+ debugf(evdev, "removing client for device %s", evdev->ev_shortname);
+
+ EVDEV_LOCK_ASSERT(evdev);
+
+ LIST_REMOVE(client, ec_link);
+ if (LIST_EMPTY(&evdev->ev_clients)) {
+ if (evdev->ev_methods != NULL &&
+ evdev->ev_methods->ev_close != NULL)
+ evdev->ev_methods->ev_close(evdev, evdev->ev_softc);
+ if (evdev_event_supported(evdev, EV_REP) &&
+ bit_test(evdev->ev_flags, EVDEV_FLAG_SOFTREPEAT))
+ evdev_stop_repeat(evdev);
+ }
+ evdev_release_client(evdev, client);
+}
+
+int
+evdev_grab_client(struct evdev_dev *evdev, struct evdev_client *client)
+{
+
+ EVDEV_LOCK_ASSERT(evdev);
+
+ if (evdev->ev_grabber != NULL)
+ return (EBUSY);
+
+ evdev->ev_grabber = client;
+
+ return (0);
+}
+
+int
+evdev_release_client(struct evdev_dev *evdev, struct evdev_client *client)
+{
+
+ EVDEV_LOCK_ASSERT(evdev);
+
+ if (evdev->ev_grabber != client)
+ return (EINVAL);
+
+ evdev->ev_grabber = NULL;
+
+ return (0);
+}
+
+static void
+evdev_repeat_callout(void *arg)
+{
+ struct evdev_dev *evdev = (struct evdev_dev *)arg;
+
+ evdev_send_event(evdev, EV_KEY, evdev->ev_rep_key, KEY_EVENT_REPEAT);
+ evdev_send_event(evdev, EV_SYN, SYN_REPORT, 1);
+
+ if (evdev->ev_rep[REP_PERIOD])
+ callout_reset(&evdev->ev_rep_callout,
+ evdev->ev_rep[REP_PERIOD] * hz / 1000,
+ evdev_repeat_callout, evdev);
+ else
+ evdev->ev_rep_key = KEY_RESERVED;
+}
+
+static void
+evdev_start_repeat(struct evdev_dev *evdev, uint16_t key)
+{
+
+ EVDEV_LOCK_ASSERT(evdev);
+
+ if (evdev->ev_rep[REP_DELAY]) {
+ evdev->ev_rep_key = key;
+ callout_reset(&evdev->ev_rep_callout,
+ evdev->ev_rep[REP_DELAY] * hz / 1000,
+ evdev_repeat_callout, evdev);
+ }
+}
+
+static void
+evdev_stop_repeat(struct evdev_dev *evdev)
+{
+
+ EVDEV_LOCK_ASSERT(evdev);
+
+ if (evdev->ev_rep_key != KEY_RESERVED) {
+ callout_stop(&evdev->ev_rep_callout);
+ evdev->ev_rep_key = KEY_RESERVED;
+ }
+}