1 /* SPDX-License-Identifier: LGPL-2.1+ */
8 #include <linux/input.h>
10 #include "sd-messages.h"
12 #include "alloc-util.h"
14 #include "logind-button.h"
15 #include "string-util.h"
18 #define CONST_MAX4(a, b, c, d) CONST_MAX(CONST_MAX(a, b), CONST_MAX(c, d))
20 #define ULONG_BITS (sizeof(unsigned long)*8)
22 static bool bitset_get(const unsigned long *bits
, unsigned i
) {
23 return (bits
[i
/ ULONG_BITS
] >> (i
% ULONG_BITS
)) & 1UL;
26 static void bitset_put(unsigned long *bits
, unsigned i
) {
27 bits
[i
/ ULONG_BITS
] |= (unsigned long) 1 << (i
% ULONG_BITS
);
30 Button
* button_new(Manager
*m
, const char *name
) {
40 b
->name
= strdup(name
);
44 if (hashmap_put(m
->buttons
, b
->name
, b
) < 0) {
55 void button_free(Button
*b
) {
58 hashmap_remove(b
->manager
->buttons
, b
->name
);
60 sd_event_source_unref(b
->io_event_source
);
61 sd_event_source_unref(b
->check_event_source
);
64 /* If the device has been unplugged close() returns
65 * ENODEV, let's ignore this, hence we don't use
74 int button_set_seat(Button
*b
, const char *sn
) {
90 static void button_lid_switch_handle_action(Manager
*manager
, bool is_edge
) {
91 HandleAction handle_action
;
95 /* If we are docked or on external power, handle the lid switch
97 if (manager_is_docked_or_external_displays(manager
))
98 handle_action
= manager
->handle_lid_switch_docked
;
99 else if (manager
->handle_lid_switch_ep
!= _HANDLE_ACTION_INVALID
&&
100 manager_is_on_external_power())
101 handle_action
= manager
->handle_lid_switch_ep
;
103 handle_action
= manager
->handle_lid_switch
;
105 manager_handle_action(manager
, INHIBIT_HANDLE_LID_SWITCH
, handle_action
, manager
->lid_switch_ignore_inhibited
, is_edge
);
108 static int button_recheck(sd_event_source
*e
, void *userdata
) {
109 Button
*b
= userdata
;
112 assert(b
->lid_closed
);
114 button_lid_switch_handle_action(b
->manager
, false);
118 static int button_install_check_event_source(Button
*b
) {
122 /* Install a post handler, so that we keep rechecking as long as the lid is closed. */
124 if (b
->check_event_source
)
127 r
= sd_event_add_post(b
->manager
->event
, &b
->check_event_source
, button_recheck
, b
);
131 return sd_event_source_set_priority(b
->check_event_source
, SD_EVENT_PRIORITY_IDLE
+1);
134 static int button_dispatch(sd_event_source
*s
, int fd
, uint32_t revents
, void *userdata
) {
135 Button
*b
= userdata
;
136 struct input_event ev
;
143 l
= read(b
->fd
, &ev
, sizeof(ev
));
145 return errno
!= EAGAIN
? -errno
: 0;
146 if ((size_t) l
< sizeof(ev
))
149 if (ev
.type
== EV_KEY
&& ev
.value
> 0) {
156 LOG_MESSAGE("Power key pressed."),
157 "MESSAGE_ID=" SD_MESSAGE_POWER_KEY_STR
);
159 manager_handle_action(b
->manager
, INHIBIT_HANDLE_POWER_KEY
, b
->manager
->handle_power_key
, b
->manager
->power_key_ignore_inhibited
, true);
162 /* The kernel is a bit confused here:
164 KEY_SLEEP = suspend-to-ram, which everybody else calls "suspend"
165 KEY_SUSPEND = suspend-to-disk, which everybody else calls "hibernate"
170 LOG_MESSAGE("Suspend key pressed."),
171 "MESSAGE_ID=" SD_MESSAGE_SUSPEND_KEY_STR
);
173 manager_handle_action(b
->manager
, INHIBIT_HANDLE_SUSPEND_KEY
, b
->manager
->handle_suspend_key
, b
->manager
->suspend_key_ignore_inhibited
, true);
178 LOG_MESSAGE("Hibernate key pressed."),
179 "MESSAGE_ID=" SD_MESSAGE_HIBERNATE_KEY_STR
);
181 manager_handle_action(b
->manager
, INHIBIT_HANDLE_HIBERNATE_KEY
, b
->manager
->handle_hibernate_key
, b
->manager
->hibernate_key_ignore_inhibited
, true);
185 } else if (ev
.type
== EV_SW
&& ev
.value
> 0) {
187 if (ev
.code
== SW_LID
) {
189 LOG_MESSAGE("Lid closed."),
190 "MESSAGE_ID=" SD_MESSAGE_LID_CLOSED_STR
);
192 b
->lid_closed
= true;
193 button_lid_switch_handle_action(b
->manager
, true);
194 button_install_check_event_source(b
);
196 } else if (ev
.code
== SW_DOCK
) {
198 LOG_MESSAGE("System docked."),
199 "MESSAGE_ID=" SD_MESSAGE_SYSTEM_DOCKED_STR
);
204 } else if (ev
.type
== EV_SW
&& ev
.value
== 0) {
206 if (ev
.code
== SW_LID
) {
208 LOG_MESSAGE("Lid opened."),
209 "MESSAGE_ID=" SD_MESSAGE_LID_OPENED_STR
);
211 b
->lid_closed
= false;
212 b
->check_event_source
= sd_event_source_unref(b
->check_event_source
);
214 } else if (ev
.code
== SW_DOCK
) {
216 LOG_MESSAGE("System undocked."),
217 "MESSAGE_ID=" SD_MESSAGE_SYSTEM_UNDOCKED_STR
);
226 static int button_suitable(Button
*b
) {
227 unsigned long types
[CONST_MAX(EV_KEY
, EV_SW
)/ULONG_BITS
+1];
232 if (ioctl(b
->fd
, EVIOCGBIT(EV_SYN
, sizeof(types
)), types
) < 0)
235 if (bitset_get(types
, EV_KEY
)) {
236 unsigned long keys
[CONST_MAX4(KEY_POWER
, KEY_POWER2
, KEY_SLEEP
, KEY_SUSPEND
)/ULONG_BITS
+1];
238 if (ioctl(b
->fd
, EVIOCGBIT(EV_KEY
, sizeof(keys
)), keys
) < 0)
241 if (bitset_get(keys
, KEY_POWER
) ||
242 bitset_get(keys
, KEY_POWER2
) ||
243 bitset_get(keys
, KEY_SLEEP
) ||
244 bitset_get(keys
, KEY_SUSPEND
))
248 if (bitset_get(types
, EV_SW
)) {
249 unsigned long switches
[CONST_MAX(SW_LID
, SW_DOCK
)/ULONG_BITS
+1];
251 if (ioctl(b
->fd
, EVIOCGBIT(EV_SW
, sizeof(switches
)), switches
) < 0)
254 if (bitset_get(switches
, SW_LID
) ||
255 bitset_get(switches
, SW_DOCK
))
262 static int button_set_mask(Button
*b
) {
264 types
[CONST_MAX(EV_KEY
, EV_SW
)/ULONG_BITS
+1] = {},
265 keys
[CONST_MAX4(KEY_POWER
, KEY_POWER2
, KEY_SLEEP
, KEY_SUSPEND
)/ULONG_BITS
+1] = {},
266 switches
[CONST_MAX(SW_LID
, SW_DOCK
)/ULONG_BITS
+1] = {};
267 struct input_mask mask
;
272 bitset_put(types
, EV_KEY
);
273 bitset_put(types
, EV_SW
);
275 mask
= (struct input_mask
) {
277 .codes_size
= sizeof(types
),
278 .codes_ptr
= PTR_TO_UINT64(types
),
281 if (ioctl(b
->fd
, EVIOCSMASK
, &mask
) < 0)
282 /* Log only at debug level if the kernel doesn't do EVIOCSMASK yet */
283 return log_full_errno(IN_SET(errno
, ENOTTY
, EOPNOTSUPP
, EINVAL
) ? LOG_DEBUG
: LOG_WARNING
,
284 errno
, "Failed to set EV_SYN event mask on /dev/input/%s: %m", b
->name
);
286 bitset_put(keys
, KEY_POWER
);
287 bitset_put(keys
, KEY_POWER2
);
288 bitset_put(keys
, KEY_SLEEP
);
289 bitset_put(keys
, KEY_SUSPEND
);
291 mask
= (struct input_mask
) {
293 .codes_size
= sizeof(keys
),
294 .codes_ptr
= PTR_TO_UINT64(keys
),
297 if (ioctl(b
->fd
, EVIOCSMASK
, &mask
) < 0)
298 return log_warning_errno(errno
, "Failed to set EV_KEY event mask on /dev/input/%s: %m", b
->name
);
300 bitset_put(switches
, SW_LID
);
301 bitset_put(switches
, SW_DOCK
);
303 mask
= (struct input_mask
) {
305 .codes_size
= sizeof(switches
),
306 .codes_ptr
= PTR_TO_UINT64(switches
),
309 if (ioctl(b
->fd
, EVIOCSMASK
, &mask
) < 0)
310 return log_warning_errno(errno
, "Failed to set EV_SW event mask on /dev/input/%s: %m", b
->name
);
315 int button_open(Button
*b
) {
321 b
->fd
= safe_close(b
->fd
);
323 p
= strjoina("/dev/input/", b
->name
);
325 b
->fd
= open(p
, O_RDWR
|O_CLOEXEC
|O_NOCTTY
|O_NONBLOCK
);
327 return log_warning_errno(errno
, "Failed to open %s: %m", p
);
329 r
= button_suitable(b
);
331 return log_warning_errno(r
, "Failed to determine whether input device is relevant to us: %m");
333 log_debug("Device %s does not expose keys or switches relevant to us, ignoring.", p
);
334 return -EADDRNOTAVAIL
;
337 if (ioctl(b
->fd
, EVIOCGNAME(sizeof(name
)), name
) < 0) {
338 r
= log_error_errno(errno
, "Failed to get input name: %m");
342 (void) button_set_mask(b
);
344 r
= sd_event_add_io(b
->manager
->event
, &b
->io_event_source
, b
->fd
, EPOLLIN
, button_dispatch
, b
);
346 log_error_errno(r
, "Failed to add button event: %m");
350 log_info("Watching system buttons on /dev/input/%s (%s)", b
->name
, name
);
355 b
->fd
= safe_close(b
->fd
);
359 int button_check_switches(Button
*b
) {
360 unsigned long switches
[CONST_MAX(SW_LID
, SW_DOCK
)/ULONG_BITS
+1] = {};
366 if (ioctl(b
->fd
, EVIOCGSW(sizeof(switches
)), switches
) < 0)
369 b
->lid_closed
= bitset_get(switches
, SW_LID
);
370 b
->docked
= bitset_get(switches
, SW_DOCK
);
373 button_install_check_event_source(b
);