kmscon/src/input.c

/*
 * kmscon - udev input hotplug and evdev handling
 *
 * Copyright (c) 2011 Ran Benita <ran234@gmail.com>
 *
 * Permission is hereby granted, free of charge, to any person obtaining
 * a copy of this software and associated documentation files
 * (the "Software"), to deal in the Software without restriction, including
 * without limitation the rights to use, copy, modify, merge, publish,
 * distribute, sublicense, and/or sell copies of the Software, and to
 * permit persons to whom the Software is furnished to do so, subject to
 * the following conditions:
 *
 * The above copyright notice and this permission notice shall be included
 * in all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
 * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
 * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
 * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
 * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
 */

/*
 * The main object kmscon_input discovers and monitors input devices, and
 * adds/removes them accordingly from the devices linked list.
 *
 * The udev monitor keeps running even while the object is in INPUT_ASLEEP.
 * We do this because we'll either lose track of the devices, or otherwise
 * have to re-scan the devices at every wakeup.
 *
 * The kmscon_input_device objects hold the file descriptors for their device
 * nodes. All events go through the input-object callback; there is currently
 * no "routing" or any differentiation between them. When the input is put to
 * sleep, all fd's are closed. When woken up, they are opened. There should be
 * not spurious events delivered. The initial state depends on the
 * kmscon_input's state.
 */

#include <errno.h>
#include <fcntl.h>
#include <libudev.h>
#include <linux/input.h>
#include <stdbool.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>

#include "eloop.h"
#include "input.h"
#include "input_xkb.h"
#include "log.h"

enum input_state {
	INPUT_ASLEEP,
	INPUT_AWAKE,
};

struct kmscon_input_device {
	size_t ref;
	struct kmscon_input_device *next;
	struct kmscon_input *input;

	int rfd;
	char *devnode;
	struct kmscon_fd *fd;

	struct xkb_state xkb_state;
};

struct kmscon_input {
	size_t ref;
	enum input_state state;
	struct kmscon_input_device *devices;

	struct kmscon_eloop *eloop;
	kmscon_input_cb cb;
	void *data;

	struct udev *udev;
	struct udev_monitor *monitor;
	struct kmscon_fd *monitor_fd;

	struct xkb_desc *xkb_desc;
};

static void remove_device(struct kmscon_input *input, const char *node);

static void notify_key(struct kmscon_input_device *device,
				uint16_t type, uint16_t code, int32_t value)
{
	struct kmscon_input_event ev;
	bool has_event;
	struct kmscon_input *input;

	if (type != EV_KEY)
		return;

	input = device->input;
	has_event = kmscon_xkb_process_evdev_key(input->xkb_desc,
					&device->xkb_state, value, code, &ev);

	if (has_event)
		input->cb(input, &ev, input->data);
}

static void device_data_arrived(struct kmscon_fd *fd, int mask, void *data)
{
	int i;
	ssize_t len, n;
	struct kmscon_input_device *device = data;
	struct kmscon_input *input = device->input;
	struct input_event ev[16];

	len = sizeof(ev);
	while (len == sizeof(ev)) {
		len = read(device->rfd, &ev, sizeof(ev));
		if (len < 0) {
			if (errno == EWOULDBLOCK)
				break;

			log_warning("input: reading device %s failed %d\n",
						device->devnode, errno);
			remove_device(input, device->devnode);
		} else if (len == 0) {
			log_debug("input: EOF device %s\n", device->devnode);
			remove_device(input, device->devnode);
		} else if (len % sizeof(*ev)) {
			log_warning("input: read invalid input_event\n");
		} else {
			n = len / sizeof(*ev);
			for (i = 0; i < n; i++)
				notify_key(device, ev[i].type, ev[i].code,
								ev[i].value);
		}
	}
}

int kmscon_input_device_wake_up(struct kmscon_input_device *device)
{
	int ret;

	if (!device || !device->input || !device->input->eloop)
		return -EINVAL;

	if (device->fd)
		return 0;

	device->rfd = open(device->devnode, O_CLOEXEC | O_NONBLOCK | O_RDONLY);
	if (device->rfd < 0) {
		log_warning("input: cannot open input device %s: %d\n",
						device->devnode, errno);
		return -errno;
	}

	/* this rediscovers the xkb state if sth changed during sleep */
	kmscon_xkb_reset_state(device->input->xkb_desc, &device->xkb_state,
								device->rfd);

	ret = kmscon_eloop_new_fd(device->input->eloop, &device->fd,
		device->rfd, KMSCON_READABLE, device_data_arrived, device);
	if (ret) {
		close(device->rfd);
		device->rfd = -1;
		return ret;
	}

	return 0;
}

void kmscon_input_device_sleep(struct kmscon_input_device *device)
{
	if (!device)
		return;

	if (device->rfd < 0)
		return;

	kmscon_eloop_rm_fd(device->fd);
	device->fd = NULL;
	close(device->rfd);
	device->rfd = -1;
}

static int kmscon_input_device_new(struct kmscon_input_device **out,
			struct kmscon_input *input, const char *devnode)
{
	struct kmscon_input_device *device;

	if (!out || !input)
		return -EINVAL;

	log_debug("input: new input device %s\n", devnode);

	device = malloc(sizeof(*device));
	if (!device)
		return -ENOMEM;

	memset(device, 0, sizeof(*device));
	device->ref = 1;

	device->devnode = strdup(devnode);
	if (!device->devnode) {
		free(device);
		return -ENOMEM;
	}

	device->input = input;
	device->rfd = -1;

	*out = device;
	return 0;
}

static void kmscon_input_device_ref(struct kmscon_input_device *device)
{
	if (!device)
		return;

	++device->ref;
}

static void kmscon_input_device_unref(struct kmscon_input_device *device)
{
	if (!device || !device->ref)
		return;

	if (--device->ref)
		return;

	kmscon_input_device_sleep(device);
	log_debug("input: destroying input device %s\n", device->devnode);
	free(device->devnode);
	free(device);
}

int kmscon_input_new(struct kmscon_input **out)
{
	int ret;
	struct kmscon_input *input;
	static const char *layout, *variant, *options;

	if (!out)
		return -EINVAL;

	input = malloc(sizeof(*input));
	if (!input)
		return -ENOMEM;

	log_debug("input: creating input object\n");

	memset(input, 0, sizeof(*input));
	input->ref = 1;
	input->state = INPUT_ASLEEP;

	/* TODO: Make properly configurable */
	layout = getenv("KMSCON_XKB_LAYOUT") ?: "us";
	variant = getenv("KMSCON_XKB_VARIANT") ?: "";
	options = getenv("KMSCON_XKB_OPTIONS") ?: "";

	ret = kmscon_xkb_new_desc(layout, variant, options, &input->xkb_desc);
	if (ret) {
		log_warning("input: cannot create xkb description\n");
		goto err_free;
	}

	input->udev = udev_new();
	if (!input->udev) {
		log_warning("input: cannot create udev object\n");
		ret = -EFAULT;
		goto err_xkb;
	}

	input->monitor = udev_monitor_new_from_netlink(input->udev, "udev");
	if (!input->monitor) {
		log_warning("input: cannot create udev monitor\n");
		ret = -EFAULT;
		goto err_udev;
	}

	ret = udev_monitor_filter_add_match_subsystem_devtype(input->monitor,
								"input", NULL);
	if (ret) {
		log_warning("input: cannot add udev filter\n");
		ret = -EFAULT;
		goto err_monitor;
	}

	ret = udev_monitor_enable_receiving(input->monitor);
	if (ret) {
		log_warning("input: cannot start udev monitor\n");
		ret = -EFAULT;
		goto err_monitor;
	}

	*out = input;
	return 0;

err_monitor:
	udev_monitor_unref(input->monitor);
err_udev:
	udev_unref(input->udev);
err_xkb:
	kmscon_xkb_free_desc(input->xkb_desc);
err_free:
	free(input);
	return ret;
}

void kmscon_input_ref(struct kmscon_input *input)
{
	if (!input)
		return;

	++input->ref;
}

void kmscon_input_unref(struct kmscon_input *input)
{
	if (!input || !input->ref)
		return;

	if (--input->ref)
		return;

	kmscon_input_disconnect_eloop(input);
	udev_monitor_unref(input->monitor);
	udev_unref(input->udev);
	kmscon_xkb_free_desc(input->xkb_desc);
	free(input);
	log_debug("input: destroying input object\n");
}

static void add_device(struct kmscon_input *input,
					struct udev_device *udev_device)
{
	int ret;
	struct kmscon_input_device *device;
	const char *value, *node;

	if (!input || !udev_device)
		return;

	/*
	 * TODO: Here should go a proper filtering of input devices we're
	 * interested in. Currently, we add all kinds of devices. A simple
	 * blacklist should be the easiest way.
	 */

	node = udev_device_get_devnode(udev_device);
	if (!node)
		return;

	value = udev_device_get_property_value(udev_device,
							"ID_INPUT_KEYBOARD");
	if (!value || strcmp(value, "1")) {
		log_debug("input: ignoring non-keyboard device %s\n", node);
		return;
	}

	ret = kmscon_input_device_new(&device, input, node);
	if (ret) {
		log_warning("input: cannot create input device for %s\n",
									node);
		return;
	}

	if (input->state == INPUT_AWAKE) {
		ret = kmscon_input_device_wake_up(device);
		if (ret) {
			log_warning("input: cannot wake up new device %s\n",
									node);
			kmscon_input_device_unref(device);
			return;
		}
	}

	device->next = input->devices;
	input->devices = device;
	log_debug("input: added device %s\n", node);
}

static void remove_device(struct kmscon_input *input, const char *node)
{
	struct kmscon_input_device *iter, *prev;

	if (!input || !node || !input->devices)
		return;

	iter = input->devices;
	prev = NULL;

	while (iter) {
		if (!strcmp(iter->devnode, node)) {
			if (prev == NULL)
				input->devices = iter->next;
			else
				prev->next = iter->next;

			kmscon_input_device_unref(iter);
			log_debug("input: removed device %s\n", node);
			break;
		}

		prev = iter;
		iter = iter->next;
	}
}

static void remove_device_udev(struct kmscon_input *input,
					struct udev_device *udev_device)
{
	const char *node;

	if (!udev_device)
		return;

	node = udev_device_get_devnode(udev_device);
	if (!node)
		return;

	remove_device(input, node);
}

static void device_changed(struct kmscon_fd *fd, int mask, void *data)
{
	struct kmscon_input *input = data;
	struct udev_device *udev_device;
	const char *action;

	udev_device = udev_monitor_receive_device(input->monitor);
	if (!udev_device)
		return;

	action = udev_device_get_action(udev_device);
	if (!action) {
		log_warning("input: cannot get action field of new device\n");
		goto err_device;
	}

	if (!strcmp(action, "add"))
		add_device(input, udev_device);
	else if (!strcmp(action, "remove"))
		remove_device_udev(input, udev_device);

err_device:
	udev_device_unref(udev_device);
}

static void add_initial_devices(struct kmscon_input *input)
{
	int ret;
	struct udev_enumerate *e;
	struct udev_list_entry *first;
	struct udev_list_entry *item;
	struct udev_device *udev_device;
	const char *syspath;

	e = udev_enumerate_new(input->udev);
	if (!e) {
		log_warning("input: cannot create udev enumeration\n");
		return;
	}

	ret = udev_enumerate_add_match_subsystem(e, "input");
	if (ret) {
		log_warning("input: cannot add match to udev enumeration\n");
		goto err_enum;
	}

	ret = udev_enumerate_scan_devices(e);
	if (ret) {
		log_warning("input: cannot scan udev enumeration\n");
		goto err_enum;
	}

	first = udev_enumerate_get_list_entry(e);
	udev_list_entry_foreach(item, first) {
		syspath = udev_list_entry_get_name(item);
		if (!syspath)
			continue;

		udev_device = udev_device_new_from_syspath(input->udev, syspath);
		if (!udev_device) {
			log_warning("input: cannot create device "
							"from udev path\n");
			continue;
		}

		add_device(input, udev_device);
		udev_device_unref(udev_device);
	}

err_enum:
	udev_enumerate_unref(e);
}

int kmscon_input_connect_eloop(struct kmscon_input *input,
		struct kmscon_eloop *eloop, kmscon_input_cb cb, void *data)
{
	int ret;
	int fd;

	if (!input || !eloop || !cb)
		return -EINVAL;

	if (input->eloop)
		return -EALREADY;

	fd = udev_monitor_get_fd(input->monitor);
	ret = kmscon_eloop_new_fd(eloop, &input->monitor_fd, fd,
				KMSCON_READABLE, device_changed, input);
	if (ret)
		return ret;

	kmscon_eloop_ref(eloop);
	input->eloop = eloop;
	input->cb = cb;
	input->data = data;

	add_initial_devices(input);

	return 0;
}

void kmscon_input_disconnect_eloop(struct kmscon_input *input)
{
	struct kmscon_input_device *tmp;

	if (!input || !input->eloop)
		return;

	while (input->devices) {
		tmp = input->devices;
		input->devices = tmp->next;
		kmscon_input_device_unref(tmp);
	}

	kmscon_eloop_rm_fd(input->monitor_fd);
	input->monitor_fd = NULL;
	kmscon_eloop_unref(input->eloop);
	input->eloop = NULL;
	input->cb = NULL;
	input->data = NULL;
}

void kmscon_input_sleep(struct kmscon_input *input)
{
	struct kmscon_input_device *iter;

	if (!input)
		return;

	for (iter = input->devices; iter; iter = iter->next)
		kmscon_input_device_sleep(iter);

	input->state = INPUT_ASLEEP;
}

void kmscon_input_wake_up(struct kmscon_input *input)
{
	struct kmscon_input_device *iter, *prev, *tmp;
	int ret;

	if (!input)
		return;

	prev = NULL;
	iter = input->devices;

	while (iter) {
		ret = kmscon_input_device_wake_up(iter);
		if (ret) {
			if (!prev)
				input->devices = iter->next;
			else
				prev->next = iter->next;

			tmp = iter;
			iter = iter->next;

			log_warning("input: device %s does not wake up, "
					"removing device\n", tmp->devnode);
			kmscon_input_device_unref(tmp);
		} else {
			prev = iter;
			iter = iter->next;
		}
	}

	input->state = INPUT_AWAKE;
}

bool kmscon_input_is_asleep(struct kmscon_input *input)
{
	if (!input)
		return false;

	return input->state == INPUT_ASLEEP;
}