2d62c530d2
This should make operation nicer with docking stations, but will not cover anything that does not implement SW_DOCK.
284 lines
8.4 KiB
C
284 lines
8.4 KiB
C
/*-*- Mode: C; c-basic-offset: 8; indent-tabs-mode: nil -*-*/
|
|
|
|
/***
|
|
This file is part of systemd.
|
|
|
|
Copyright 2012 Lennart Poettering
|
|
|
|
systemd is free software; you can redistribute it and/or modify it
|
|
under the terms of the GNU Lesser General Public License as published by
|
|
the Free Software Foundation; either version 2.1 of the License, or
|
|
(at your option) any later version.
|
|
|
|
systemd is distributed in the hope that it will be useful, but
|
|
WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
Lesser General Public License for more details.
|
|
|
|
You should have received a copy of the GNU Lesser General Public License
|
|
along with systemd; If not, see <http://www.gnu.org/licenses/>.
|
|
***/
|
|
|
|
#include <assert.h>
|
|
#include <string.h>
|
|
#include <errno.h>
|
|
#include <fcntl.h>
|
|
#include <sys/ioctl.h>
|
|
#include <unistd.h>
|
|
#include <linux/input.h>
|
|
|
|
#include "sd-messages.h"
|
|
#include "conf-parser.h"
|
|
#include "util.h"
|
|
#include "special.h"
|
|
#include "logind-button.h"
|
|
|
|
Button* button_new(Manager *m, const char *name) {
|
|
Button *b;
|
|
|
|
assert(m);
|
|
assert(name);
|
|
|
|
b = new0(Button, 1);
|
|
if (!b)
|
|
return NULL;
|
|
|
|
b->name = strdup(name);
|
|
if (!b->name) {
|
|
free(b);
|
|
return NULL;
|
|
}
|
|
|
|
if (hashmap_put(m->buttons, b->name, b) < 0) {
|
|
free(b->name);
|
|
free(b);
|
|
return NULL;
|
|
}
|
|
|
|
b->manager = m;
|
|
b->fd = -1;
|
|
|
|
return b;
|
|
}
|
|
|
|
void button_free(Button *b) {
|
|
assert(b);
|
|
|
|
hashmap_remove(b->manager->buttons, b->name);
|
|
|
|
sd_event_source_unref(b->io_event_source);
|
|
sd_event_source_unref(b->check_event_source);
|
|
|
|
if (b->fd >= 0) {
|
|
/* If the device has been unplugged close() returns
|
|
* ENODEV, let's ignore this, hence we don't use
|
|
* close_nointr_nofail() */
|
|
close(b->fd);
|
|
}
|
|
|
|
free(b->name);
|
|
free(b->seat);
|
|
free(b);
|
|
}
|
|
|
|
int button_set_seat(Button *b, const char *sn) {
|
|
char *s;
|
|
|
|
assert(b);
|
|
assert(sn);
|
|
|
|
s = strdup(sn);
|
|
if (!s)
|
|
return -ENOMEM;
|
|
|
|
free(b->seat);
|
|
b->seat = s;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int button_recheck(sd_event_source *e, void *userdata) {
|
|
Button *b = userdata;
|
|
|
|
assert(b);
|
|
assert(b->lid_closed);
|
|
|
|
manager_handle_action(b->manager, INHIBIT_HANDLE_LID_SWITCH, b->manager->handle_lid_switch, b->manager->lid_switch_ignore_inhibited, false);
|
|
return 1;
|
|
}
|
|
|
|
static int button_install_check_event_source(Button *b) {
|
|
int r;
|
|
assert(b);
|
|
|
|
/* Install a post handler, so that we keep rechecking as long as the lid is closed. */
|
|
|
|
if (b->check_event_source)
|
|
return 0;
|
|
|
|
r = sd_event_add_post(b->manager->event, &b->check_event_source, button_recheck, b);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
return sd_event_source_set_priority(b->check_event_source, SD_EVENT_PRIORITY_IDLE+1);
|
|
}
|
|
|
|
static int button_dispatch(sd_event_source *s, int fd, uint32_t revents, void *userdata) {
|
|
Button *b = userdata;
|
|
struct input_event ev;
|
|
ssize_t l;
|
|
|
|
assert(s);
|
|
assert(fd == b->fd);
|
|
assert(b);
|
|
|
|
l = read(b->fd, &ev, sizeof(ev));
|
|
if (l < 0)
|
|
return errno != EAGAIN ? -errno : 0;
|
|
if ((size_t) l < sizeof(ev))
|
|
return -EIO;
|
|
|
|
if (ev.type == EV_KEY && ev.value > 0) {
|
|
|
|
switch (ev.code) {
|
|
|
|
case KEY_POWER:
|
|
case KEY_POWER2:
|
|
log_struct(LOG_INFO,
|
|
"MESSAGE=Power key pressed.",
|
|
MESSAGE_ID(SD_MESSAGE_POWER_KEY),
|
|
NULL);
|
|
|
|
manager_handle_action(b->manager, INHIBIT_HANDLE_POWER_KEY, b->manager->handle_power_key, b->manager->power_key_ignore_inhibited, true);
|
|
break;
|
|
|
|
/* The kernel is a bit confused here:
|
|
|
|
KEY_SLEEP = suspend-to-ram, which everybody else calls "suspend"
|
|
KEY_SUSPEND = suspend-to-disk, which everybody else calls "hibernate"
|
|
*/
|
|
|
|
case KEY_SLEEP:
|
|
log_struct(LOG_INFO,
|
|
"MESSAGE=Suspend key pressed.",
|
|
MESSAGE_ID(SD_MESSAGE_SUSPEND_KEY),
|
|
NULL);
|
|
|
|
manager_handle_action(b->manager, INHIBIT_HANDLE_SUSPEND_KEY, b->manager->handle_suspend_key, b->manager->suspend_key_ignore_inhibited, true);
|
|
break;
|
|
|
|
case KEY_SUSPEND:
|
|
log_struct(LOG_INFO,
|
|
"MESSAGE=Hibernate key pressed.",
|
|
MESSAGE_ID(SD_MESSAGE_HIBERNATE_KEY),
|
|
NULL);
|
|
|
|
manager_handle_action(b->manager, INHIBIT_HANDLE_HIBERNATE_KEY, b->manager->handle_hibernate_key, b->manager->hibernate_key_ignore_inhibited, true);
|
|
break;
|
|
}
|
|
|
|
} else if (ev.type == EV_SW && ev.value > 0) {
|
|
|
|
if (ev.code == SW_LID) {
|
|
log_struct(LOG_INFO,
|
|
"MESSAGE=Lid closed.",
|
|
MESSAGE_ID(SD_MESSAGE_LID_CLOSED),
|
|
NULL);
|
|
|
|
b->lid_closed = true;
|
|
manager_handle_action(b->manager, INHIBIT_HANDLE_LID_SWITCH, b->manager->handle_lid_switch, b->manager->lid_switch_ignore_inhibited, true);
|
|
button_install_check_event_source(b);
|
|
|
|
} else if (ev.code == SW_DOCK) {
|
|
log_struct(LOG_INFO,
|
|
"MESSAGE=System docked.",
|
|
MESSAGE_ID(SD_MESSAGE_SYSTEM_DOCKED),
|
|
NULL);
|
|
|
|
b->docked = true;
|
|
}
|
|
|
|
} else if (ev.type == EV_SW && ev.value == 0) {
|
|
|
|
if (ev.code == SW_LID) {
|
|
log_struct(LOG_INFO,
|
|
"MESSAGE=Lid opened.",
|
|
MESSAGE_ID(SD_MESSAGE_LID_OPENED),
|
|
NULL);
|
|
|
|
b->lid_closed = false;
|
|
b->check_event_source = sd_event_source_unref(b->check_event_source);
|
|
|
|
} else if (ev.code == SW_DOCK) {
|
|
log_struct(LOG_INFO,
|
|
"MESSAGE=System undocked.",
|
|
MESSAGE_ID(SD_MESSAGE_SYSTEM_UNDOCKED),
|
|
NULL);
|
|
|
|
b->docked = false;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int button_open(Button *b) {
|
|
char *p, name[256];
|
|
int r;
|
|
|
|
assert(b);
|
|
|
|
if (b->fd >= 0) {
|
|
close(b->fd);
|
|
b->fd = -1;
|
|
}
|
|
|
|
p = strappenda("/dev/input/", b->name);
|
|
|
|
b->fd = open(p, O_RDWR|O_CLOEXEC|O_NOCTTY|O_NONBLOCK);
|
|
if (b->fd < 0) {
|
|
log_warning("Failed to open %s: %m", b->name);
|
|
return -errno;
|
|
}
|
|
|
|
if (ioctl(b->fd, EVIOCGNAME(sizeof(name)), name) < 0) {
|
|
log_error("Failed to get input name: %m");
|
|
r = -errno;
|
|
goto fail;
|
|
}
|
|
|
|
r = sd_event_add_io(b->manager->event, &b->io_event_source, b->fd, EPOLLIN, button_dispatch, b);
|
|
if (r < 0) {
|
|
log_error("Failed to add button event: %s", strerror(-r));
|
|
goto fail;
|
|
}
|
|
|
|
log_info("Watching system buttons on /dev/input/%s (%s)", b->name, name);
|
|
|
|
return 0;
|
|
|
|
fail:
|
|
close(b->fd);
|
|
b->fd = -1;
|
|
return r;
|
|
}
|
|
|
|
int button_check_switches(Button *b) {
|
|
uint8_t switches[SW_MAX/8+1] = {};
|
|
assert(b);
|
|
|
|
if (b->fd < 0)
|
|
return -EINVAL;
|
|
|
|
if (ioctl(b->fd, EVIOCGSW(sizeof(switches)), switches) < 0)
|
|
return -errno;
|
|
|
|
b->lid_closed = (switches[SW_LID/8] >> (SW_LID % 8)) & 1;
|
|
b->docked = (switches[SW_DOCK/8] >> (SW_DOCK % 8)) & 1;
|
|
|
|
if (b->lid_closed)
|
|
button_install_check_event_source(b);
|
|
|
|
return 0;
|
|
}
|