mirror of
https://github.com/libretro/Mesen.git
synced 2024-11-30 20:40:54 +00:00
1723 lines
39 KiB
C
Executable File
1723 lines
39 KiB
C
Executable File
/*
|
|
* Copyright © 2013 Red Hat, Inc.
|
|
*
|
|
* Permission to use, copy, modify, distribute, and sell this software and its
|
|
* documentation for any purpose is hereby granted without fee, provided that
|
|
* the above copyright notice appear in all copies and that both that copyright
|
|
* notice and this permission notice appear in supporting documentation, and
|
|
* that the name of the copyright holders not be used in advertising or
|
|
* publicity pertaining to distribution of the software without specific,
|
|
* written prior permission. The copyright holders make no representations
|
|
* about the suitability of this software for any purpose. It is provided "as
|
|
* is" without express or implied warranty.
|
|
*
|
|
* THE COPYRIGHT HOLDERS DISCLAIM ALL WARRANTIES WITH REGARD TO THIS SOFTWARE,
|
|
* INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO
|
|
* EVENT SHALL THE COPYRIGHT HOLDERS BE LIABLE FOR ANY SPECIAL, INDIRECT OR
|
|
* CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE,
|
|
* DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
|
|
* TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE
|
|
* OF THIS SOFTWARE.
|
|
*/
|
|
|
|
#include <errno.h>
|
|
#include <poll.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <limits.h>
|
|
#include <unistd.h>
|
|
#include <stdarg.h>
|
|
#include <stdbool.h>
|
|
|
|
#include "libevdev.h"
|
|
#include "libevdev-int.h"
|
|
#include "libevdev-util.h"
|
|
#include "event-names.h"
|
|
|
|
#define MAXEVENTS 64
|
|
|
|
enum event_filter_status {
|
|
EVENT_FILTER_NONE, /**< Event untouched by filters */
|
|
EVENT_FILTER_MODIFIED, /**< Event was modified */
|
|
EVENT_FILTER_DISCARD, /**< Discard current event */
|
|
};
|
|
|
|
static int sync_mt_state(struct libevdev *dev, int create_events);
|
|
|
|
static inline int*
|
|
slot_value(const struct libevdev *dev, int slot, int axis)
|
|
{
|
|
if (unlikely(slot > dev->num_slots)) {
|
|
log_bug(dev, "Slot %d exceeds number of slots (%d)\n", slot, dev->num_slots);
|
|
slot = 0;
|
|
}
|
|
if (unlikely(axis < ABS_MT_MIN || axis > ABS_MT_MAX)) {
|
|
log_bug(dev, "MT axis %d is outside the valid range [%d,%d]\n",
|
|
axis, ABS_MT_MIN, ABS_MT_MAX);
|
|
axis = ABS_MT_MIN;
|
|
}
|
|
return &dev->mt_slot_vals[slot * ABS_MT_CNT + axis - ABS_MT_MIN];
|
|
}
|
|
|
|
static int
|
|
init_event_queue(struct libevdev *dev)
|
|
{
|
|
const int MIN_QUEUE_SIZE = 256;
|
|
int nevents = 1; /* terminating SYN_REPORT */
|
|
int nslots;
|
|
unsigned int type, code;
|
|
|
|
/* count the number of axes, keys, etc. to get a better idea at how
|
|
many events per EV_SYN we could possibly get. That's the max we
|
|
may get during SYN_DROPPED too. Use double that, just so we have
|
|
room for events while syncing a device.
|
|
*/
|
|
for (type = EV_KEY; type < EV_MAX; type++) {
|
|
int max = libevdev_event_type_get_max(type);
|
|
for (code = 0; max > 0 && code < (unsigned int) max; code++) {
|
|
if (libevdev_has_event_code(dev, type, code))
|
|
nevents++;
|
|
}
|
|
}
|
|
|
|
nslots = libevdev_get_num_slots(dev);
|
|
if (nslots > 1) {
|
|
int num_mt_axes = 0;
|
|
|
|
for (code = ABS_MT_SLOT; code <= ABS_MAX; code++) {
|
|
if (libevdev_has_event_code(dev, EV_ABS, code))
|
|
num_mt_axes++;
|
|
}
|
|
|
|
/* We already counted the first slot in the initial count */
|
|
nevents += num_mt_axes * (nslots - 1);
|
|
}
|
|
|
|
return queue_alloc(dev, max(MIN_QUEUE_SIZE, nevents * 2));
|
|
}
|
|
|
|
static void
|
|
libevdev_dflt_log_func(enum libevdev_log_priority priority,
|
|
void *data,
|
|
const char *file, int line, const char *func,
|
|
const char *format, va_list args)
|
|
{
|
|
const char *prefix;
|
|
switch(priority) {
|
|
case LIBEVDEV_LOG_ERROR: prefix = "libevdev error"; break;
|
|
case LIBEVDEV_LOG_INFO: prefix = "libevdev info"; break;
|
|
case LIBEVDEV_LOG_DEBUG:
|
|
prefix = "libevdev debug";
|
|
break;
|
|
default:
|
|
prefix = "libevdev INVALID LOG PRIORITY";
|
|
break;
|
|
}
|
|
/* default logging format:
|
|
libevev error in libevdev_some_func: blah blah
|
|
libevev info in libevdev_some_func: blah blah
|
|
libevev debug in file.c:123:libevdev_some_func: blah blah
|
|
*/
|
|
|
|
fprintf(stderr, "%s in ", prefix);
|
|
if (priority == LIBEVDEV_LOG_DEBUG)
|
|
fprintf(stderr, "%s:%d:", file, line);
|
|
fprintf(stderr, "%s: ", func);
|
|
vfprintf(stderr, format, args);
|
|
}
|
|
|
|
static void
|
|
fix_invalid_absinfo(const struct libevdev *dev,
|
|
int axis,
|
|
struct input_absinfo* abs_info)
|
|
{
|
|
/*
|
|
* The reported absinfo for ABS_MT_TRACKING_ID is sometimes
|
|
* uninitialized for certain mtk-soc, due to init code mangling
|
|
* in the vendor kernel.
|
|
*/
|
|
if (axis == ABS_MT_TRACKING_ID &&
|
|
abs_info->maximum == abs_info->minimum) {
|
|
abs_info->minimum = -1;
|
|
abs_info->maximum = 0xFFFF;
|
|
log_bug(dev,
|
|
"Device \"%s\" has invalid ABS_MT_TRACKING_ID range",
|
|
dev->name);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Global logging settings.
|
|
*/
|
|
static struct logdata log_data = {
|
|
.priority = LIBEVDEV_LOG_INFO,
|
|
.global_handler = libevdev_dflt_log_func,
|
|
.userdata = NULL,
|
|
};
|
|
|
|
void
|
|
_libevdev_log_msg(const struct libevdev *dev,
|
|
enum libevdev_log_priority priority,
|
|
const char *file, int line, const char *func,
|
|
const char *format, ...)
|
|
{
|
|
va_list args;
|
|
|
|
if (dev && dev->log.device_handler) {
|
|
/**
|
|
* if both global handler and device handler are set
|
|
* we've set up the handlers wrong. And that means we'll
|
|
* likely get the printf args wrong and cause all sorts of
|
|
* mayhem. Seppuku is called for.
|
|
*/
|
|
if (unlikely(dev->log.global_handler))
|
|
abort();
|
|
|
|
if (priority > dev->log.priority)
|
|
return;
|
|
} else if (!log_data.global_handler || priority > log_data.priority)
|
|
return;
|
|
else if (unlikely(log_data.device_handler))
|
|
abort(); /* Seppuku, see above */
|
|
|
|
va_start(args, format);
|
|
if (dev && dev->log.device_handler)
|
|
dev->log.device_handler(dev, priority, dev->log.userdata, file, line, func, format, args);
|
|
else
|
|
log_data.global_handler(priority, log_data.userdata, file, line, func, format, args);
|
|
va_end(args);
|
|
}
|
|
|
|
static void
|
|
libevdev_reset(struct libevdev *dev)
|
|
{
|
|
enum libevdev_log_priority pri = dev->log.priority;
|
|
libevdev_device_log_func_t handler = dev->log.device_handler;
|
|
|
|
free(dev->name);
|
|
free(dev->phys);
|
|
free(dev->uniq);
|
|
free(dev->mt_slot_vals);
|
|
free(dev->mt_sync.mt_state);
|
|
free(dev->mt_sync.tracking_id_changes);
|
|
free(dev->mt_sync.slot_update);
|
|
memset(dev, 0, sizeof(*dev));
|
|
dev->fd = -1;
|
|
dev->initialized = false;
|
|
dev->num_slots = -1;
|
|
dev->current_slot = -1;
|
|
dev->grabbed = LIBEVDEV_UNGRAB;
|
|
dev->sync_state = SYNC_NONE;
|
|
dev->log.priority = pri;
|
|
dev->log.device_handler = handler;
|
|
libevdev_enable_event_type(dev, EV_SYN);
|
|
}
|
|
|
|
LIBEVDEV_EXPORT struct libevdev*
|
|
libevdev_new(void)
|
|
{
|
|
struct libevdev *dev;
|
|
|
|
dev = calloc(1, sizeof(*dev));
|
|
if (!dev)
|
|
return NULL;
|
|
|
|
libevdev_reset(dev);
|
|
|
|
return dev;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_new_from_fd(int fd, struct libevdev **dev)
|
|
{
|
|
struct libevdev *d;
|
|
int rc;
|
|
|
|
d = libevdev_new();
|
|
if (!d)
|
|
return -ENOMEM;
|
|
|
|
rc = libevdev_set_fd(d, fd);
|
|
if (rc < 0)
|
|
libevdev_free(d);
|
|
else
|
|
*dev = d;
|
|
return rc;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT void
|
|
libevdev_free(struct libevdev *dev)
|
|
{
|
|
if (!dev)
|
|
return;
|
|
|
|
queue_free(dev);
|
|
libevdev_reset(dev);
|
|
free(dev);
|
|
}
|
|
|
|
LIBEVDEV_EXPORT void
|
|
libevdev_set_log_function(libevdev_log_func_t logfunc, void *data)
|
|
{
|
|
log_data.global_handler = logfunc;
|
|
log_data.userdata = data;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT void
|
|
libevdev_set_log_priority(enum libevdev_log_priority priority)
|
|
{
|
|
if (priority > LIBEVDEV_LOG_DEBUG)
|
|
priority = LIBEVDEV_LOG_DEBUG;
|
|
log_data.priority = priority;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT enum libevdev_log_priority
|
|
libevdev_get_log_priority(void)
|
|
{
|
|
return log_data.priority;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT void
|
|
libevdev_set_device_log_function(struct libevdev *dev,
|
|
libevdev_device_log_func_t logfunc,
|
|
enum libevdev_log_priority priority,
|
|
void *data)
|
|
{
|
|
if (!dev) {
|
|
log_bug(NULL, "device must not be NULL\n");
|
|
return;
|
|
}
|
|
|
|
dev->log.priority = priority;
|
|
dev->log.device_handler = logfunc;
|
|
dev->log.userdata = data;
|
|
}
|
|
|
|
enum libevdev_log_priority
|
|
_libevdev_log_priority(const struct libevdev *dev)
|
|
{
|
|
if (dev && dev->log.device_handler)
|
|
return dev->log.priority;
|
|
else
|
|
return libevdev_get_log_priority();
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_change_fd(struct libevdev *dev, int fd)
|
|
{
|
|
if (!dev->initialized) {
|
|
log_bug(dev, "device not initialized. call libevdev_set_fd() first\n");
|
|
return -1;
|
|
}
|
|
dev->fd = fd;
|
|
return 0;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_set_fd(struct libevdev* dev, int fd)
|
|
{
|
|
int rc;
|
|
int i;
|
|
char buf[256];
|
|
|
|
if (dev->initialized) {
|
|
log_bug(dev, "device already initialized.\n");
|
|
return -EBADF;
|
|
} else if (fd < 0)
|
|
return -EBADF;
|
|
|
|
libevdev_reset(dev);
|
|
|
|
rc = ioctl(fd, EVIOCGBIT(0, sizeof(dev->bits)), dev->bits);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
memset(buf, 0, sizeof(buf));
|
|
rc = ioctl(fd, EVIOCGNAME(sizeof(buf) - 1), buf);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
free(dev->name);
|
|
dev->name = strdup(buf);
|
|
if (!dev->name) {
|
|
errno = ENOMEM;
|
|
goto out;
|
|
}
|
|
|
|
free(dev->phys);
|
|
dev->phys = NULL;
|
|
memset(buf, 0, sizeof(buf));
|
|
rc = ioctl(fd, EVIOCGPHYS(sizeof(buf) - 1), buf);
|
|
if (rc < 0) {
|
|
/* uinput has no phys */
|
|
if (errno != ENOENT)
|
|
goto out;
|
|
} else {
|
|
dev->phys = strdup(buf);
|
|
if (!dev->phys) {
|
|
errno = ENOMEM;
|
|
goto out;
|
|
}
|
|
}
|
|
|
|
free(dev->uniq);
|
|
dev->uniq = NULL;
|
|
memset(buf, 0, sizeof(buf));
|
|
rc = ioctl(fd, EVIOCGUNIQ(sizeof(buf) - 1), buf);
|
|
if (rc < 0) {
|
|
if (errno != ENOENT)
|
|
goto out;
|
|
} else {
|
|
dev->uniq = strdup(buf);
|
|
if (!dev->uniq) {
|
|
errno = ENOMEM;
|
|
goto out;
|
|
}
|
|
}
|
|
|
|
rc = ioctl(fd, EVIOCGID, &dev->ids);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
rc = ioctl(fd, EVIOCGVERSION, &dev->driver_version);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
/* Built on a kernel with props, running against a kernel without property
|
|
support. This should not be a fatal case, we'll be missing properties but other
|
|
than that everything is as expected.
|
|
*/
|
|
rc = ioctl(fd, EVIOCGPROP(sizeof(dev->props)), dev->props);
|
|
if (rc < 0 && errno != EINVAL)
|
|
goto out;
|
|
|
|
rc = ioctl(fd, EVIOCGBIT(EV_REL, sizeof(dev->rel_bits)), dev->rel_bits);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
rc = ioctl(fd, EVIOCGBIT(EV_ABS, sizeof(dev->abs_bits)), dev->abs_bits);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
rc = ioctl(fd, EVIOCGBIT(EV_LED, sizeof(dev->led_bits)), dev->led_bits);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
rc = ioctl(fd, EVIOCGBIT(EV_KEY, sizeof(dev->key_bits)), dev->key_bits);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
rc = ioctl(fd, EVIOCGBIT(EV_SW, sizeof(dev->sw_bits)), dev->sw_bits);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
rc = ioctl(fd, EVIOCGBIT(EV_MSC, sizeof(dev->msc_bits)), dev->msc_bits);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
rc = ioctl(fd, EVIOCGBIT(EV_FF, sizeof(dev->ff_bits)), dev->ff_bits);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
rc = ioctl(fd, EVIOCGBIT(EV_SND, sizeof(dev->snd_bits)), dev->snd_bits);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
rc = ioctl(fd, EVIOCGKEY(sizeof(dev->key_values)), dev->key_values);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
rc = ioctl(fd, EVIOCGLED(sizeof(dev->led_values)), dev->led_values);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
rc = ioctl(fd, EVIOCGSW(sizeof(dev->sw_values)), dev->sw_values);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
/* rep is a special case, always set it to 1 for both values if EV_REP is set */
|
|
if (bit_is_set(dev->bits, EV_REP)) {
|
|
for (i = 0; i < REP_CNT; i++)
|
|
set_bit(dev->rep_bits, i);
|
|
rc = ioctl(fd, EVIOCGREP, dev->rep_values);
|
|
if (rc < 0)
|
|
goto out;
|
|
}
|
|
|
|
for (i = ABS_X; i <= ABS_MAX; i++) {
|
|
if (bit_is_set(dev->abs_bits, i)) {
|
|
struct input_absinfo abs_info;
|
|
rc = ioctl(fd, EVIOCGABS(i), &abs_info);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
fix_invalid_absinfo(dev, i, &abs_info);
|
|
|
|
dev->abs_info[i] = abs_info;
|
|
}
|
|
}
|
|
|
|
dev->fd = fd;
|
|
|
|
/* devices with ABS_MT_SLOT - 1 aren't MT devices,
|
|
see the documentation for multitouch-related
|
|
functions for more details */
|
|
if (!libevdev_has_event_code(dev, EV_ABS, ABS_MT_SLOT - 1) &&
|
|
libevdev_has_event_code(dev, EV_ABS, ABS_MT_SLOT)) {
|
|
const struct input_absinfo *abs_info;
|
|
|
|
abs_info = libevdev_get_abs_info(dev, ABS_MT_SLOT);
|
|
|
|
dev->num_slots = abs_info->maximum + 1;
|
|
dev->mt_slot_vals = calloc(dev->num_slots * ABS_MT_CNT, sizeof(int));
|
|
if (!dev->mt_slot_vals) {
|
|
rc = -ENOMEM;
|
|
goto out;
|
|
}
|
|
dev->current_slot = abs_info->value;
|
|
|
|
dev->mt_sync.mt_state_sz = sizeof(*dev->mt_sync.mt_state) +
|
|
(dev->num_slots) * sizeof(int);
|
|
dev->mt_sync.mt_state = calloc(1, dev->mt_sync.mt_state_sz);
|
|
|
|
dev->mt_sync.tracking_id_changes_sz = NLONGS(dev->num_slots) * sizeof(long);
|
|
dev->mt_sync.tracking_id_changes = malloc(dev->mt_sync.tracking_id_changes_sz);
|
|
|
|
dev->mt_sync.slot_update_sz = NLONGS(dev->num_slots * ABS_MT_CNT) * sizeof(long);
|
|
dev->mt_sync.slot_update = malloc(dev->mt_sync.slot_update_sz);
|
|
|
|
if (!dev->mt_sync.tracking_id_changes ||
|
|
!dev->mt_sync.slot_update ||
|
|
!dev->mt_sync.mt_state) {
|
|
rc = -ENOMEM;
|
|
goto out;
|
|
}
|
|
|
|
sync_mt_state(dev, 0);
|
|
}
|
|
|
|
rc = init_event_queue(dev);
|
|
if (rc < 0) {
|
|
dev->fd = -1;
|
|
return -rc;
|
|
}
|
|
|
|
/* not copying key state because we won't know when we'll start to
|
|
* use this fd and key's are likely to change state by then.
|
|
* Same with the valuators, really, but they may not change.
|
|
*/
|
|
|
|
dev->initialized = true;
|
|
out:
|
|
if (rc)
|
|
libevdev_reset(dev);
|
|
return rc ? -errno : 0;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_get_fd(const struct libevdev* dev)
|
|
{
|
|
return dev->fd;
|
|
}
|
|
|
|
static inline void
|
|
init_event(struct libevdev *dev, struct input_event *ev, int type, int code, int value)
|
|
{
|
|
ev->time = dev->last_event_time;
|
|
ev->type = type;
|
|
ev->code = code;
|
|
ev->value = value;
|
|
}
|
|
|
|
static int
|
|
sync_key_state(struct libevdev *dev)
|
|
{
|
|
int rc;
|
|
int i;
|
|
unsigned long keystate[NLONGS(KEY_CNT)] = {0};
|
|
|
|
rc = ioctl(dev->fd, EVIOCGKEY(sizeof(keystate)), keystate);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
for (i = 0; i < KEY_CNT; i++) {
|
|
int old, new;
|
|
old = bit_is_set(dev->key_values, i);
|
|
new = bit_is_set(keystate, i);
|
|
if (old ^ new) {
|
|
struct input_event *ev = queue_push(dev);
|
|
init_event(dev, ev, EV_KEY, i, new ? 1 : 0);
|
|
}
|
|
}
|
|
|
|
memcpy(dev->key_values, keystate, rc);
|
|
|
|
rc = 0;
|
|
out:
|
|
return rc ? -errno : 0;
|
|
}
|
|
|
|
static int
|
|
sync_sw_state(struct libevdev *dev)
|
|
{
|
|
int rc;
|
|
int i;
|
|
unsigned long swstate[NLONGS(SW_CNT)] = {0};
|
|
|
|
rc = ioctl(dev->fd, EVIOCGSW(sizeof(swstate)), swstate);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
for (i = 0; i < SW_CNT; i++) {
|
|
int old, new;
|
|
old = bit_is_set(dev->sw_values, i);
|
|
new = bit_is_set(swstate, i);
|
|
if (old ^ new) {
|
|
struct input_event *ev = queue_push(dev);
|
|
init_event(dev, ev, EV_SW, i, new ? 1 : 0);
|
|
}
|
|
}
|
|
|
|
memcpy(dev->sw_values, swstate, rc);
|
|
|
|
rc = 0;
|
|
out:
|
|
return rc ? -errno : 0;
|
|
}
|
|
|
|
static int
|
|
sync_led_state(struct libevdev *dev)
|
|
{
|
|
int rc;
|
|
int i;
|
|
unsigned long ledstate[NLONGS(LED_CNT)] = {0};
|
|
|
|
rc = ioctl(dev->fd, EVIOCGLED(sizeof(ledstate)), ledstate);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
for (i = 0; i < LED_CNT; i++) {
|
|
int old, new;
|
|
old = bit_is_set(dev->led_values, i);
|
|
new = bit_is_set(ledstate, i);
|
|
if (old ^ new) {
|
|
struct input_event *ev = queue_push(dev);
|
|
init_event(dev, ev, EV_LED, i, new ? 1 : 0);
|
|
}
|
|
}
|
|
|
|
memcpy(dev->led_values, ledstate, rc);
|
|
|
|
rc = 0;
|
|
out:
|
|
return rc ? -errno : 0;
|
|
}
|
|
static int
|
|
sync_abs_state(struct libevdev *dev)
|
|
{
|
|
int rc;
|
|
int i;
|
|
|
|
for (i = ABS_X; i < ABS_CNT; i++) {
|
|
struct input_absinfo abs_info;
|
|
|
|
if (i >= ABS_MT_MIN && i <= ABS_MT_MAX)
|
|
continue;
|
|
|
|
if (!bit_is_set(dev->abs_bits, i))
|
|
continue;
|
|
|
|
rc = ioctl(dev->fd, EVIOCGABS(i), &abs_info);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
if (dev->abs_info[i].value != abs_info.value) {
|
|
struct input_event *ev = queue_push(dev);
|
|
|
|
init_event(dev, ev, EV_ABS, i, abs_info.value);
|
|
dev->abs_info[i].value = abs_info.value;
|
|
}
|
|
}
|
|
|
|
rc = 0;
|
|
out:
|
|
return rc ? -errno : 0;
|
|
}
|
|
|
|
static int
|
|
sync_mt_state(struct libevdev *dev, int create_events)
|
|
{
|
|
struct input_event *ev;
|
|
struct input_absinfo abs_info;
|
|
int rc;
|
|
int axis, slot;
|
|
int ioctl_success = 0;
|
|
int last_reported_slot = 0;
|
|
struct mt_sync_state *mt_state = dev->mt_sync.mt_state;
|
|
unsigned long *slot_update = dev->mt_sync.slot_update;
|
|
unsigned long *tracking_id_changes = dev->mt_sync.tracking_id_changes;
|
|
int need_tracking_id_changes = 0;
|
|
|
|
memset(dev->mt_sync.slot_update, 0, dev->mt_sync.slot_update_sz);
|
|
memset(dev->mt_sync.tracking_id_changes, 0,
|
|
dev->mt_sync.tracking_id_changes_sz);
|
|
|
|
#define AXISBIT(_slot, _axis) (_slot * ABS_MT_CNT + _axis - ABS_MT_MIN)
|
|
|
|
for (axis = ABS_MT_MIN; axis <= ABS_MT_MAX; axis++) {
|
|
if (axis == ABS_MT_SLOT)
|
|
continue;
|
|
|
|
if (!libevdev_has_event_code(dev, EV_ABS, axis))
|
|
continue;
|
|
|
|
mt_state->code = axis;
|
|
rc = ioctl(dev->fd, EVIOCGMTSLOTS(dev->mt_sync.mt_state_sz), mt_state);
|
|
if (rc < 0) {
|
|
/* if the first ioctl fails with -EINVAL, chances are the kernel
|
|
doesn't support the ioctl. Simply continue */
|
|
if (errno == -EINVAL && !ioctl_success) {
|
|
rc = 0;
|
|
} else /* if the second, ... ioctl fails, really fail */
|
|
goto out;
|
|
} else {
|
|
if (ioctl_success == 0)
|
|
ioctl_success = 1;
|
|
|
|
for (slot = 0; slot < dev->num_slots; slot++) {
|
|
|
|
if (*slot_value(dev, slot, axis) == mt_state->val[slot])
|
|
continue;
|
|
|
|
if (axis == ABS_MT_TRACKING_ID &&
|
|
*slot_value(dev, slot, axis) != -1 &&
|
|
mt_state->val[slot] != -1) {
|
|
set_bit(tracking_id_changes, slot);
|
|
need_tracking_id_changes = 1;
|
|
}
|
|
|
|
*slot_value(dev, slot, axis) = mt_state->val[slot];
|
|
|
|
set_bit(slot_update, AXISBIT(slot, axis));
|
|
/* note that this slot has updates */
|
|
set_bit(slot_update, AXISBIT(slot, ABS_MT_SLOT));
|
|
}
|
|
|
|
}
|
|
}
|
|
|
|
if (!create_events) {
|
|
rc = 0;
|
|
goto out;
|
|
}
|
|
|
|
if (need_tracking_id_changes) {
|
|
for (slot = 0; slot < dev->num_slots; slot++) {
|
|
if (!bit_is_set(tracking_id_changes, slot))
|
|
continue;
|
|
|
|
ev = queue_push(dev);
|
|
init_event(dev, ev, EV_ABS, ABS_MT_SLOT, slot);
|
|
ev = queue_push(dev);
|
|
init_event(dev, ev, EV_ABS, ABS_MT_TRACKING_ID, -1);
|
|
|
|
last_reported_slot = slot;
|
|
}
|
|
|
|
ev = queue_push(dev);
|
|
init_event(dev, ev, EV_SYN, SYN_REPORT, 0);
|
|
}
|
|
|
|
for (slot = 0; slot < dev->num_slots; slot++) {
|
|
if (!bit_is_set(slot_update, AXISBIT(slot, ABS_MT_SLOT)))
|
|
continue;
|
|
|
|
ev = queue_push(dev);
|
|
init_event(dev, ev, EV_ABS, ABS_MT_SLOT, slot);
|
|
last_reported_slot = slot;
|
|
|
|
for (axis = ABS_MT_MIN; axis <= ABS_MT_MAX; axis++) {
|
|
if (axis == ABS_MT_SLOT ||
|
|
!libevdev_has_event_code(dev, EV_ABS, axis))
|
|
continue;
|
|
|
|
if (bit_is_set(slot_update, AXISBIT(slot, axis))) {
|
|
ev = queue_push(dev);
|
|
init_event(dev, ev, EV_ABS, axis, *slot_value(dev, slot, axis));
|
|
}
|
|
}
|
|
}
|
|
|
|
/* add one last slot event to make sure the client is on the same
|
|
slot as the kernel */
|
|
|
|
rc = ioctl(dev->fd, EVIOCGABS(ABS_MT_SLOT), &abs_info);
|
|
if (rc < 0)
|
|
goto out;
|
|
|
|
dev->current_slot = abs_info.value;
|
|
|
|
if (dev->current_slot != last_reported_slot) {
|
|
ev = queue_push(dev);
|
|
init_event(dev, ev, EV_ABS, ABS_MT_SLOT, dev->current_slot);
|
|
}
|
|
|
|
#undef AXISBIT
|
|
|
|
rc = 0;
|
|
out:
|
|
return rc ? -errno : 0;
|
|
}
|
|
|
|
static int
|
|
read_more_events(struct libevdev *dev)
|
|
{
|
|
int free_elem;
|
|
int len;
|
|
struct input_event *next;
|
|
|
|
free_elem = queue_num_free_elements(dev);
|
|
if (free_elem <= 0)
|
|
return 0;
|
|
|
|
next = queue_next_element(dev);
|
|
len = read(dev->fd, next, free_elem * sizeof(struct input_event));
|
|
if (len < 0) {
|
|
return -errno;
|
|
} else if (len > 0 && len % sizeof(struct input_event) != 0)
|
|
return -EINVAL;
|
|
else if (len > 0) {
|
|
int nev = len/sizeof(struct input_event);
|
|
queue_set_num_elements(dev, queue_num_elements(dev) + nev);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static inline void
|
|
drain_events(struct libevdev *dev)
|
|
{
|
|
int rc;
|
|
size_t nelem;
|
|
int iterations = 0;
|
|
const int max_iterations = 8; /* EVDEV_BUF_PACKETS in
|
|
kernel/drivers/input/evedev.c */
|
|
|
|
queue_shift_multiple(dev, queue_num_elements(dev), NULL);
|
|
|
|
do {
|
|
rc = read_more_events(dev);
|
|
if (rc == -EAGAIN)
|
|
return;
|
|
|
|
if (rc < 0) {
|
|
log_error(dev, "Failed to drain events before sync.\n");
|
|
return;
|
|
}
|
|
|
|
nelem = queue_num_elements(dev);
|
|
queue_shift_multiple(dev, nelem, NULL);
|
|
} while (iterations++ < max_iterations && nelem >= queue_size(dev));
|
|
|
|
/* Our buffer should be roughly the same or bigger than the kernel
|
|
buffer in most cases, so we usually don't expect to recurse. If
|
|
we do, make sure we stop after max_iterations and proceed with
|
|
what we have. This could happen if events queue up faster than
|
|
we can drain them.
|
|
*/
|
|
if (iterations >= max_iterations)
|
|
log_info(dev, "Unable to drain events, buffer size mismatch.\n");
|
|
}
|
|
|
|
static int
|
|
sync_state(struct libevdev *dev)
|
|
{
|
|
int rc = 0;
|
|
struct input_event *ev;
|
|
|
|
/* see section "Discarding events before synchronizing" in
|
|
* libevdev/libevdev.h */
|
|
drain_events(dev);
|
|
|
|
if (libevdev_has_event_type(dev, EV_KEY))
|
|
rc = sync_key_state(dev);
|
|
if (libevdev_has_event_type(dev, EV_LED))
|
|
rc = sync_led_state(dev);
|
|
if (libevdev_has_event_type(dev, EV_SW))
|
|
rc = sync_sw_state(dev);
|
|
if (rc == 0 && libevdev_has_event_type(dev, EV_ABS))
|
|
rc = sync_abs_state(dev);
|
|
if (rc == 0 && dev->num_slots > -1 &&
|
|
libevdev_has_event_code(dev, EV_ABS, ABS_MT_SLOT))
|
|
rc = sync_mt_state(dev, 1);
|
|
|
|
dev->queue_nsync = queue_num_elements(dev);
|
|
|
|
if (dev->queue_nsync > 0) {
|
|
ev = queue_push(dev);
|
|
init_event(dev, ev, EV_SYN, SYN_REPORT, 0);
|
|
dev->queue_nsync++;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
static int
|
|
update_key_state(struct libevdev *dev, const struct input_event *e)
|
|
{
|
|
if (!libevdev_has_event_type(dev, EV_KEY))
|
|
return 1;
|
|
|
|
if (e->code > KEY_MAX)
|
|
return 1;
|
|
|
|
set_bit_state(dev->key_values, e->code, e->value != 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
update_mt_state(struct libevdev *dev, const struct input_event *e)
|
|
{
|
|
if (e->code == ABS_MT_SLOT && dev->num_slots > -1) {
|
|
int i;
|
|
dev->current_slot = e->value;
|
|
/* sync abs_info with the current slot values */
|
|
for (i = ABS_MT_SLOT + 1; i <= ABS_MT_MAX; i++) {
|
|
if (libevdev_has_event_code(dev, EV_ABS, i))
|
|
dev->abs_info[i].value = *slot_value(dev, dev->current_slot, i);
|
|
}
|
|
|
|
return 0;
|
|
} else if (dev->current_slot == -1)
|
|
return 1;
|
|
|
|
*slot_value(dev, dev->current_slot, e->code) = e->value;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
update_abs_state(struct libevdev *dev, const struct input_event *e)
|
|
{
|
|
if (!libevdev_has_event_type(dev, EV_ABS))
|
|
return 1;
|
|
|
|
if (e->code > ABS_MAX)
|
|
return 1;
|
|
|
|
if (e->code >= ABS_MT_MIN && e->code <= ABS_MT_MAX)
|
|
update_mt_state(dev, e);
|
|
|
|
dev->abs_info[e->code].value = e->value;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
update_led_state(struct libevdev *dev, const struct input_event *e)
|
|
{
|
|
if (!libevdev_has_event_type(dev, EV_LED))
|
|
return 1;
|
|
|
|
if (e->code > LED_MAX)
|
|
return 1;
|
|
|
|
set_bit_state(dev->led_values, e->code, e->value != 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
update_sw_state(struct libevdev *dev, const struct input_event *e)
|
|
{
|
|
if (!libevdev_has_event_type(dev, EV_SW))
|
|
return 1;
|
|
|
|
if (e->code > SW_MAX)
|
|
return 1;
|
|
|
|
set_bit_state(dev->sw_values, e->code, e->value != 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
update_state(struct libevdev *dev, const struct input_event *e)
|
|
{
|
|
int rc = 0;
|
|
|
|
switch(e->type) {
|
|
case EV_SYN:
|
|
case EV_REL:
|
|
break;
|
|
case EV_KEY:
|
|
rc = update_key_state(dev, e);
|
|
break;
|
|
case EV_ABS:
|
|
rc = update_abs_state(dev, e);
|
|
break;
|
|
case EV_LED:
|
|
rc = update_led_state(dev, e);
|
|
break;
|
|
case EV_SW:
|
|
rc = update_sw_state(dev, e);
|
|
break;
|
|
}
|
|
|
|
dev->last_event_time = e->time;
|
|
|
|
return rc;
|
|
}
|
|
|
|
/**
|
|
* Sanitize/modify events where needed.
|
|
*/
|
|
static inline enum event_filter_status
|
|
sanitize_event(const struct libevdev *dev,
|
|
struct input_event *ev,
|
|
enum SyncState sync_state)
|
|
{
|
|
if (!libevdev_has_event_code(dev, ev->type, ev->code))
|
|
return EVENT_FILTER_DISCARD;
|
|
|
|
if (unlikely(dev->num_slots > -1 &&
|
|
libevdev_event_is_code(ev, EV_ABS, ABS_MT_SLOT) &&
|
|
(ev->value < 0 || ev->value >= dev->num_slots))) {
|
|
log_bug(dev, "Device \"%s\" received an invalid slot index %d."
|
|
"Capping to announced max slot number %d.\n",
|
|
dev->name, ev->value, dev->num_slots - 1);
|
|
ev->value = dev->num_slots - 1;
|
|
return EVENT_FILTER_MODIFIED;
|
|
|
|
/* Drop any invalid tracking IDs, they are only supposed to go from
|
|
N to -1 or from -1 to N. Never from -1 to -1, or N to M. Very
|
|
unlikely to ever happen from a real device.
|
|
*/
|
|
} else if (unlikely(sync_state == SYNC_NONE &&
|
|
dev->num_slots > -1 &&
|
|
libevdev_event_is_code(ev, EV_ABS, ABS_MT_TRACKING_ID) &&
|
|
((ev->value == -1 &&
|
|
*slot_value(dev, dev->current_slot, ABS_MT_TRACKING_ID) == -1) ||
|
|
(ev->value != -1 &&
|
|
*slot_value(dev, dev->current_slot, ABS_MT_TRACKING_ID) != -1)))) {
|
|
log_bug(dev, "Device \"%s\" received a double tracking ID %d in slot %d.\n",
|
|
dev->name, ev->value, dev->current_slot);
|
|
return EVENT_FILTER_DISCARD;
|
|
}
|
|
|
|
return EVENT_FILTER_NONE;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_next_event(struct libevdev *dev, unsigned int flags, struct input_event *ev)
|
|
{
|
|
int rc = LIBEVDEV_READ_STATUS_SUCCESS;
|
|
enum event_filter_status filter_status;
|
|
const unsigned int valid_flags = LIBEVDEV_READ_FLAG_NORMAL |
|
|
LIBEVDEV_READ_FLAG_SYNC |
|
|
LIBEVDEV_READ_FLAG_FORCE_SYNC |
|
|
LIBEVDEV_READ_FLAG_BLOCKING;
|
|
|
|
if (!dev->initialized) {
|
|
log_bug(dev, "device not initialized. call libevdev_set_fd() first\n");
|
|
return -EBADF;
|
|
} else if (dev->fd < 0)
|
|
return -EBADF;
|
|
|
|
if ((flags & valid_flags) == 0) {
|
|
log_bug(dev, "invalid flags %#x.\n", flags);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (flags & LIBEVDEV_READ_FLAG_SYNC) {
|
|
if (dev->sync_state == SYNC_NEEDED) {
|
|
rc = sync_state(dev);
|
|
if (rc != 0)
|
|
return rc;
|
|
dev->sync_state = SYNC_IN_PROGRESS;
|
|
}
|
|
|
|
if (dev->queue_nsync == 0) {
|
|
dev->sync_state = SYNC_NONE;
|
|
return -EAGAIN;
|
|
}
|
|
|
|
} else if (dev->sync_state != SYNC_NONE) {
|
|
struct input_event e;
|
|
|
|
/* call update_state for all events here, otherwise the library has the wrong view
|
|
of the device too */
|
|
while (queue_shift(dev, &e) == 0) {
|
|
dev->queue_nsync--;
|
|
if (sanitize_event(dev, &e, dev->sync_state) != EVENT_FILTER_DISCARD)
|
|
update_state(dev, &e);
|
|
}
|
|
|
|
dev->sync_state = SYNC_NONE;
|
|
}
|
|
|
|
/* Always read in some more events. Best case this smoothes over a potential SYN_DROPPED,
|
|
worst case we don't read fast enough and end up with SYN_DROPPED anyway.
|
|
|
|
Except if the fd is in blocking mode and we still have events from the last read, don't
|
|
read in any more.
|
|
*/
|
|
do {
|
|
if (!(flags & LIBEVDEV_READ_FLAG_BLOCKING) ||
|
|
queue_num_elements(dev) == 0) {
|
|
rc = read_more_events(dev);
|
|
if (rc < 0 && rc != -EAGAIN)
|
|
goto out;
|
|
}
|
|
|
|
if (flags & LIBEVDEV_READ_FLAG_FORCE_SYNC) {
|
|
dev->sync_state = SYNC_NEEDED;
|
|
rc = LIBEVDEV_READ_STATUS_SYNC;
|
|
goto out;
|
|
}
|
|
|
|
if (queue_shift(dev, ev) != 0)
|
|
return -EAGAIN;
|
|
|
|
filter_status = sanitize_event(dev, ev, dev->sync_state);
|
|
if (filter_status != EVENT_FILTER_DISCARD)
|
|
update_state(dev, ev);
|
|
|
|
/* if we disabled a code, get the next event instead */
|
|
} while(filter_status == EVENT_FILTER_DISCARD ||
|
|
!libevdev_has_event_code(dev, ev->type, ev->code));
|
|
|
|
rc = LIBEVDEV_READ_STATUS_SUCCESS;
|
|
if (ev->type == EV_SYN && ev->code == SYN_DROPPED) {
|
|
dev->sync_state = SYNC_NEEDED;
|
|
rc = LIBEVDEV_READ_STATUS_SYNC;
|
|
}
|
|
|
|
if (flags & LIBEVDEV_READ_FLAG_SYNC && dev->queue_nsync > 0) {
|
|
dev->queue_nsync--;
|
|
rc = LIBEVDEV_READ_STATUS_SYNC;
|
|
if (dev->queue_nsync == 0) {
|
|
struct input_event next;
|
|
dev->sync_state = SYNC_NONE;
|
|
|
|
if (queue_peek(dev, 0, &next) == 0 &&
|
|
next.type == EV_SYN && next.code == SYN_DROPPED)
|
|
log_info(dev, "SYN_DROPPED received after finished "
|
|
"sync - you're not keeping up\n");
|
|
}
|
|
}
|
|
|
|
out:
|
|
return rc;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_has_event_pending(struct libevdev *dev)
|
|
{
|
|
struct pollfd fds = { dev->fd, POLLIN, 0 };
|
|
int rc;
|
|
|
|
if (!dev->initialized) {
|
|
log_bug(dev, "device not initialized. call libevdev_set_fd() first\n");
|
|
return -EBADF;
|
|
} else if (dev->fd < 0)
|
|
return -EBADF;
|
|
|
|
if (queue_num_elements(dev) != 0)
|
|
return 1;
|
|
|
|
rc = poll(&fds, 1, 0);
|
|
return (rc >= 0) ? rc : -errno;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT const char *
|
|
libevdev_get_name(const struct libevdev *dev)
|
|
{
|
|
return dev->name ? dev->name : "";
|
|
}
|
|
|
|
LIBEVDEV_EXPORT const char *
|
|
libevdev_get_phys(const struct libevdev *dev)
|
|
{
|
|
return dev->phys;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT const char *
|
|
libevdev_get_uniq(const struct libevdev *dev)
|
|
{
|
|
return dev->uniq;
|
|
}
|
|
|
|
#define STRING_SETTER(field) \
|
|
LIBEVDEV_EXPORT void libevdev_set_##field(struct libevdev *dev, const char *field) \
|
|
{ \
|
|
if (field == NULL) \
|
|
return; \
|
|
free(dev->field); \
|
|
dev->field = strdup(field); \
|
|
}
|
|
|
|
STRING_SETTER(name)
|
|
STRING_SETTER(phys)
|
|
STRING_SETTER(uniq)
|
|
|
|
#define PRODUCT_GETTER(name) \
|
|
LIBEVDEV_EXPORT int libevdev_get_id_##name(const struct libevdev *dev) \
|
|
{ \
|
|
return dev->ids.name; \
|
|
}
|
|
|
|
PRODUCT_GETTER(product)
|
|
PRODUCT_GETTER(vendor)
|
|
PRODUCT_GETTER(bustype)
|
|
PRODUCT_GETTER(version)
|
|
|
|
#define PRODUCT_SETTER(field) \
|
|
LIBEVDEV_EXPORT void libevdev_set_id_##field(struct libevdev *dev, int field) \
|
|
{ \
|
|
dev->ids.field = field;\
|
|
}
|
|
|
|
PRODUCT_SETTER(product)
|
|
PRODUCT_SETTER(vendor)
|
|
PRODUCT_SETTER(bustype)
|
|
PRODUCT_SETTER(version)
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_get_driver_version(const struct libevdev *dev)
|
|
{
|
|
return dev->driver_version;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_has_property(const struct libevdev *dev, unsigned int prop)
|
|
{
|
|
return (prop <= INPUT_PROP_MAX) && bit_is_set(dev->props, prop);
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_enable_property(struct libevdev *dev, unsigned int prop)
|
|
{
|
|
if (prop > INPUT_PROP_MAX)
|
|
return -1;
|
|
|
|
set_bit(dev->props, prop);
|
|
return 0;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_has_event_type(const struct libevdev *dev, unsigned int type)
|
|
{
|
|
return type == EV_SYN ||(type <= EV_MAX && bit_is_set(dev->bits, type));
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_has_event_code(const struct libevdev *dev, unsigned int type, unsigned int code)
|
|
{
|
|
const unsigned long *mask = NULL;
|
|
int max;
|
|
|
|
if (!libevdev_has_event_type(dev, type))
|
|
return 0;
|
|
|
|
if (type == EV_SYN)
|
|
return 1;
|
|
|
|
max = type_to_mask_const(dev, type, &mask);
|
|
|
|
if (max == -1 || code > (unsigned int)max)
|
|
return 0;
|
|
|
|
return bit_is_set(mask, code);
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_get_event_value(const struct libevdev *dev, unsigned int type, unsigned int code)
|
|
{
|
|
int value = 0;
|
|
|
|
if (!libevdev_has_event_type(dev, type) || !libevdev_has_event_code(dev, type, code))
|
|
return 0;
|
|
|
|
switch (type) {
|
|
case EV_ABS: value = dev->abs_info[code].value; break;
|
|
case EV_KEY: value = bit_is_set(dev->key_values, code); break;
|
|
case EV_LED: value = bit_is_set(dev->led_values, code); break;
|
|
case EV_SW: value = bit_is_set(dev->sw_values, code); break;
|
|
case EV_REP:
|
|
switch(code) {
|
|
case REP_DELAY:
|
|
libevdev_get_repeat(dev, &value, NULL);
|
|
break;
|
|
case REP_PERIOD:
|
|
libevdev_get_repeat(dev, NULL, &value);
|
|
break;
|
|
default:
|
|
value = 0;
|
|
break;
|
|
}
|
|
break;
|
|
default:
|
|
value = 0;
|
|
break;
|
|
}
|
|
|
|
return value;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_set_event_value(struct libevdev *dev, unsigned int type, unsigned int code, int value)
|
|
{
|
|
int rc = 0;
|
|
struct input_event e;
|
|
|
|
if (!libevdev_has_event_type(dev, type) || !libevdev_has_event_code(dev, type, code))
|
|
return -1;
|
|
|
|
e.type = type;
|
|
e.code = code;
|
|
e.value = value;
|
|
|
|
if (sanitize_event(dev, &e, SYNC_NONE) != EVENT_FILTER_NONE)
|
|
return -1;
|
|
|
|
switch(type) {
|
|
case EV_ABS: rc = update_abs_state(dev, &e); break;
|
|
case EV_KEY: rc = update_key_state(dev, &e); break;
|
|
case EV_LED: rc = update_led_state(dev, &e); break;
|
|
case EV_SW: rc = update_sw_state(dev, &e); break;
|
|
default:
|
|
rc = -1;
|
|
break;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_fetch_event_value(const struct libevdev *dev, unsigned int type, unsigned int code, int *value)
|
|
{
|
|
if (libevdev_has_event_type(dev, type) &&
|
|
libevdev_has_event_code(dev, type, code)) {
|
|
*value = libevdev_get_event_value(dev, type, code);
|
|
return 1;
|
|
} else
|
|
return 0;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_get_slot_value(const struct libevdev *dev, unsigned int slot, unsigned int code)
|
|
{
|
|
if (!libevdev_has_event_type(dev, EV_ABS) || !libevdev_has_event_code(dev, EV_ABS, code))
|
|
return 0;
|
|
|
|
if (dev->num_slots < 0 || slot >= (unsigned int)dev->num_slots)
|
|
return 0;
|
|
|
|
if (code > ABS_MT_MAX || code < ABS_MT_MIN)
|
|
return 0;
|
|
|
|
return *slot_value(dev, slot, code);
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_set_slot_value(struct libevdev *dev, unsigned int slot, unsigned int code, int value)
|
|
{
|
|
if (!libevdev_has_event_type(dev, EV_ABS) || !libevdev_has_event_code(dev, EV_ABS, code))
|
|
return -1;
|
|
|
|
if (dev->num_slots == -1 || slot >= (unsigned int)dev->num_slots)
|
|
return -1;
|
|
|
|
if (code > ABS_MT_MAX || code < ABS_MT_MIN)
|
|
return -1;
|
|
|
|
if (code == ABS_MT_SLOT) {
|
|
if (value < 0 || value >= libevdev_get_num_slots(dev))
|
|
return -1;
|
|
dev->current_slot = value;
|
|
}
|
|
|
|
*slot_value(dev, slot, code) = value;
|
|
|
|
return 0;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_fetch_slot_value(const struct libevdev *dev, unsigned int slot, unsigned int code, int *value)
|
|
{
|
|
if (libevdev_has_event_type(dev, EV_ABS) &&
|
|
libevdev_has_event_code(dev, EV_ABS, code) &&
|
|
dev->num_slots >= 0 &&
|
|
slot < (unsigned int)dev->num_slots) {
|
|
*value = libevdev_get_slot_value(dev, slot, code);
|
|
return 1;
|
|
} else
|
|
return 0;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_get_num_slots(const struct libevdev *dev)
|
|
{
|
|
return dev->num_slots;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_get_current_slot(const struct libevdev *dev)
|
|
{
|
|
return dev->current_slot;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT const struct input_absinfo*
|
|
libevdev_get_abs_info(const struct libevdev *dev, unsigned int code)
|
|
{
|
|
if (!libevdev_has_event_type(dev, EV_ABS) ||
|
|
!libevdev_has_event_code(dev, EV_ABS, code))
|
|
return NULL;
|
|
|
|
return &dev->abs_info[code];
|
|
}
|
|
|
|
#define ABS_GETTER(name) \
|
|
LIBEVDEV_EXPORT int libevdev_get_abs_##name(const struct libevdev *dev, unsigned int code) \
|
|
{ \
|
|
const struct input_absinfo *absinfo = libevdev_get_abs_info(dev, code); \
|
|
return absinfo ? absinfo->name : 0; \
|
|
}
|
|
|
|
ABS_GETTER(maximum)
|
|
ABS_GETTER(minimum)
|
|
ABS_GETTER(fuzz)
|
|
ABS_GETTER(flat)
|
|
ABS_GETTER(resolution)
|
|
|
|
#define ABS_SETTER(field) \
|
|
LIBEVDEV_EXPORT void libevdev_set_abs_##field(struct libevdev *dev, unsigned int code, int val) \
|
|
{ \
|
|
if (!libevdev_has_event_code(dev, EV_ABS, code)) \
|
|
return; \
|
|
dev->abs_info[code].field = val; \
|
|
}
|
|
|
|
ABS_SETTER(maximum)
|
|
ABS_SETTER(minimum)
|
|
ABS_SETTER(fuzz)
|
|
ABS_SETTER(flat)
|
|
ABS_SETTER(resolution)
|
|
|
|
LIBEVDEV_EXPORT void
|
|
libevdev_set_abs_info(struct libevdev *dev, unsigned int code, const struct input_absinfo *abs)
|
|
{
|
|
if (!libevdev_has_event_code(dev, EV_ABS, code))
|
|
return;
|
|
|
|
dev->abs_info[code] = *abs;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_enable_event_type(struct libevdev *dev, unsigned int type)
|
|
{
|
|
int max;
|
|
|
|
if (type > EV_MAX)
|
|
return -1;
|
|
|
|
if (libevdev_has_event_type(dev, type))
|
|
return 0;
|
|
|
|
max = libevdev_event_type_get_max(type);
|
|
if (max == -1)
|
|
return -1;
|
|
|
|
set_bit(dev->bits, type);
|
|
|
|
if (type == EV_REP) {
|
|
int delay = 0, period = 0;
|
|
libevdev_enable_event_code(dev, EV_REP, REP_DELAY, &delay);
|
|
libevdev_enable_event_code(dev, EV_REP, REP_PERIOD, &period);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_disable_event_type(struct libevdev *dev, unsigned int type)
|
|
{
|
|
int max;
|
|
|
|
if (type > EV_MAX || type == EV_SYN)
|
|
return -1;
|
|
|
|
max = libevdev_event_type_get_max(type);
|
|
if (max == -1)
|
|
return -1;
|
|
|
|
clear_bit(dev->bits, type);
|
|
|
|
return 0;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_enable_event_code(struct libevdev *dev, unsigned int type,
|
|
unsigned int code, const void *data)
|
|
{
|
|
unsigned int max;
|
|
unsigned long *mask = NULL;
|
|
|
|
if (libevdev_enable_event_type(dev, type))
|
|
return -1;
|
|
|
|
switch(type) {
|
|
case EV_SYN:
|
|
return 0;
|
|
case EV_ABS:
|
|
case EV_REP:
|
|
if (data == NULL)
|
|
return -1;
|
|
break;
|
|
default:
|
|
if (data != NULL)
|
|
return -1;
|
|
break;
|
|
}
|
|
|
|
max = type_to_mask(dev, type, &mask);
|
|
|
|
if (code > max || (int)max == -1)
|
|
return -1;
|
|
|
|
set_bit(mask, code);
|
|
|
|
if (type == EV_ABS) {
|
|
const struct input_absinfo *abs = data;
|
|
dev->abs_info[code] = *abs;
|
|
} else if (type == EV_REP) {
|
|
const int *value = data;
|
|
dev->rep_values[code] = *value;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_disable_event_code(struct libevdev *dev, unsigned int type, unsigned int code)
|
|
{
|
|
unsigned int max;
|
|
unsigned long *mask = NULL;
|
|
|
|
if (type > EV_MAX || type == EV_SYN)
|
|
return -1;
|
|
|
|
max = type_to_mask(dev, type, &mask);
|
|
|
|
if (code > max || (int)max == -1)
|
|
return -1;
|
|
|
|
clear_bit(mask, code);
|
|
|
|
return 0;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_kernel_set_abs_info(struct libevdev *dev, unsigned int code, const struct input_absinfo *abs)
|
|
{
|
|
int rc;
|
|
|
|
if (!dev->initialized) {
|
|
log_bug(dev, "device not initialized. call libevdev_set_fd() first\n");
|
|
return -EBADF;
|
|
} else if (dev->fd < 0)
|
|
return -EBADF;
|
|
|
|
if (code > ABS_MAX)
|
|
return -EINVAL;
|
|
|
|
rc = ioctl(dev->fd, EVIOCSABS(code), abs);
|
|
if (rc < 0)
|
|
rc = -errno;
|
|
else
|
|
rc = libevdev_enable_event_code(dev, EV_ABS, code, abs);
|
|
|
|
return rc;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_grab(struct libevdev *dev, enum libevdev_grab_mode grab)
|
|
{
|
|
int rc = 0;
|
|
|
|
if (!dev->initialized) {
|
|
log_bug(dev, "device not initialized. call libevdev_set_fd() first\n");
|
|
return -EBADF;
|
|
} else if (dev->fd < 0)
|
|
return -EBADF;
|
|
|
|
if (grab != LIBEVDEV_GRAB && grab != LIBEVDEV_UNGRAB) {
|
|
log_bug(dev, "invalid grab parameter %#x\n", grab);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (grab == dev->grabbed)
|
|
return 0;
|
|
|
|
if (grab == LIBEVDEV_GRAB)
|
|
rc = ioctl(dev->fd, EVIOCGRAB, (void *)1);
|
|
else if (grab == LIBEVDEV_UNGRAB)
|
|
rc = ioctl(dev->fd, EVIOCGRAB, (void *)0);
|
|
|
|
if (rc == 0)
|
|
dev->grabbed = grab;
|
|
|
|
return rc < 0 ? -errno : 0;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_event_is_type(const struct input_event *ev, unsigned int type)
|
|
{
|
|
return type < EV_CNT && ev->type == type;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_event_is_code(const struct input_event *ev, unsigned int type, unsigned int code)
|
|
{
|
|
int max;
|
|
|
|
if (!libevdev_event_is_type(ev, type))
|
|
return 0;
|
|
|
|
max = libevdev_event_type_get_max(type);
|
|
return (max > -1 && code <= (unsigned int)max && ev->code == code);
|
|
}
|
|
|
|
LIBEVDEV_EXPORT const char*
|
|
libevdev_event_type_get_name(unsigned int type)
|
|
{
|
|
if (type > EV_MAX)
|
|
return NULL;
|
|
return ev_map[type];
|
|
}
|
|
|
|
LIBEVDEV_EXPORT const char*
|
|
libevdev_event_code_get_name(unsigned int type, unsigned int code)
|
|
{
|
|
int max = libevdev_event_type_get_max(type);
|
|
|
|
if (max == -1 || code > (unsigned int)max)
|
|
return NULL;
|
|
|
|
return event_type_map[type][code];
|
|
}
|
|
|
|
LIBEVDEV_EXPORT const char*
|
|
libevdev_property_get_name(unsigned int prop)
|
|
{
|
|
if (prop > INPUT_PROP_MAX)
|
|
return NULL;
|
|
|
|
return input_prop_map[prop];
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_event_type_get_max(unsigned int type)
|
|
{
|
|
if (type > EV_MAX)
|
|
return -1;
|
|
|
|
return ev_max[type];
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_get_repeat(const struct libevdev *dev, int *delay, int *period)
|
|
{
|
|
if (!libevdev_has_event_type(dev, EV_REP))
|
|
return -1;
|
|
|
|
if (delay != NULL)
|
|
*delay = dev->rep_values[REP_DELAY];
|
|
if (period != NULL)
|
|
*period = dev->rep_values[REP_PERIOD];
|
|
|
|
return 0;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_kernel_set_led_value(struct libevdev *dev, unsigned int code, enum libevdev_led_value value)
|
|
{
|
|
return libevdev_kernel_set_led_values(dev, code, value, -1);
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_kernel_set_led_values(struct libevdev *dev, ...)
|
|
{
|
|
struct input_event ev[LED_MAX + 1];
|
|
enum libevdev_led_value val;
|
|
va_list args;
|
|
int code;
|
|
int rc = 0;
|
|
size_t nleds = 0;
|
|
|
|
if (!dev->initialized) {
|
|
log_bug(dev, "device not initialized. call libevdev_set_fd() first\n");
|
|
return -EBADF;
|
|
} else if (dev->fd < 0)
|
|
return -EBADF;
|
|
|
|
memset(ev, 0, sizeof(ev));
|
|
|
|
va_start(args, dev);
|
|
code = va_arg(args, unsigned int);
|
|
while (code != -1) {
|
|
if (code > LED_MAX) {
|
|
rc = -EINVAL;
|
|
break;
|
|
}
|
|
val = va_arg(args, enum libevdev_led_value);
|
|
if (val != LIBEVDEV_LED_ON && val != LIBEVDEV_LED_OFF) {
|
|
rc = -EINVAL;
|
|
break;
|
|
}
|
|
|
|
if (libevdev_has_event_code(dev, EV_LED, code)) {
|
|
struct input_event *e = ev;
|
|
|
|
while (e->type > 0 && e->code != code)
|
|
e++;
|
|
|
|
if (e->type == 0)
|
|
nleds++;
|
|
e->type = EV_LED;
|
|
e->code = code;
|
|
e->value = (val == LIBEVDEV_LED_ON);
|
|
}
|
|
code = va_arg(args, unsigned int);
|
|
}
|
|
va_end(args);
|
|
|
|
if (rc == 0 && nleds > 0) {
|
|
ev[nleds].type = EV_SYN;
|
|
ev[nleds++].code = SYN_REPORT;
|
|
|
|
rc = write(libevdev_get_fd(dev), ev, nleds * sizeof(ev[0]));
|
|
if (rc > 0) {
|
|
nleds--; /* last is EV_SYN */
|
|
while (nleds--)
|
|
update_led_state(dev, &ev[nleds]);
|
|
}
|
|
rc = (rc != -1) ? 0 : -errno;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
LIBEVDEV_EXPORT int
|
|
libevdev_set_clock_id(struct libevdev *dev, int clockid)
|
|
{
|
|
if (!dev->initialized) {
|
|
log_bug(dev, "device not initialized. call libevdev_set_fd() first\n");
|
|
return -EBADF;
|
|
} else if (dev->fd < 0)
|
|
return -EBADF;
|
|
|
|
return ioctl(dev->fd, EVIOCSCLOCKID, &clockid) ? -errno : 0;
|
|
}
|