363 lines
15 KiB
C
363 lines
15 KiB
C
/* SPDX-License-Identifier: GPL-2.0+ */
|
|
/*
|
|
* expose input properties via udev
|
|
*
|
|
* Portions Copyright © 2004 David Zeuthen, <david@fubar.dk>
|
|
* Copyright © 2014 Carlos Garnacho <carlosg@gnome.org>
|
|
*/
|
|
|
|
#include <errno.h>
|
|
#include <fcntl.h>
|
|
#include <stdarg.h>
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <linux/limits.h>
|
|
|
|
#include "device-util.h"
|
|
#include "fd-util.h"
|
|
#include "missing_input.h"
|
|
#include "stdio-util.h"
|
|
#include "string-util.h"
|
|
#include "udev-builtin.h"
|
|
#include "util.h"
|
|
|
|
/* we must use this kernel-compatible implementation */
|
|
#define BITS_PER_LONG (sizeof(unsigned long) * 8)
|
|
#define NBITS(x) ((((x)-1)/BITS_PER_LONG)+1)
|
|
#define OFF(x) ((x)%BITS_PER_LONG)
|
|
#define BIT(x) (1UL<<OFF(x))
|
|
#define LONG(x) ((x)/BITS_PER_LONG)
|
|
#define test_bit(bit, array) ((array[LONG(bit)] >> OFF(bit)) & 1)
|
|
|
|
struct range {
|
|
unsigned start;
|
|
unsigned end;
|
|
};
|
|
|
|
/* key code ranges above BTN_MISC (start is inclusive, stop is exclusive)*/
|
|
static const struct range high_key_blocks[] = {
|
|
{ KEY_OK, BTN_DPAD_UP },
|
|
{ KEY_ALS_TOGGLE, BTN_TRIGGER_HAPPY }
|
|
};
|
|
|
|
static int abs_size_mm(const struct input_absinfo *absinfo) {
|
|
/* Resolution is defined to be in units/mm for ABS_X/Y */
|
|
return (absinfo->maximum - absinfo->minimum) / absinfo->resolution;
|
|
}
|
|
|
|
static void extract_info(sd_device *dev, const char *devpath, bool test) {
|
|
char width[DECIMAL_STR_MAX(int)], height[DECIMAL_STR_MAX(int)];
|
|
struct input_absinfo xabsinfo = {}, yabsinfo = {};
|
|
_cleanup_close_ int fd = -1;
|
|
|
|
fd = open(devpath, O_RDONLY|O_CLOEXEC);
|
|
if (fd < 0)
|
|
return;
|
|
|
|
if (ioctl(fd, EVIOCGABS(ABS_X), &xabsinfo) < 0 ||
|
|
ioctl(fd, EVIOCGABS(ABS_Y), &yabsinfo) < 0)
|
|
return;
|
|
|
|
if (xabsinfo.resolution <= 0 || yabsinfo.resolution <= 0)
|
|
return;
|
|
|
|
xsprintf(width, "%d", abs_size_mm(&xabsinfo));
|
|
xsprintf(height, "%d", abs_size_mm(&yabsinfo));
|
|
|
|
udev_builtin_add_property(dev, test, "ID_INPUT_WIDTH_MM", width);
|
|
udev_builtin_add_property(dev, test, "ID_INPUT_HEIGHT_MM", height);
|
|
}
|
|
|
|
/*
|
|
* Read a capability attribute and return bitmask.
|
|
* @param dev sd_device
|
|
* @param attr sysfs attribute name (e. g. "capabilities/key")
|
|
* @param bitmask: Output array which has a sizeof of bitmask_size
|
|
*/
|
|
static void get_cap_mask(sd_device *pdev, const char* attr,
|
|
unsigned long *bitmask, size_t bitmask_size,
|
|
bool test) {
|
|
const char *v;
|
|
char text[4096];
|
|
unsigned i;
|
|
char* word;
|
|
unsigned long val;
|
|
|
|
if (sd_device_get_sysattr_value(pdev, attr, &v) < 0)
|
|
v = "";
|
|
|
|
xsprintf(text, "%s", v);
|
|
log_device_debug(pdev, "%s raw kernel attribute: %s", attr, text);
|
|
|
|
memzero(bitmask, bitmask_size);
|
|
i = 0;
|
|
while ((word = strrchr(text, ' ')) != NULL) {
|
|
val = strtoul(word+1, NULL, 16);
|
|
if (i < bitmask_size / sizeof(unsigned long))
|
|
bitmask[i] = val;
|
|
else
|
|
log_device_debug(pdev, "Ignoring %s block %lX which is larger than maximum size", attr, val);
|
|
*word = '\0';
|
|
++i;
|
|
}
|
|
val = strtoul (text, NULL, 16);
|
|
if (i < bitmask_size / sizeof(unsigned long))
|
|
bitmask[i] = val;
|
|
else
|
|
log_device_debug(pdev, "Ignoring %s block %lX which is larger than maximum size", attr, val);
|
|
|
|
if (test) {
|
|
/* printf pattern with the right unsigned long number of hex chars */
|
|
xsprintf(text, " bit %%4u: %%0%zulX\n",
|
|
2 * sizeof(unsigned long));
|
|
log_device_debug(pdev, "%s decoded bit map:", attr);
|
|
val = bitmask_size / sizeof (unsigned long);
|
|
/* skip over leading zeros */
|
|
while (bitmask[val-1] == 0 && val > 0)
|
|
--val;
|
|
for (i = 0; i < val; ++i) {
|
|
DISABLE_WARNING_FORMAT_NONLITERAL;
|
|
log_device_debug(pdev, text, i * BITS_PER_LONG, bitmask[i]);
|
|
REENABLE_WARNING;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* pointer devices */
|
|
static bool test_pointers(sd_device *dev,
|
|
const unsigned long* bitmask_ev,
|
|
const unsigned long* bitmask_abs,
|
|
const unsigned long* bitmask_key,
|
|
const unsigned long* bitmask_rel,
|
|
const unsigned long* bitmask_props,
|
|
bool test) {
|
|
int button, axis;
|
|
bool has_abs_coordinates = false;
|
|
bool has_rel_coordinates = false;
|
|
bool has_mt_coordinates = false;
|
|
bool has_joystick_axes_or_buttons = false;
|
|
bool is_direct = false;
|
|
bool has_touch = false;
|
|
bool has_3d_coordinates = false;
|
|
bool has_keys = false;
|
|
bool stylus_or_pen = false;
|
|
bool finger_but_no_pen = false;
|
|
bool has_mouse_button = false;
|
|
bool is_mouse = false;
|
|
bool is_touchpad = false;
|
|
bool is_touchscreen = false;
|
|
bool is_tablet = false;
|
|
bool is_joystick = false;
|
|
bool is_accelerometer = false;
|
|
bool is_pointing_stick= false;
|
|
|
|
has_keys = test_bit(EV_KEY, bitmask_ev);
|
|
has_abs_coordinates = test_bit(ABS_X, bitmask_abs) && test_bit(ABS_Y, bitmask_abs);
|
|
has_3d_coordinates = has_abs_coordinates && test_bit(ABS_Z, bitmask_abs);
|
|
is_accelerometer = test_bit(INPUT_PROP_ACCELEROMETER, bitmask_props);
|
|
|
|
if (!has_keys && has_3d_coordinates)
|
|
is_accelerometer = true;
|
|
|
|
if (is_accelerometer) {
|
|
udev_builtin_add_property(dev, test, "ID_INPUT_ACCELEROMETER", "1");
|
|
return true;
|
|
}
|
|
|
|
is_pointing_stick = test_bit(INPUT_PROP_POINTING_STICK, bitmask_props);
|
|
stylus_or_pen = test_bit(BTN_STYLUS, bitmask_key) || test_bit(BTN_TOOL_PEN, bitmask_key);
|
|
finger_but_no_pen = test_bit(BTN_TOOL_FINGER, bitmask_key) && !test_bit(BTN_TOOL_PEN, bitmask_key);
|
|
for (button = BTN_MOUSE; button < BTN_JOYSTICK && !has_mouse_button; button++)
|
|
has_mouse_button = test_bit(button, bitmask_key);
|
|
has_rel_coordinates = test_bit(EV_REL, bitmask_ev) && test_bit(REL_X, bitmask_rel) && test_bit(REL_Y, bitmask_rel);
|
|
has_mt_coordinates = test_bit(ABS_MT_POSITION_X, bitmask_abs) && test_bit(ABS_MT_POSITION_Y, bitmask_abs);
|
|
|
|
/* unset has_mt_coordinates if devices claims to have all abs axis */
|
|
if (has_mt_coordinates && test_bit(ABS_MT_SLOT, bitmask_abs) && test_bit(ABS_MT_SLOT - 1, bitmask_abs))
|
|
has_mt_coordinates = false;
|
|
is_direct = test_bit(INPUT_PROP_DIRECT, bitmask_props);
|
|
has_touch = test_bit(BTN_TOUCH, bitmask_key);
|
|
|
|
/* joysticks don't necessarily have buttons; e. g.
|
|
* rudders/pedals are joystick-like, but buttonless; they have
|
|
* other fancy axes. Others have buttons only but no axes.
|
|
*
|
|
* The BTN_JOYSTICK range starts after the mouse range, so a mouse
|
|
* with more than 16 buttons runs into the joystick range (e.g. Mad
|
|
* Catz Mad Catz M.M.O.TE). Skip those.
|
|
*/
|
|
if (!test_bit(BTN_JOYSTICK - 1, bitmask_key)) {
|
|
for (button = BTN_JOYSTICK; button < BTN_DIGI && !has_joystick_axes_or_buttons; button++)
|
|
has_joystick_axes_or_buttons = test_bit(button, bitmask_key);
|
|
for (button = BTN_TRIGGER_HAPPY1; button <= BTN_TRIGGER_HAPPY40 && !has_joystick_axes_or_buttons; button++)
|
|
has_joystick_axes_or_buttons = test_bit(button, bitmask_key);
|
|
for (button = BTN_DPAD_UP; button <= BTN_DPAD_RIGHT && !has_joystick_axes_or_buttons; button++)
|
|
has_joystick_axes_or_buttons = test_bit(button, bitmask_key);
|
|
}
|
|
for (axis = ABS_RX; axis < ABS_PRESSURE && !has_joystick_axes_or_buttons; axis++)
|
|
has_joystick_axes_or_buttons = test_bit(axis, bitmask_abs);
|
|
|
|
if (has_abs_coordinates) {
|
|
if (stylus_or_pen)
|
|
is_tablet = true;
|
|
else if (finger_but_no_pen && !is_direct)
|
|
is_touchpad = true;
|
|
else if (has_mouse_button)
|
|
/* This path is taken by VMware's USB mouse, which has
|
|
* absolute axes, but no touch/pressure button. */
|
|
is_mouse = true;
|
|
else if (has_touch || is_direct)
|
|
is_touchscreen = true;
|
|
else if (has_joystick_axes_or_buttons)
|
|
is_joystick = true;
|
|
} else if (has_joystick_axes_or_buttons) {
|
|
is_joystick = true;
|
|
}
|
|
|
|
if (has_mt_coordinates) {
|
|
if (stylus_or_pen)
|
|
is_tablet = true;
|
|
else if (finger_but_no_pen && !is_direct)
|
|
is_touchpad = true;
|
|
else if (has_touch || is_direct)
|
|
is_touchscreen = true;
|
|
}
|
|
|
|
if (!is_tablet && !is_touchpad && !is_joystick &&
|
|
has_mouse_button &&
|
|
(has_rel_coordinates ||
|
|
!has_abs_coordinates)) /* mouse buttons and no axis */
|
|
is_mouse = true;
|
|
|
|
if (is_pointing_stick)
|
|
udev_builtin_add_property(dev, test, "ID_INPUT_POINTINGSTICK", "1");
|
|
if (is_mouse)
|
|
udev_builtin_add_property(dev, test, "ID_INPUT_MOUSE", "1");
|
|
if (is_touchpad)
|
|
udev_builtin_add_property(dev, test, "ID_INPUT_TOUCHPAD", "1");
|
|
if (is_touchscreen)
|
|
udev_builtin_add_property(dev, test, "ID_INPUT_TOUCHSCREEN", "1");
|
|
if (is_joystick)
|
|
udev_builtin_add_property(dev, test, "ID_INPUT_JOYSTICK", "1");
|
|
if (is_tablet)
|
|
udev_builtin_add_property(dev, test, "ID_INPUT_TABLET", "1");
|
|
|
|
return is_tablet || is_mouse || is_touchpad || is_touchscreen || is_joystick || is_pointing_stick;
|
|
}
|
|
|
|
/* key like devices */
|
|
static bool test_key(sd_device *dev,
|
|
const unsigned long* bitmask_ev,
|
|
const unsigned long* bitmask_key,
|
|
bool test) {
|
|
unsigned i;
|
|
unsigned long found;
|
|
unsigned long mask;
|
|
bool ret = false;
|
|
|
|
/* do we have any KEY_* capability? */
|
|
if (!test_bit(EV_KEY, bitmask_ev)) {
|
|
log_device_debug(dev, "test_key: no EV_KEY capability");
|
|
return false;
|
|
}
|
|
|
|
/* only consider KEY_* here, not BTN_* */
|
|
found = 0;
|
|
for (i = 0; i < BTN_MISC/BITS_PER_LONG; ++i) {
|
|
found |= bitmask_key[i];
|
|
log_device_debug(dev, "test_key: checking bit block %lu for any keys; found=%i", (unsigned long)i*BITS_PER_LONG, found > 0);
|
|
}
|
|
/* If there are no keys in the lower block, check the higher blocks */
|
|
if (!found) {
|
|
unsigned block;
|
|
for (block = 0; block < (sizeof(high_key_blocks) / sizeof(struct range)); ++block) {
|
|
for (i = high_key_blocks[block].start; i < high_key_blocks[block].end; ++i) {
|
|
if (test_bit(i, bitmask_key)) {
|
|
log_device_debug(dev, "test_key: Found key %x in high block", i);
|
|
found = 1;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
if (found > 0) {
|
|
udev_builtin_add_property(dev, test, "ID_INPUT_KEY", "1");
|
|
ret = true;
|
|
}
|
|
|
|
/* the first 32 bits are ESC, numbers, and Q to D; if we have all of
|
|
* those, consider it a full keyboard; do not test KEY_RESERVED, though */
|
|
mask = 0xFFFFFFFE;
|
|
if (FLAGS_SET(bitmask_key[0], mask)) {
|
|
udev_builtin_add_property(dev, test, "ID_INPUT_KEYBOARD", "1");
|
|
ret = true;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int builtin_input_id(sd_device *dev, int argc, char *argv[], bool test) {
|
|
sd_device *pdev;
|
|
unsigned long bitmask_ev[NBITS(EV_MAX)];
|
|
unsigned long bitmask_abs[NBITS(ABS_MAX)];
|
|
unsigned long bitmask_key[NBITS(KEY_MAX)];
|
|
unsigned long bitmask_rel[NBITS(REL_MAX)];
|
|
unsigned long bitmask_props[NBITS(INPUT_PROP_MAX)];
|
|
const char *sysname, *devnode;
|
|
bool is_pointer;
|
|
bool is_key;
|
|
|
|
assert(dev);
|
|
|
|
/* walk up the parental chain until we find the real input device; the
|
|
* argument is very likely a subdevice of this, like eventN */
|
|
for (pdev = dev; pdev; ) {
|
|
const char *s;
|
|
|
|
if (sd_device_get_sysattr_value(pdev, "capabilities/ev", &s) >= 0)
|
|
break;
|
|
|
|
if (sd_device_get_parent_with_subsystem_devtype(pdev, "input", NULL, &pdev) >= 0)
|
|
continue;
|
|
|
|
pdev = NULL;
|
|
break;
|
|
}
|
|
|
|
if (pdev) {
|
|
/* Use this as a flag that input devices were detected, so that this
|
|
* program doesn't need to be called more than once per device */
|
|
udev_builtin_add_property(dev, test, "ID_INPUT", "1");
|
|
get_cap_mask(pdev, "capabilities/ev", bitmask_ev, sizeof(bitmask_ev), test);
|
|
get_cap_mask(pdev, "capabilities/abs", bitmask_abs, sizeof(bitmask_abs), test);
|
|
get_cap_mask(pdev, "capabilities/rel", bitmask_rel, sizeof(bitmask_rel), test);
|
|
get_cap_mask(pdev, "capabilities/key", bitmask_key, sizeof(bitmask_key), test);
|
|
get_cap_mask(pdev, "properties", bitmask_props, sizeof(bitmask_props), test);
|
|
is_pointer = test_pointers(dev, bitmask_ev, bitmask_abs,
|
|
bitmask_key, bitmask_rel,
|
|
bitmask_props, test);
|
|
is_key = test_key(dev, bitmask_ev, bitmask_key, test);
|
|
/* Some evdev nodes have only a scrollwheel */
|
|
if (!is_pointer && !is_key && test_bit(EV_REL, bitmask_ev) &&
|
|
(test_bit(REL_WHEEL, bitmask_rel) || test_bit(REL_HWHEEL, bitmask_rel)))
|
|
udev_builtin_add_property(dev, test, "ID_INPUT_KEY", "1");
|
|
if (test_bit(EV_SW, bitmask_ev))
|
|
udev_builtin_add_property(dev, test, "ID_INPUT_SWITCH", "1");
|
|
|
|
}
|
|
|
|
if (sd_device_get_devname(dev, &devnode) >= 0 &&
|
|
sd_device_get_sysname(dev, &sysname) >= 0 &&
|
|
startswith(sysname, "event"))
|
|
extract_info(dev, devnode, test);
|
|
|
|
return 0;
|
|
}
|
|
|
|
const UdevBuiltin udev_builtin_input_id = {
|
|
.name = "input_id",
|
|
.cmd = builtin_input_id,
|
|
.help = "Input device properties",
|
|
};
|