494 lines
11 KiB
C
494 lines
11 KiB
C
|
/*
|
||
|
* Copyright © 2012 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 (including the next
|
||
|
* paragraph) 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.
|
||
|
*/
|
||
|
|
||
|
#include <dirent.h>
|
||
|
#include <errno.h>
|
||
|
#include <fcntl.h>
|
||
|
#include <fnmatch.h>
|
||
|
#include <limits.h>
|
||
|
#include <locale.h>
|
||
|
#include <signal.h>
|
||
|
#include <stdbool.h>
|
||
|
#include <stdio.h>
|
||
|
#include <stdlib.h>
|
||
|
#include <string.h>
|
||
|
#include <sysexits.h>
|
||
|
#include <unistd.h>
|
||
|
|
||
|
#include <sys/epoll.h>
|
||
|
#include <linux/input.h>
|
||
|
|
||
|
#include "xkbcommon/xkbcommon.h"
|
||
|
|
||
|
struct keyboard {
|
||
|
char *path;
|
||
|
int fd;
|
||
|
struct xkb_state *state;
|
||
|
struct keyboard *next;
|
||
|
};
|
||
|
|
||
|
bool terminate;
|
||
|
|
||
|
#define NLONGS(n) (((n) + LONG_BIT - 1) / LONG_BIT)
|
||
|
|
||
|
static bool
|
||
|
evdev_bit_is_set(const unsigned long *array, int bit)
|
||
|
{
|
||
|
return !!(array[bit / LONG_BIT] & (1LL << (bit % LONG_BIT)));
|
||
|
}
|
||
|
|
||
|
/* Some heuristics to see if the device is a keyboard. */
|
||
|
static bool
|
||
|
is_keyboard(int fd)
|
||
|
{
|
||
|
int i;
|
||
|
unsigned long evbits[NLONGS(EV_CNT)] = { 0 };
|
||
|
unsigned long keybits[NLONGS(KEY_CNT)] = { 0 };
|
||
|
|
||
|
errno = 0;
|
||
|
ioctl(fd, EVIOCGBIT(0, sizeof(evbits)), evbits);
|
||
|
if (errno)
|
||
|
return false;
|
||
|
|
||
|
if (!evdev_bit_is_set(evbits, EV_KEY))
|
||
|
return false;
|
||
|
|
||
|
errno = 0;
|
||
|
ioctl(fd, EVIOCGBIT(EV_KEY, sizeof(keybits)), keybits);
|
||
|
if (errno)
|
||
|
return false;
|
||
|
|
||
|
for (i = KEY_RESERVED; i <= KEY_MIN_INTERESTING; i++)
|
||
|
if (evdev_bit_is_set(keybits, i))
|
||
|
return true;
|
||
|
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
keyboard_new(struct dirent *ent, struct xkb_keymap *xkb, struct keyboard **out)
|
||
|
{
|
||
|
int ret;
|
||
|
char *path;
|
||
|
int fd;
|
||
|
struct xkb_state *state;
|
||
|
struct keyboard *kbd;
|
||
|
|
||
|
ret = asprintf(&path, "/dev/input/%s", ent->d_name);
|
||
|
if (ret < 0)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
fd = open(path, O_NONBLOCK | O_CLOEXEC | O_RDONLY);
|
||
|
if (fd < 0) {
|
||
|
ret = -errno;
|
||
|
goto err_path;
|
||
|
}
|
||
|
|
||
|
if (!is_keyboard(fd)) {
|
||
|
/* Dummy "skip this device" value. */
|
||
|
ret = -ENOTSUP;
|
||
|
goto err_fd;
|
||
|
}
|
||
|
|
||
|
state = xkb_state_new(xkb);
|
||
|
if (!state) {
|
||
|
fprintf(stderr, "Couldn't create xkb state for %s\n", path);
|
||
|
ret = -EFAULT;
|
||
|
goto err_fd;
|
||
|
}
|
||
|
|
||
|
kbd = calloc(1, sizeof(*kbd));
|
||
|
if (!kbd) {
|
||
|
ret = -ENOMEM;
|
||
|
goto err_state;
|
||
|
}
|
||
|
|
||
|
kbd->path = path;
|
||
|
kbd->fd = fd;
|
||
|
kbd->state = state;
|
||
|
*out = kbd;
|
||
|
return 0;
|
||
|
|
||
|
err_state:
|
||
|
xkb_state_unref(state);
|
||
|
err_fd:
|
||
|
close(fd);
|
||
|
err_path:
|
||
|
free(path);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
keyboard_free(struct keyboard *kbd)
|
||
|
{
|
||
|
if (!kbd)
|
||
|
return;
|
||
|
if (kbd->fd >= 0)
|
||
|
close(kbd->fd);
|
||
|
free(kbd->path);
|
||
|
xkb_state_unref(kbd->state);
|
||
|
free(kbd);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
filter_device_name(const struct dirent *ent)
|
||
|
{
|
||
|
return !fnmatch("event*", ent->d_name, 0);
|
||
|
}
|
||
|
|
||
|
static struct keyboard *
|
||
|
get_keyboards(struct xkb_keymap *xkb)
|
||
|
{
|
||
|
int ret, i, nents;
|
||
|
struct dirent **ents;
|
||
|
struct keyboard *kbds = NULL, *kbd = NULL;
|
||
|
|
||
|
nents = scandir("/dev/input", &ents, filter_device_name, alphasort);
|
||
|
if (nents < 0) {
|
||
|
fprintf(stderr, "Couldn't scan /dev/input: %s\n", strerror(errno));
|
||
|
return NULL;
|
||
|
}
|
||
|
|
||
|
for (i = 0; i < nents; i++) {
|
||
|
ret = keyboard_new(ents[i], xkb, &kbd);
|
||
|
if (ret) {
|
||
|
if (ret == -EACCES) {
|
||
|
fprintf(stderr, "Couldn't open /dev/input/%s: %s. "
|
||
|
"You probably need root to run this.\n",
|
||
|
ents[i]->d_name, strerror(-ret));
|
||
|
break;
|
||
|
}
|
||
|
if (ret != -ENOTSUP) {
|
||
|
fprintf(stderr, "Couldn't open /dev/input/%s: %s. Skipping.\n",
|
||
|
ents[i]->d_name, strerror(-ret));
|
||
|
}
|
||
|
continue;
|
||
|
}
|
||
|
|
||
|
kbd->next = kbds;
|
||
|
kbds = kbd;
|
||
|
}
|
||
|
|
||
|
if (!kbds) {
|
||
|
fprintf(stderr, "Couldn't find any keyboards I can use! Quitting.\n");
|
||
|
goto err;
|
||
|
}
|
||
|
|
||
|
err:
|
||
|
for (i = 0; i < nents; i++)
|
||
|
free(ents[i]);
|
||
|
free(ents);
|
||
|
return kbds;
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
free_keyboards(struct keyboard *kbds)
|
||
|
{
|
||
|
struct keyboard *next;
|
||
|
|
||
|
while (kbds) {
|
||
|
next = kbds->next;
|
||
|
keyboard_free(kbds);
|
||
|
kbds = next;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
print_keycode(struct keyboard *kbd, xkb_keycode_t keycode)
|
||
|
{
|
||
|
unsigned int i;
|
||
|
struct xkb_keymap *xkb;
|
||
|
struct xkb_state *state;
|
||
|
|
||
|
const xkb_keysym_t *syms;
|
||
|
unsigned int nsyms;
|
||
|
char s[16];
|
||
|
uint32_t unicode;
|
||
|
xkb_group_index_t group;
|
||
|
xkb_mod_index_t mod;
|
||
|
xkb_led_index_t led;
|
||
|
|
||
|
state = kbd->state;
|
||
|
xkb = xkb_state_get_map(state);
|
||
|
|
||
|
nsyms = xkb_key_get_syms(state, keycode, &syms);
|
||
|
|
||
|
if (nsyms <= 0)
|
||
|
return;
|
||
|
|
||
|
printf("keysyms [ ");
|
||
|
for (i = 0; i < nsyms; i++) {
|
||
|
xkb_keysym_get_name(syms[i], s, sizeof(s));
|
||
|
printf("%-*s ", (int)sizeof(s), s);
|
||
|
}
|
||
|
printf("] ");
|
||
|
|
||
|
/*
|
||
|
* Only do this if wchar_t is UCS-4, so we can be lazy and print
|
||
|
* with %lc.
|
||
|
*/
|
||
|
#ifdef __STDC_ISO_10646__
|
||
|
printf("unicode [ ");
|
||
|
for (i = 0; i < nsyms; i++) {
|
||
|
unicode = xkb_keysym_to_utf32(syms[i]);
|
||
|
printf("%lc ", (int)(unicode ? unicode : L' '));
|
||
|
}
|
||
|
printf("] ");
|
||
|
#endif
|
||
|
|
||
|
printf("groups [ ");
|
||
|
for (group = 0; group < xkb_map_num_groups(xkb); group++) {
|
||
|
if (!xkb_state_group_index_is_active(state, group, XKB_STATE_EFFECTIVE))
|
||
|
continue;
|
||
|
printf("%s (%d) ", xkb_map_group_get_name(xkb, group), group);
|
||
|
}
|
||
|
printf("] ");
|
||
|
|
||
|
printf("mods [ ");
|
||
|
for (mod = 0; mod < xkb_map_num_mods(xkb); mod++) {
|
||
|
if (!xkb_state_mod_index_is_active(state, mod, XKB_STATE_EFFECTIVE))
|
||
|
continue;
|
||
|
printf("%s ", xkb_map_mod_get_name(xkb, mod));
|
||
|
}
|
||
|
printf("] ");
|
||
|
|
||
|
printf("leds [ ");
|
||
|
for (led = 0; led < xkb_map_num_leds(xkb); led++) {
|
||
|
if (!xkb_state_led_index_is_active(state, led))
|
||
|
continue;
|
||
|
printf("%s ", xkb_map_led_get_name(xkb, led));
|
||
|
}
|
||
|
printf("] ");
|
||
|
|
||
|
printf("\n");
|
||
|
}
|
||
|
|
||
|
/* The meaning of the input_event 'value' field. */
|
||
|
enum {
|
||
|
KEY_STATE_RELEASE = 0,
|
||
|
KEY_STATE_PRESS = 1,
|
||
|
KEY_STATE_REPEAT = 2,
|
||
|
};
|
||
|
|
||
|
#define EVDEV_OFFSET 8
|
||
|
|
||
|
static void
|
||
|
process_event(struct keyboard *kbd, uint16_t type, uint16_t code, int32_t value)
|
||
|
{
|
||
|
xkb_keycode_t keycode;
|
||
|
struct xkb_keymap *keymap;
|
||
|
|
||
|
if (type != EV_KEY)
|
||
|
return;
|
||
|
|
||
|
keycode = EVDEV_OFFSET + code;
|
||
|
keymap = xkb_state_get_map(kbd->state);
|
||
|
|
||
|
if (value == KEY_STATE_REPEAT && !xkb_key_repeats(keymap, keycode))
|
||
|
return;
|
||
|
|
||
|
if (value != KEY_STATE_RELEASE)
|
||
|
print_keycode(kbd, keycode);
|
||
|
|
||
|
if (value == KEY_STATE_RELEASE)
|
||
|
xkb_state_update_key(kbd->state, keycode, XKB_KEY_UP);
|
||
|
else
|
||
|
xkb_state_update_key(kbd->state, keycode, XKB_KEY_DOWN);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
read_keyboard(struct keyboard *kbd)
|
||
|
{
|
||
|
size_t i;
|
||
|
ssize_t len;
|
||
|
struct input_event evs[16];
|
||
|
size_t nevs;
|
||
|
|
||
|
/* No fancy error checking here. */
|
||
|
while ((len = read(kbd->fd, &evs, sizeof(evs))) > 0) {
|
||
|
nevs = len / sizeof(struct input_event);
|
||
|
for (i = 0; i < nevs; i++)
|
||
|
process_event(kbd, evs[i].type, evs[i].code, evs[i].value);
|
||
|
}
|
||
|
|
||
|
if (len < 0 && errno != EWOULDBLOCK) {
|
||
|
fprintf(stderr, "Couldn't read %s: %s\n", kbd->path,
|
||
|
strerror(errno));
|
||
|
return -errno;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
loop(struct keyboard *kbds)
|
||
|
{
|
||
|
int i, ret;
|
||
|
int epfd;
|
||
|
struct keyboard *kbd;
|
||
|
struct epoll_event ev;
|
||
|
struct epoll_event evs[16];
|
||
|
|
||
|
epfd = epoll_create1(0);
|
||
|
if (epfd < 0) {
|
||
|
fprintf(stderr, "Couldn't create epoll instance: %s\n",
|
||
|
strerror(errno));
|
||
|
return -errno;
|
||
|
}
|
||
|
|
||
|
for (kbd = kbds; kbd; kbd = kbd->next) {
|
||
|
memset(&ev, 0, sizeof(ev));
|
||
|
ev.events = EPOLLIN;
|
||
|
ev.data.ptr = kbd;
|
||
|
ret = epoll_ctl(epfd, EPOLL_CTL_ADD, kbd->fd, &ev);
|
||
|
if (ret) {
|
||
|
ret = -errno;
|
||
|
fprintf(stderr, "Couldn't add %s to epoll: %s\n",
|
||
|
kbd->path, strerror(errno));
|
||
|
goto err_epoll;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
while (!terminate) {
|
||
|
ret = epoll_wait(epfd, evs, 16, -1);
|
||
|
if (ret < 0) {
|
||
|
if (errno == EINTR)
|
||
|
continue;
|
||
|
ret = -errno;
|
||
|
fprintf(stderr, "Couldn't poll for events: %s\n",
|
||
|
strerror(errno));
|
||
|
goto err_epoll;
|
||
|
}
|
||
|
|
||
|
for (i = 0; i < ret; i++) {
|
||
|
kbd = evs[i].data.ptr;
|
||
|
ret = read_keyboard(kbd);
|
||
|
if (ret) {
|
||
|
goto err_epoll;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
close(epfd);
|
||
|
return 0;
|
||
|
|
||
|
err_epoll:
|
||
|
close(epfd);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
sigintr_handler(int signum)
|
||
|
{
|
||
|
terminate = true;
|
||
|
}
|
||
|
|
||
|
int
|
||
|
main(int argc, char *argv[])
|
||
|
{
|
||
|
int ret;
|
||
|
int opt;
|
||
|
struct keyboard *kbds;
|
||
|
struct xkb_context *context;
|
||
|
struct xkb_keymap *xkb;
|
||
|
struct xkb_rule_names names = {
|
||
|
.rules = "evdev",
|
||
|
.model = "evdev",
|
||
|
.layout = "us",
|
||
|
.variant = "",
|
||
|
.options = "",
|
||
|
};
|
||
|
struct sigaction act;
|
||
|
|
||
|
setlocale(LC_ALL, "");
|
||
|
|
||
|
while ((opt = getopt(argc, argv, "r:m:l:v:o:")) != -1) {
|
||
|
switch (opt) {
|
||
|
case 'r':
|
||
|
names.rules = optarg;
|
||
|
break;
|
||
|
case 'm':
|
||
|
names.model = optarg;
|
||
|
break;
|
||
|
case 'l':
|
||
|
names.layout = optarg;
|
||
|
break;
|
||
|
case 'v':
|
||
|
names.variant = optarg;
|
||
|
break;
|
||
|
case 'o':
|
||
|
names.options = optarg;
|
||
|
break;
|
||
|
case '?':
|
||
|
fprintf(stderr, "Usage: %s [-r <rules>] [-m <model>] "
|
||
|
"[-l <layout>] [-v <variant>] [-o <options>]\n",
|
||
|
argv[0]);
|
||
|
exit(EX_USAGE);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
context = xkb_context_new(0);
|
||
|
if (!context) {
|
||
|
ret = -1;
|
||
|
fprintf(stderr, "Couldn't create xkb context\n");
|
||
|
goto err_out;
|
||
|
}
|
||
|
|
||
|
xkb = xkb_map_new_from_names(context, &names, 0);
|
||
|
if (!xkb) {
|
||
|
ret = -1;
|
||
|
fprintf(stderr, "Couldn't create xkb keymap\n");
|
||
|
goto err_ctx;
|
||
|
}
|
||
|
|
||
|
kbds = get_keyboards(xkb);
|
||
|
if (!kbds) {
|
||
|
ret = -1;
|
||
|
goto err_xkb;
|
||
|
}
|
||
|
|
||
|
act.sa_handler = sigintr_handler;
|
||
|
sigemptyset(&act.sa_mask);
|
||
|
act.sa_flags = 0;
|
||
|
sigaction(SIGINT, &act, NULL);
|
||
|
sigaction(SIGTERM, &act, NULL);
|
||
|
|
||
|
/* Instead of fiddling with termios.. */
|
||
|
system("stty -echo");
|
||
|
|
||
|
ret = loop(kbds);
|
||
|
if (ret) {
|
||
|
goto err_stty;
|
||
|
}
|
||
|
|
||
|
err_stty:
|
||
|
system("stty echo");
|
||
|
free_keyboards(kbds);
|
||
|
err_xkb:
|
||
|
xkb_map_unref(xkb);
|
||
|
err_ctx:
|
||
|
xkb_context_unref(context);
|
||
|
err_out:
|
||
|
exit(ret == 0 ? EXIT_SUCCESS : EXIT_FAILURE);
|
||
|
}
|