src/udev/udev-builtin-keyboard.c

   1 /* SPDX-License-Identifier: LGPL-2.1+ */
   2
   3 #include <errno.h>
   4 #include <fcntl.h>
   5 #include <stdio.h>
   6 #include <stdlib.h>
   7 #include <string.h>
   8 #include <sys/ioctl.h>
   9 #include <linux/input.h>
  10
  11 #include "device-util.h"
  12 #include "fd-util.h"
  13 #include "parse-util.h"
  14 #include "stdio-util.h"
  15 #include "string-util.h"
  16 #include "strxcpyx.h"
  17 #include "udev-builtin.h"
  18
  19 static const struct key_name *keyboard_lookup_key(const char *str, GPERF_LEN_TYPE len);
  20 #include "keyboard-keys-from-name.h"
  21
  22 static int install_force_release(sd_device *dev, const unsigned *release, unsigned release_count) {
  23         sd_device *atkbd;
  24         const char *cur;
  25         char codes[4096];
  26         char *s;
  27         size_t l;
  28         unsigned i;
  29         int r;
  30
  31         assert(dev);
  32         assert(release);
  33
  34         r = sd_device_get_parent_with_subsystem_devtype(dev, "serio", NULL, &atkbd);
  35         if (r < 0)
  36                 return log_device_error_errno(dev, r, "Failed to get serio parent: %m");
  37
  38         r = sd_device_get_sysattr_value(atkbd, "force_release", &cur);
  39         if (r < 0)
  40                 return log_device_error_errno(atkbd, r, "Failed to get force-release attribute: %m");
  41
  42         s = codes;
  43         l = sizeof(codes);
  44
  45         /* copy current content */
  46         l = strpcpy(&s, l, cur);
  47
  48         /* append new codes */
  49         for (i = 0; i < release_count; i++)
  50                 l = strpcpyf(&s, l, ",%u", release[i]);
  51
  52         log_device_debug(atkbd, "keyboard: updating force-release list with '%s'", codes);
  53         r = sd_device_set_sysattr_value(atkbd, "force_release", codes);
  54         if (r < 0)
  55                 return log_device_error_errno(atkbd, r, "Failed to set force-release attribute: %m");
  56
  57         return 0;
  58 }
  59
  60 static int map_keycode(sd_device *dev, int fd, int scancode, const char *keycode) {
  61         struct {
  62                 unsigned scan;
  63                 unsigned key;
  64         } map;
  65         char *endptr;
  66         const struct key_name *k;
  67         unsigned keycode_num;
  68
  69         /* translate identifier to key code */
  70         k = keyboard_lookup_key(keycode, strlen(keycode));
  71         if (k) {
  72                 keycode_num = k->id;
  73         } else {
  74                 /* check if it's a numeric code already */
  75                 keycode_num = strtoul(keycode, &endptr, 0);
  76                 if (endptr[0] !='\0')
  77                         return log_device_error_errno(dev, SYNTHETIC_ERRNO(EINVAL), "Failed to parse key identifier '%s'", keycode);
  78         }
  79
  80         map.scan = scancode;
  81         map.key = keycode_num;
  82
  83         log_device_debug(dev, "keyboard: mapping scan code %d (0x%x) to key code %d (0x%x)",
  84                          map.scan, map.scan, map.key, map.key);
  85
  86         if (ioctl(fd, EVIOCSKEYCODE, &map) < 0)
  87                 return log_device_error_errno(dev, errno, "Failed to call EVIOCSKEYCODE with scan code 0x%x, and key code %d: %m", map.scan, map.key);
  88
  89         return 0;
  90 }
  91
  92 static char* parse_token(const char *current, int32_t *val_out) {
  93         char *next;
  94         int32_t val;
  95
  96         if (!current)
  97                 return NULL;
  98
  99         val = strtol(current, &next, 0);
 100         if (*next && *next != ':')
 101                 return NULL;
 102
 103         if (next != current)
 104                 *val_out = val;
 105
 106         if (*next)
 107                 next++;
 108
 109         return next;
 110 }
 111
 112 static int override_abs(sd_device *dev, int fd, unsigned evcode, const char *value) {
 113         struct input_absinfo absinfo;
 114         char *next;
 115         int r;
 116
 117         r = ioctl(fd, EVIOCGABS(evcode), &absinfo);
 118         if (r < 0)
 119                 return log_device_error_errno(dev, errno, "Failed to call EVIOCGABS");
 120
 121         next = parse_token(value, &absinfo.minimum);
 122         next = parse_token(next, &absinfo.maximum);
 123         next = parse_token(next, &absinfo.resolution);
 124         next = parse_token(next, &absinfo.fuzz);
 125         next = parse_token(next, &absinfo.flat);
 126         if (!next)
 127                 return log_device_error(dev, "Failed to parse EV_ABS override '%s'", value);
 128
 129         log_device_debug(dev, "keyboard: %x overridden with %"PRIi32"/%"PRIi32"/%"PRIi32"/%"PRIi32"/%"PRIi32,
 130                          evcode, absinfo.minimum, absinfo.maximum, absinfo.resolution, absinfo.fuzz, absinfo.flat);
 131         r = ioctl(fd, EVIOCSABS(evcode), &absinfo);
 132         if (r < 0)
 133                 return log_device_error_errno(dev, errno, "Failed to call EVIOCSABS");
 134
 135         return 0;
 136 }
 137
 138 static int set_trackpoint_sensitivity(sd_device *dev, const char *value) {
 139         sd_device *pdev;
 140         char val_s[DECIMAL_STR_MAX(int)];
 141         int r, val_i;
 142
 143         assert(dev);
 144         assert(value);
 145
 146         /* The sensitivity sysfs attr belongs to the serio parent device */
 147         r = sd_device_get_parent_with_subsystem_devtype(dev, "serio", NULL, &pdev);
 148         if (r < 0)
 149                 return log_device_error_errno(dev, r, "Failed to get serio parent: %m");
 150
 151         r = safe_atoi(value, &val_i);
 152         if (r < 0)
 153                 return log_device_error_errno(dev, r, "Failed to parse POINTINGSTICK_SENSITIVITY '%s': %m", value);
 154         else if (val_i < 0 || val_i > 255)
 155                 return log_device_error_errno(dev, SYNTHETIC_ERRNO(ERANGE), "POINTINGSTICK_SENSITIVITY %d outside range [0..255]", val_i);
 156
 157         xsprintf(val_s, "%d", val_i);
 158
 159         r = sd_device_set_sysattr_value(pdev, "sensitivity", val_s);
 160         if (r < 0)
 161                 return log_device_error_errno(dev, r, "Failed to write 'sensitivity' attribute: %m");
 162
 163         return 0;
 164 }
 165
 166 static int builtin_keyboard(sd_device *dev, int argc, char *argv[], bool test) {
 167         unsigned release[1024];
 168         unsigned release_count = 0;
 169         _cleanup_close_ int fd = -1;
 170         const char *node, *key, *value;
 171         int has_abs = -1, r;
 172
 173         r = sd_device_get_devname(dev, &node);
 174         if (r < 0)
 175                 return log_device_error_errno(dev, r, "Failed to get device name: %m");
 176
 177         FOREACH_DEVICE_PROPERTY(dev, key, value) {
 178                 char *endptr;
 179
 180                 if (startswith(key, "KEYBOARD_KEY_")) {
 181                         const char *keycode = value;
 182                         unsigned scancode;
 183
 184                         /* KEYBOARD_KEY_<hex scan code>=<key identifier string> */
 185                         scancode = strtoul(key + 13, &endptr, 16);
 186                         if (endptr[0] != '\0') {
 187                                 log_device_warning(dev, "Failed to parse scan code from \"%s\", ignoring", key);
 188                                 continue;
 189                         }
 190
 191                         /* a leading '!' needs a force-release entry */
 192                         if (keycode[0] == '!') {
 193                                 keycode++;
 194
 195                                 release[release_count] = scancode;
 196                                 if (release_count < ELEMENTSOF(release)-1)
 197                                         release_count++;
 198
 199                                 if (keycode[0] == '\0')
 200                                         continue;
 201                         }
 202
 203                         if (fd < 0) {
 204                                 fd = open(node, O_RDWR|O_CLOEXEC|O_NONBLOCK|O_NOCTTY);
 205                                 if (fd < 0)
 206                                         return log_device_error_errno(dev, errno, "Failed to open device '%s': %m", node);
 207                         }
 208
 209                         (void) map_keycode(dev, fd, scancode, keycode);
 210                 } else if (startswith(key, "EVDEV_ABS_")) {
 211                         unsigned evcode;
 212
 213                         /* EVDEV_ABS_<EV_ABS code>=<min>:<max>:<res>:<fuzz>:<flat> */
 214                         evcode = strtoul(key + 10, &endptr, 16);
 215                         if (endptr[0] != '\0') {
 216                                 log_device_warning(dev, "Failed to parse EV_ABS code from \"%s\", ignoring", key);
 217                                 continue;
 218                         }
 219
 220                         if (fd < 0) {
 221                                 fd = open(node, O_RDWR|O_CLOEXEC|O_NONBLOCK|O_NOCTTY);
 222                                 if (fd < 0)
 223                                         return log_device_error_errno(dev, errno, "Failed to open device '%s': %m", node);
 224                         }
 225
 226                         if (has_abs == -1) {
 227                                 unsigned long bits;
 228                                 int rc;
 229
 230                                 rc = ioctl(fd, EVIOCGBIT(0, sizeof(bits)), &bits);
 231                                 if (rc < 0)
 232                                         return log_device_error_errno(dev, errno, "Failed to set EVIOCGBIT");
 233
 234                                 has_abs = !!(bits & (1 << EV_ABS));
 235                                 if (!has_abs)
 236                                         log_device_warning(dev, "EVDEV_ABS override set but no EV_ABS present on device");
 237                         }
 238
 239                         if (!has_abs)
 240                                 continue;
 241
 242                         (void) override_abs(dev, fd, evcode, value);
 243                 } else if (streq(key, "POINTINGSTICK_SENSITIVITY"))
 244                         (void) set_trackpoint_sensitivity(dev, value);
 245         }
 246
 247         /* install list of force-release codes */
 248         if (release_count > 0)
 249                 (void) install_force_release(dev, release, release_count);
 250
 251         return 0;
 252 }
 253
 254 const struct udev_builtin udev_builtin_keyboard = {
 255         .name = "keyboard",
 256         .cmd = builtin_keyboard,
 257         .help = "Keyboard scan code to key mapping",
 258 };