]>
Commit | Line | Data |
---|---|---|
53e1b683 | 1 | /* SPDX-License-Identifier: LGPL-2.1+ */ |
e9d21f24 LP |
2 | /*** |
3 | This file is part of systemd. | |
4 | ||
5 | Copyright 2012 Lennart Poettering | |
e9d21f24 LP |
6 | ***/ |
7 | ||
e9d21f24 LP |
8 | #include <errno.h> |
9 | #include <fcntl.h> | |
07630cea | 10 | #include <string.h> |
e9d21f24 LP |
11 | #include <sys/ioctl.h> |
12 | #include <unistd.h> | |
13 | #include <linux/input.h> | |
e9d21f24 | 14 | |
cc377381 | 15 | #include "sd-messages.h" |
07630cea | 16 | |
b5efdb8a | 17 | #include "alloc-util.h" |
3ffd4af2 LP |
18 | #include "fd-util.h" |
19 | #include "logind-button.h" | |
07630cea | 20 | #include "string-util.h" |
e9d21f24 | 21 | #include "util.h" |
e9d21f24 | 22 | |
d5dd44b0 LP |
23 | #define CONST_MAX4(a, b, c, d) CONST_MAX(CONST_MAX(a, b), CONST_MAX(c, d)) |
24 | ||
25 | #define ULONG_BITS (sizeof(unsigned long)*8) | |
26 | ||
27 | static bool bitset_get(const unsigned long *bits, unsigned i) { | |
28 | return (bits[i / ULONG_BITS] >> (i % ULONG_BITS)) & 1UL; | |
29 | } | |
30 | ||
31 | static void bitset_put(unsigned long *bits, unsigned i) { | |
32 | bits[i / ULONG_BITS] |= (unsigned long) 1 << (i % ULONG_BITS); | |
33 | } | |
34 | ||
e9d21f24 LP |
35 | Button* button_new(Manager *m, const char *name) { |
36 | Button *b; | |
37 | ||
38 | assert(m); | |
39 | assert(name); | |
40 | ||
41 | b = new0(Button, 1); | |
42 | if (!b) | |
43 | return NULL; | |
44 | ||
45 | b->name = strdup(name); | |
6b430fdb ZJS |
46 | if (!b->name) |
47 | return mfree(b); | |
e9d21f24 LP |
48 | |
49 | if (hashmap_put(m->buttons, b->name, b) < 0) { | |
50 | free(b->name); | |
6b430fdb | 51 | return mfree(b); |
e9d21f24 LP |
52 | } |
53 | ||
54 | b->manager = m; | |
55 | b->fd = -1; | |
56 | ||
57 | return b; | |
58 | } | |
59 | ||
60 | void button_free(Button *b) { | |
61 | assert(b); | |
62 | ||
63 | hashmap_remove(b->manager->buttons, b->name); | |
64 | ||
ed4ba7e4 LP |
65 | sd_event_source_unref(b->io_event_source); |
66 | sd_event_source_unref(b->check_event_source); | |
c30a0c62 | 67 | |
ece174c5 | 68 | if (b->fd >= 0) |
c30a0c62 LP |
69 | /* If the device has been unplugged close() returns |
70 | * ENODEV, let's ignore this, hence we don't use | |
03e334a1 | 71 | * safe_close() */ |
4fba5796 | 72 | (void) close(b->fd); |
e9d21f24 LP |
73 | |
74 | free(b->name); | |
75 | free(b->seat); | |
76 | free(b); | |
77 | } | |
78 | ||
79 | int button_set_seat(Button *b, const char *sn) { | |
80 | char *s; | |
81 | ||
82 | assert(b); | |
83 | assert(sn); | |
84 | ||
85 | s = strdup(sn); | |
86 | if (!s) | |
87 | return -ENOMEM; | |
88 | ||
89 | free(b->seat); | |
90 | b->seat = s; | |
91 | ||
92 | return 0; | |
93 | } | |
94 | ||
3c56cab4 BW |
95 | static void button_lid_switch_handle_action(Manager *manager, bool is_edge) { |
96 | HandleAction handle_action; | |
97 | ||
98 | assert(manager); | |
99 | ||
e25937a3 SF |
100 | /* If we are docked or on external power, handle the lid switch |
101 | * differently */ | |
602a41c2 | 102 | if (manager_is_docked_or_external_displays(manager)) |
3c56cab4 | 103 | handle_action = manager->handle_lid_switch_docked; |
e25937a3 SF |
104 | else if (manager->handle_lid_switch_ep != _HANDLE_ACTION_INVALID && |
105 | manager_is_on_external_power()) | |
106 | handle_action = manager->handle_lid_switch_ep; | |
3c56cab4 BW |
107 | else |
108 | handle_action = manager->handle_lid_switch; | |
109 | ||
110 | manager_handle_action(manager, INHIBIT_HANDLE_LID_SWITCH, handle_action, manager->lid_switch_ignore_inhibited, is_edge); | |
111 | } | |
112 | ||
ed4ba7e4 LP |
113 | static int button_recheck(sd_event_source *e, void *userdata) { |
114 | Button *b = userdata; | |
beaafb2e | 115 | |
ed4ba7e4 LP |
116 | assert(b); |
117 | assert(b->lid_closed); | |
118 | ||
3c56cab4 | 119 | button_lid_switch_handle_action(b->manager, false); |
ed4ba7e4 LP |
120 | return 1; |
121 | } | |
e9d21f24 | 122 | |
ed4ba7e4 LP |
123 | static int button_install_check_event_source(Button *b) { |
124 | int r; | |
e9d21f24 LP |
125 | assert(b); |
126 | ||
ed4ba7e4 | 127 | /* Install a post handler, so that we keep rechecking as long as the lid is closed. */ |
6de0e0e5 | 128 | |
ed4ba7e4 LP |
129 | if (b->check_event_source) |
130 | return 0; | |
131 | ||
132 | r = sd_event_add_post(b->manager->event, &b->check_event_source, button_recheck, b); | |
133 | if (r < 0) | |
134 | return r; | |
135 | ||
136 | return sd_event_source_set_priority(b->check_event_source, SD_EVENT_PRIORITY_IDLE+1); | |
e9d21f24 LP |
137 | } |
138 | ||
cc377381 LP |
139 | static int button_dispatch(sd_event_source *s, int fd, uint32_t revents, void *userdata) { |
140 | Button *b = userdata; | |
e9d21f24 LP |
141 | struct input_event ev; |
142 | ssize_t l; | |
143 | ||
cc377381 LP |
144 | assert(s); |
145 | assert(fd == b->fd); | |
e9d21f24 LP |
146 | assert(b); |
147 | ||
148 | l = read(b->fd, &ev, sizeof(ev)); | |
149 | if (l < 0) | |
150 | return errno != EAGAIN ? -errno : 0; | |
151 | if ((size_t) l < sizeof(ev)) | |
152 | return -EIO; | |
153 | ||
e9d21f24 LP |
154 | if (ev.type == EV_KEY && ev.value > 0) { |
155 | ||
156 | switch (ev.code) { | |
157 | ||
158 | case KEY_POWER: | |
159 | case KEY_POWER2: | |
c485437f | 160 | log_struct(LOG_INFO, |
e2cc6eca | 161 | LOG_MESSAGE("Power key pressed."), |
a1230ff9 | 162 | "MESSAGE_ID=" SD_MESSAGE_POWER_KEY_STR); |
7b77ed8c | 163 | |
ed4ba7e4 | 164 | manager_handle_action(b->manager, INHIBIT_HANDLE_POWER_KEY, b->manager->handle_power_key, b->manager->power_key_ignore_inhibited, true); |
7b77ed8c | 165 | break; |
e9d21f24 | 166 | |
8e7fd6ad LP |
167 | /* The kernel is a bit confused here: |
168 | ||
169 | KEY_SLEEP = suspend-to-ram, which everybody else calls "suspend" | |
170 | KEY_SUSPEND = suspend-to-disk, which everybody else calls "hibernate" | |
171 | */ | |
172 | ||
e9d21f24 | 173 | case KEY_SLEEP: |
c485437f | 174 | log_struct(LOG_INFO, |
e2cc6eca | 175 | LOG_MESSAGE("Suspend key pressed."), |
a1230ff9 | 176 | "MESSAGE_ID=" SD_MESSAGE_SUSPEND_KEY_STR); |
7b77ed8c | 177 | |
ed4ba7e4 | 178 | manager_handle_action(b->manager, INHIBIT_HANDLE_SUSPEND_KEY, b->manager->handle_suspend_key, b->manager->suspend_key_ignore_inhibited, true); |
7b77ed8c | 179 | break; |
e9d21f24 | 180 | |
8e7fd6ad | 181 | case KEY_SUSPEND: |
c485437f | 182 | log_struct(LOG_INFO, |
e2cc6eca | 183 | LOG_MESSAGE("Hibernate key pressed."), |
a1230ff9 | 184 | "MESSAGE_ID=" SD_MESSAGE_HIBERNATE_KEY_STR); |
7b77ed8c | 185 | |
ed4ba7e4 | 186 | manager_handle_action(b->manager, INHIBIT_HANDLE_HIBERNATE_KEY, b->manager->handle_hibernate_key, b->manager->hibernate_key_ignore_inhibited, true); |
7b77ed8c | 187 | break; |
e9d21f24 | 188 | } |
8e7fd6ad | 189 | |
e9d21f24 LP |
190 | } else if (ev.type == EV_SW && ev.value > 0) { |
191 | ||
7b77ed8c | 192 | if (ev.code == SW_LID) { |
c485437f | 193 | log_struct(LOG_INFO, |
e2cc6eca | 194 | LOG_MESSAGE("Lid closed."), |
a1230ff9 | 195 | "MESSAGE_ID=" SD_MESSAGE_LID_CLOSED_STR); |
65b51162 | 196 | |
ed4ba7e4 | 197 | b->lid_closed = true; |
3c56cab4 | 198 | button_lid_switch_handle_action(b->manager, true); |
ed4ba7e4 | 199 | button_install_check_event_source(b); |
2d62c530 LP |
200 | |
201 | } else if (ev.code == SW_DOCK) { | |
202 | log_struct(LOG_INFO, | |
e2cc6eca | 203 | LOG_MESSAGE("System docked."), |
a1230ff9 | 204 | "MESSAGE_ID=" SD_MESSAGE_SYSTEM_DOCKED_STR); |
2d62c530 LP |
205 | |
206 | b->docked = true; | |
65b51162 LP |
207 | } |
208 | ||
209 | } else if (ev.type == EV_SW && ev.value == 0) { | |
210 | ||
7b77ed8c | 211 | if (ev.code == SW_LID) { |
c485437f | 212 | log_struct(LOG_INFO, |
e2cc6eca | 213 | LOG_MESSAGE("Lid opened."), |
a1230ff9 | 214 | "MESSAGE_ID=" SD_MESSAGE_LID_OPENED_STR); |
7b77ed8c | 215 | |
ed4ba7e4 LP |
216 | b->lid_closed = false; |
217 | b->check_event_source = sd_event_source_unref(b->check_event_source); | |
2d62c530 LP |
218 | |
219 | } else if (ev.code == SW_DOCK) { | |
220 | log_struct(LOG_INFO, | |
e2cc6eca | 221 | LOG_MESSAGE("System undocked."), |
a1230ff9 | 222 | "MESSAGE_ID=" SD_MESSAGE_SYSTEM_UNDOCKED_STR); |
2d62c530 LP |
223 | |
224 | b->docked = false; | |
e9d21f24 LP |
225 | } |
226 | } | |
227 | ||
228 | return 0; | |
229 | } | |
230 | ||
2546b70a LP |
231 | static int button_suitable(Button *b) { |
232 | unsigned long types[CONST_MAX(EV_KEY, EV_SW)/ULONG_BITS+1]; | |
233 | ||
234 | assert(b); | |
235 | assert(b->fd); | |
236 | ||
237 | if (ioctl(b->fd, EVIOCGBIT(EV_SYN, sizeof(types)), types) < 0) | |
238 | return -errno; | |
239 | ||
240 | if (bitset_get(types, EV_KEY)) { | |
241 | unsigned long keys[CONST_MAX4(KEY_POWER, KEY_POWER2, KEY_SLEEP, KEY_SUSPEND)/ULONG_BITS+1]; | |
242 | ||
243 | if (ioctl(b->fd, EVIOCGBIT(EV_KEY, sizeof(keys)), keys) < 0) | |
244 | return -errno; | |
245 | ||
246 | if (bitset_get(keys, KEY_POWER) || | |
247 | bitset_get(keys, KEY_POWER2) || | |
248 | bitset_get(keys, KEY_SLEEP) || | |
249 | bitset_get(keys, KEY_SUSPEND)) | |
250 | return true; | |
251 | } | |
252 | ||
253 | if (bitset_get(types, EV_SW)) { | |
254 | unsigned long switches[CONST_MAX(SW_LID, SW_DOCK)/ULONG_BITS+1]; | |
255 | ||
256 | if (ioctl(b->fd, EVIOCGBIT(EV_SW, sizeof(switches)), switches) < 0) | |
257 | return -errno; | |
258 | ||
259 | if (bitset_get(switches, SW_LID) || | |
260 | bitset_get(switches, SW_DOCK)) | |
261 | return true; | |
262 | } | |
263 | ||
264 | return false; | |
265 | } | |
266 | ||
d5dd44b0 LP |
267 | static int button_set_mask(Button *b) { |
268 | unsigned long | |
269 | types[CONST_MAX(EV_KEY, EV_SW)/ULONG_BITS+1] = {}, | |
270 | keys[CONST_MAX4(KEY_POWER, KEY_POWER2, KEY_SLEEP, KEY_SUSPEND)/ULONG_BITS+1] = {}, | |
271 | switches[CONST_MAX(SW_LID, SW_DOCK)/ULONG_BITS+1] = {}; | |
272 | struct input_mask mask; | |
273 | ||
274 | assert(b); | |
275 | assert(b->fd >= 0); | |
276 | ||
277 | bitset_put(types, EV_KEY); | |
278 | bitset_put(types, EV_SW); | |
279 | ||
280 | mask = (struct input_mask) { | |
281 | .type = EV_SYN, | |
282 | .codes_size = sizeof(types), | |
283 | .codes_ptr = PTR_TO_UINT64(types), | |
284 | }; | |
285 | ||
286 | if (ioctl(b->fd, EVIOCSMASK, &mask) < 0) | |
287 | /* Log only at debug level if the kernel doesn't do EVIOCSMASK yet */ | |
288 | return log_full_errno(IN_SET(errno, ENOTTY, EOPNOTSUPP, EINVAL) ? LOG_DEBUG : LOG_WARNING, | |
289 | errno, "Failed to set EV_SYN event mask on /dev/input/%s: %m", b->name); | |
290 | ||
291 | bitset_put(keys, KEY_POWER); | |
292 | bitset_put(keys, KEY_POWER2); | |
293 | bitset_put(keys, KEY_SLEEP); | |
294 | bitset_put(keys, KEY_SUSPEND); | |
295 | ||
296 | mask = (struct input_mask) { | |
297 | .type = EV_KEY, | |
298 | .codes_size = sizeof(keys), | |
299 | .codes_ptr = PTR_TO_UINT64(keys), | |
300 | }; | |
301 | ||
302 | if (ioctl(b->fd, EVIOCSMASK, &mask) < 0) | |
303 | return log_warning_errno(errno, "Failed to set EV_KEY event mask on /dev/input/%s: %m", b->name); | |
304 | ||
305 | bitset_put(switches, SW_LID); | |
306 | bitset_put(switches, SW_DOCK); | |
307 | ||
308 | mask = (struct input_mask) { | |
309 | .type = EV_SW, | |
310 | .codes_size = sizeof(switches), | |
311 | .codes_ptr = PTR_TO_UINT64(switches), | |
312 | }; | |
313 | ||
314 | if (ioctl(b->fd, EVIOCSMASK, &mask) < 0) | |
315 | return log_warning_errno(errno, "Failed to set EV_SW event mask on /dev/input/%s: %m", b->name); | |
316 | ||
317 | return 0; | |
318 | } | |
319 | ||
cc377381 LP |
320 | int button_open(Button *b) { |
321 | char *p, name[256]; | |
322 | int r; | |
323 | ||
324 | assert(b); | |
325 | ||
7f6e12b0 | 326 | b->fd = safe_close(b->fd); |
cc377381 | 327 | |
63c372cb | 328 | p = strjoina("/dev/input/", b->name); |
cc377381 LP |
329 | |
330 | b->fd = open(p, O_RDWR|O_CLOEXEC|O_NOCTTY|O_NONBLOCK); | |
4a62c710 | 331 | if (b->fd < 0) |
2546b70a LP |
332 | return log_warning_errno(errno, "Failed to open %s: %m", p); |
333 | ||
334 | r = button_suitable(b); | |
335 | if (r < 0) | |
336 | return log_warning_errno(r, "Failed to determine whether input device is relevant to us: %m"); | |
337 | if (r == 0) { | |
338 | log_debug("Device %s does not expose keys or switches relevant to us, ignoring.", p); | |
339 | return -EADDRNOTAVAIL; | |
340 | } | |
cc377381 LP |
341 | |
342 | if (ioctl(b->fd, EVIOCGNAME(sizeof(name)), name) < 0) { | |
76ef789d | 343 | r = log_error_errno(errno, "Failed to get input name: %m"); |
cc377381 LP |
344 | goto fail; |
345 | } | |
346 | ||
d5dd44b0 LP |
347 | (void) button_set_mask(b); |
348 | ||
ed4ba7e4 | 349 | r = sd_event_add_io(b->manager->event, &b->io_event_source, b->fd, EPOLLIN, button_dispatch, b); |
cc377381 | 350 | if (r < 0) { |
da927ba9 | 351 | log_error_errno(r, "Failed to add button event: %m"); |
cc377381 LP |
352 | goto fail; |
353 | } | |
354 | ||
355 | log_info("Watching system buttons on /dev/input/%s (%s)", b->name, name); | |
356 | ||
357 | return 0; | |
358 | ||
359 | fail: | |
66e40583 | 360 | b->fd = safe_close(b->fd); |
cc377381 LP |
361 | return r; |
362 | } | |
363 | ||
2d62c530 | 364 | int button_check_switches(Button *b) { |
d5dd44b0 | 365 | unsigned long switches[CONST_MAX(SW_LID, SW_DOCK)/ULONG_BITS+1] = {}; |
65b51162 LP |
366 | assert(b); |
367 | ||
ed4ba7e4 LP |
368 | if (b->fd < 0) |
369 | return -EINVAL; | |
370 | ||
371 | if (ioctl(b->fd, EVIOCGSW(sizeof(switches)), switches) < 0) | |
372 | return -errno; | |
65b51162 | 373 | |
d5dd44b0 LP |
374 | b->lid_closed = bitset_get(switches, SW_LID); |
375 | b->docked = bitset_get(switches, SW_DOCK); | |
ed4ba7e4 | 376 | |
2d62c530 | 377 | if (b->lid_closed) |
ed4ba7e4 | 378 | button_install_check_event_source(b); |
ed4ba7e4 LP |
379 | |
380 | return 0; | |
65b51162 | 381 | } |