1 /* SPDX-License-Identifier: LGPL-2.1+ */
7 #include <linux/input.h>
9 #include "device-util.h"
11 #include "parse-util.h"
12 #include "stdio-util.h"
13 #include "string-util.h"
15 #include "udev-builtin.h"
17 static const struct key_name
*keyboard_lookup_key(const char *str
, GPERF_LEN_TYPE len
);
18 #include "keyboard-keys-from-name.h"
20 static int install_force_release(sd_device
*dev
, const unsigned *release
, unsigned release_count
) {
32 r
= sd_device_get_parent_with_subsystem_devtype(dev
, "serio", NULL
, &atkbd
);
34 return log_device_error_errno(dev
, r
, "Failed to get serio parent: %m");
36 r
= sd_device_get_sysattr_value(atkbd
, "force_release", &cur
);
38 return log_device_error_errno(atkbd
, r
, "Failed to get force-release attribute: %m");
43 /* copy current content */
44 l
= strpcpy(&s
, l
, cur
);
46 /* append new codes */
47 for (i
= 0; i
< release_count
; i
++)
48 l
= strpcpyf(&s
, l
, ",%u", release
[i
]);
50 log_device_debug(atkbd
, "keyboard: updating force-release list with '%s'", codes
);
51 r
= sd_device_set_sysattr_value(atkbd
, "force_release", codes
);
53 return log_device_error_errno(atkbd
, r
, "Failed to set force-release attribute: %m");
58 static int map_keycode(sd_device
*dev
, int fd
, int scancode
, const char *keycode
) {
64 const struct key_name
*k
;
67 /* translate identifier to key code */
68 k
= keyboard_lookup_key(keycode
, strlen(keycode
));
72 /* check if it's a numeric code already */
73 keycode_num
= strtoul(keycode
, &endptr
, 0);
75 return log_device_error_errno(dev
, SYNTHETIC_ERRNO(EINVAL
), "Failed to parse key identifier '%s'", keycode
);
79 map
.key
= keycode_num
;
81 log_device_debug(dev
, "keyboard: mapping scan code %d (0x%x) to key code %d (0x%x)",
82 map
.scan
, map
.scan
, map
.key
, map
.key
);
84 if (ioctl(fd
, EVIOCSKEYCODE
, &map
) < 0)
85 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
);
90 static char* parse_token(const char *current
, int32_t *val_out
) {
97 val
= strtol(current
, &next
, 0);
98 if (*next
&& *next
!= ':')
110 static int override_abs(sd_device
*dev
, int fd
, unsigned evcode
, const char *value
) {
111 struct input_absinfo absinfo
;
115 r
= ioctl(fd
, EVIOCGABS(evcode
), &absinfo
);
117 return log_device_error_errno(dev
, errno
, "Failed to call EVIOCGABS");
119 next
= parse_token(value
, &absinfo
.minimum
);
120 next
= parse_token(next
, &absinfo
.maximum
);
121 next
= parse_token(next
, &absinfo
.resolution
);
122 next
= parse_token(next
, &absinfo
.fuzz
);
123 next
= parse_token(next
, &absinfo
.flat
);
125 return log_device_error(dev
, "Failed to parse EV_ABS override '%s'", value
);
127 log_device_debug(dev
, "keyboard: %x overridden with %"PRIi32
"/%"PRIi32
"/%"PRIi32
"/%"PRIi32
"/%"PRIi32
,
128 evcode
, absinfo
.minimum
, absinfo
.maximum
, absinfo
.resolution
, absinfo
.fuzz
, absinfo
.flat
);
129 r
= ioctl(fd
, EVIOCSABS(evcode
), &absinfo
);
131 return log_device_error_errno(dev
, errno
, "Failed to call EVIOCSABS");
136 static int set_trackpoint_sensitivity(sd_device
*dev
, const char *value
) {
138 char val_s
[DECIMAL_STR_MAX(int)];
144 /* The sensitivity sysfs attr belongs to the serio parent device */
145 r
= sd_device_get_parent_with_subsystem_devtype(dev
, "serio", NULL
, &pdev
);
147 return log_device_error_errno(dev
, r
, "Failed to get serio parent: %m");
149 r
= safe_atoi(value
, &val_i
);
151 return log_device_error_errno(dev
, r
, "Failed to parse POINTINGSTICK_SENSITIVITY '%s': %m", value
);
152 else if (val_i
< 0 || val_i
> 255)
153 return log_device_error_errno(dev
, SYNTHETIC_ERRNO(ERANGE
), "POINTINGSTICK_SENSITIVITY %d outside range [0..255]", val_i
);
155 xsprintf(val_s
, "%d", val_i
);
157 r
= sd_device_set_sysattr_value(pdev
, "sensitivity", val_s
);
159 return log_device_error_errno(dev
, r
, "Failed to write 'sensitivity' attribute: %m");
164 static int builtin_keyboard(sd_device
*dev
, int argc
, char *argv
[], bool test
) {
165 unsigned release
[1024];
166 unsigned release_count
= 0;
167 _cleanup_close_
int fd
= -1;
168 const char *node
, *key
, *value
;
171 r
= sd_device_get_devname(dev
, &node
);
173 return log_device_error_errno(dev
, r
, "Failed to get device name: %m");
175 FOREACH_DEVICE_PROPERTY(dev
, key
, value
) {
178 if (startswith(key
, "KEYBOARD_KEY_")) {
179 const char *keycode
= value
;
182 /* KEYBOARD_KEY_<hex scan code>=<key identifier string> */
183 scancode
= strtoul(key
+ 13, &endptr
, 16);
184 if (endptr
[0] != '\0') {
185 log_device_warning(dev
, "Failed to parse scan code from \"%s\", ignoring", key
);
189 /* a leading '!' needs a force-release entry */
190 if (keycode
[0] == '!') {
193 release
[release_count
] = scancode
;
194 if (release_count
< ELEMENTSOF(release
)-1)
197 if (keycode
[0] == '\0')
202 fd
= open(node
, O_RDWR
|O_CLOEXEC
|O_NONBLOCK
|O_NOCTTY
);
204 return log_device_error_errno(dev
, errno
, "Failed to open device '%s': %m", node
);
207 (void) map_keycode(dev
, fd
, scancode
, keycode
);
208 } else if (startswith(key
, "EVDEV_ABS_")) {
211 /* EVDEV_ABS_<EV_ABS code>=<min>:<max>:<res>:<fuzz>:<flat> */
212 evcode
= strtoul(key
+ 10, &endptr
, 16);
213 if (endptr
[0] != '\0') {
214 log_device_warning(dev
, "Failed to parse EV_ABS code from \"%s\", ignoring", key
);
219 fd
= open(node
, O_RDWR
|O_CLOEXEC
|O_NONBLOCK
|O_NOCTTY
);
221 return log_device_error_errno(dev
, errno
, "Failed to open device '%s': %m", node
);
228 rc
= ioctl(fd
, EVIOCGBIT(0, sizeof(bits
)), &bits
);
230 return log_device_error_errno(dev
, errno
, "Failed to set EVIOCGBIT");
232 has_abs
= !!(bits
& (1 << EV_ABS
));
234 log_device_warning(dev
, "EVDEV_ABS override set but no EV_ABS present on device");
240 (void) override_abs(dev
, fd
, evcode
, value
);
241 } else if (streq(key
, "POINTINGSTICK_SENSITIVITY"))
242 (void) set_trackpoint_sensitivity(dev
, value
);
245 /* install list of force-release codes */
246 if (release_count
> 0)
247 (void) install_force_release(dev
, release
, release_count
);
252 const UdevBuiltin udev_builtin_keyboard
= {
254 .cmd
= builtin_keyboard
,
255 .help
= "Keyboard scan code to key mapping",