path: root/rcm-server-keymap.c

#define _GNU_SOURCE
#include <stdio.h>
#include <stdbool.h>
#include <stdlib.h>
#include <stdint.h>
#include <string.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <dirent.h>
#include <unistd.h>
#include <ctype.h>
#include <errno.h>
#include <limits.h>

#include "utils.h"
#include "rcm-server-main.h"
#include "rcm-server-keymap.h"

enum ini_section {
	INI_SECTION_UNDEFINED,
	INI_SECTION_DESCRIPTION,
	INI_SECTION_KEYMAP,
	INI_SECTION_LAYOUT,
};

struct inis {
	const char *name;
	enum ini_section value;
};

struct inis iniss[] = {
	{ .name = "Description", .value = INI_SECTION_DESCRIPTION },
	{ .name = "Keymap", .value = INI_SECTION_KEYMAP },
	{ .name = "Layout", .value = INI_SECTION_LAYOUT },
	{ .name = NULL, .value = INI_SECTION_UNDEFINED },
};

static int strtol_strict(const char *str, int *result)
{
	char *end;
	long val;

	errno = 0;
	val = strtol(str, &end, 10);

	if (errno == ERANGE && (val == LONG_MAX || val == LONG_MIN))
		return -EINVAL;

	if (errno != 0 && val == 0)
		return -EINVAL;

	if (end == str)
		return -EINVAL;

	if (*end != '\0')
		return -EINVAL;

	if (val < 1 || val > UINT16_MAX)
		return -EINVAL;

	*result = val;
	return 0;
}

static int strtoull_strict(const char *str, uint64_t *result)
{
	char *end;
	unsigned long long val;

	errno = 0;
	val = strtoull(str, &end, 16);

	if (errno == ERANGE && (val == ULLONG_MAX || val == 0))
		return -EINVAL;

	if (errno != 0 && val == 0)
		return -EINVAL;

	if (end == str)
		return -EINVAL;

	if (*end != '\0')
		return -EINVAL;

	if (val > UINT64_MAX)
		return -EINVAL;

	*result = val;
	return 0;
}

static int
keymap_parse(FILE *fp, char **line, size_t *buf_size, struct keymap *keymap,
	     uint16_t *rows_return, uint16_t *cols_return,
	     unsigned *keycode_count_return)
{
	unsigned keycode_count = 0;
	unsigned layout_count = 0;
	int rows = -1;
	int cols = -1;
	unsigned i;
	enum ini_section current_section = INI_SECTION_UNDEFINED;
	int r;

	rewind(fp);

	while (getline(line, buf_size, fp) != -1) {
		char *p, *tmp;

		p = strchr(*line, '\n');
		if (!p)
			continue;
		*p = '\0';

		p = *line;
		while (isspace(*p))
			p++;

		if (*p == '\0' || *p == ';' || *p == '#')
			continue;

		if (*p == '[') {
			p++;
			tmp = strchr(p, ']');
			if (!tmp)
				continue;
			*tmp = '\0';

			for (i = 0; iniss[i].name; i++) {
				if (strcasecmp(iniss[i].name, p))
					continue;
				current_section = iniss[i].value;
				break;
			}

			if (!iniss[i].name)
				current_section = INI_SECTION_UNDEFINED;

			continue;
		}

		tmp = strchr(p, '=');
		if (!tmp)
			continue;

		*tmp++ = '\0';
		while (isspace(*tmp))
			tmp++;

		if (*tmp == '\0')
			continue;

		/* FIXME: eat RHS whitespace for p */
		switch (current_section) {
		case INI_SECTION_DESCRIPTION:
			if (!keymap)
				continue;

			if (!strcasecmp(p, "Name")) {
				keymap->name = strdup(tmp);
				if (!keymap->name)
					return -ENOMEM;
			} else if (!strcasecmp(p, "Description")) {
				keymap->desc = strdup(tmp);
				if (!keymap->desc)
					return -ENOMEM;
			}
			break;
		case INI_SECTION_KEYMAP:
			if (!strcasecmp(p, "Map")) {
				char *protocol;
				char *scanstr;
				char *keycode;
				char *end;
				uint64_t scancode;

				printf("Map %s\n", tmp);
				protocol = strtok(tmp,  " :");
				scanstr = strtok(NULL, " :");
				keycode  = strtok(NULL, " :");
				end      = strtok(NULL, " :");

				if (!protocol || !scancode || !keycode || end) {
					fprintf(stderr, "Invalid map directive\n");
					return -ENOMEM;
				}

				r = strtoull_strict(scanstr, &scancode);
				if (r < 0) {
					fprintf(stderr, "Invalid scancode value\n");
					return r;
				}

				printf("Map means protocol %s scancode 0x%08" PRIx64 " keycode %s\n",
				       protocol, scancode, keycode);

				if (keymap) {
					/* FIXME: leaks */
					keymap->keycodes[keycode_count].protocol = strdup(protocol);
					keymap->keycodes[keycode_count].scancode = scancode;
					keymap->keycodes[keycode_count].keycode  = strdup(keycode);
				}
				keycode_count++;
			} else {
				fprintf(stderr, "Unknown parameter: %s\n", p);
			}

			break;
		case INI_SECTION_LAYOUT:
			if (!strcasecmp(p, "Rows")) {
				if (rows >= 0) {
					fprintf(stderr, "Multiple rows specifications\n");
					return -EINVAL;
				}

				r = strtol_strict(tmp, &rows);
				if (r < 0) {
					fprintf(stderr, "Invalid rows specification\n");
					return -EINVAL;
				}

			} else if (!strcasecmp(p, "Cols")) {
				if (cols >= 0) {
					fprintf(stderr, "Multiple cols specifications\n");
					return -EINVAL;
				}

				r = strtol_strict(tmp, &cols);
				if (r < 0) {
					fprintf(stderr, "Invalid cols specification\n");
					return -EINVAL;
				}

			} else if (!strcasecmp(p, "Button")) {
				if (keymap) {
					if (!strcasecmp(tmp, "Blank"))
						keymap->layout[layout_count] = NULL;
					else
						keymap->layout[layout_count] = &keymap->keycodes[1];
				}
				layout_count++;

			} else {
				fprintf(stderr, "Unknown parameter: %s\n", p);
			}
			break;
		case INI_SECTION_UNDEFINED:
			break;
		default:
			printf("Line: %i - %s = %s\n", current_section, p, tmp);
			break;
		}
	}

	if (rows < 0) {
		fprintf(stderr, "Rows specification missing\n");
		return -EINVAL;
	}

	if (cols < 0) {
		fprintf(stderr, "Cols specification missing\n");
		return -EINVAL;
	}

	if (keycode_count < 1) {
		fprintf(stderr, "No keycodes found\n");
		return -EINVAL;
	}

	if (layout_count < 1) {
		fprintf(stderr, "No layout found\n");
		return -EINVAL;
	}

	if (rows * cols != layout_count) {
		fprintf(stderr, "Layout (%u) does not match rows x cols (%ux%u)\n",
			layout_count, rows, cols);
		return -EINVAL;
	}

	if (keymap) {
		keymap->rows = rows;
		keymap->cols = cols;
		keymap->keycode_count = keycode_count;
	}

	if (rows_return)
		*rows_return = rows;

	if (cols_return)
		*cols_return = cols;

	if (keycode_count_return)
		*keycode_count_return = keycode_count;

	return 0;
}

static struct keymap *
keymap_read(int dfd, const char *name)
{
	_cleanup_close_ int fd = -1;
	_cleanup_fclose_ FILE *fp = NULL;
	_cleanup_free_ char *line = NULL;
	struct keymap *keymap = NULL;
	uint16_t cols, rows;
	unsigned keycode_count;
	size_t buf_size = 0;
	int r;

	if (dfd < 0 || !name)
		return NULL;

	fd = openat(dfd, name, O_RDONLY);
	if (fd < 0)
		return NULL;

	fp = fdopen(fd, "r");
	if (!fp)
		return NULL;
	fd = -1;

	r = keymap_parse(fp, &line, &buf_size, NULL, &rows, &cols, &keycode_count);
	if (r < 0) {
		fprintf(stderr, "Invalid keymap: %s\n", name);
		return NULL;
	}

	keymap = zmalloc(sizeof(*keymap) + sizeof(struct keycode) * keycode_count);
	if (!keymap)
		return NULL;

	keymap->layout = zmalloc(sizeof(struct keycode *) * cols * rows);
	if (!keymap->layout) {
		free(keymap);
		return NULL;
	}

	keymap_parse(fp, &line, &buf_size, keymap, NULL, NULL, NULL);
	return keymap;
}

static int
keymaps_load_dir(struct device *device, const char *path)
{
	_cleanup_closedir_ DIR *dir = NULL;
	int dfd;
	struct dirent *dent;
	struct keymap *keymap;

	dir = opendir(path);
	if (!dir)
		return -1;

	dfd = dirfd(dir);
	if (dfd < 0)
		return -1;

	while ((dent = readdir(dir))) {
		switch (dent->d_type) {
		case DT_REG:
		case DT_LNK:
		case DT_UNKNOWN:
			keymap = find_keymap_by_name(device, dent->d_name);
			if (keymap)
				continue;
			keymap = keymap_read(dfd, dent->d_name);
			if (keymap) {
				printf("Keymap added (0x%p)\n", keymap);
				printf("\tDescription: %s\n", keymap->desc);
				printf("\tName: %s\n", keymap->name);
				list_add(&keymap->list, &device->keymaps);
			}
			break;
		default:
			break;
		}
	}

	return 0;
}

int
keymaps_load(struct device *device)
{
	char pdpath[strlen("./keymaps/per-device/") + strlen(device->name) + 1];

	sprintf(pdpath, "./keymaps/per-device/%s", device->name);

	printf("Loading per-device keymaps...\n");
	keymaps_load_dir(device, pdpath);
	printf("Loading default keymaps...\n");
	keymaps_load_dir(device, "./keymaps/default");

	return 0;
}

void
keymap_free(struct keymap *keymap)
{
	free(keymap->layout);
	free(keymap->name);
	free(keymap->desc);
	free(keymap);
}

struct keymap *
find_keymap_by_name(struct device *dev, const char *name)
{
	struct keymap *keymap;

	list_for_each_entry(keymap, &dev->keymaps, list)
		if (!strcmp(keymap->name, name))
			return keymap;

	return NULL;
}