uinput-mapper/c/map.c
2013-05-14 23:53:37 +02:00

310 lines
8.8 KiB
C

/*
* Status:
*
* - Can map keys from some keyboard to keys on a joystick.
* - Has programmable config format (see config.h)
*
* TODO:
* - Allow multiple keymaps per input key event; currently we override previous
* values.
* - Allow multiple inputs, modify config file to allow for mapping from
* specific inputs.
*
*/
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <fcntl.h>
#include <signal.h>
#include <linux/input.h>
#include <linux/uinput.h>
#include <err.h>
#include <poll.h>
#include <errno.h>
#include "config.h"
/* Reverse mapping, for later use */
static const struct _key_to_str {
char *name;
int num;
} key_map[] = {
#define DEF_KEY(NAME) \
{#NAME,NAME},
#include "def_keys.h"
{NULL, -1}
};
static const struct _btn_to_str {
char *name;
int num;
} btn_map[] = {
#define DEF_BTN(NAME) \
{#NAME,NAME},
#include "def_buttons.h"
{NULL, -1}
};
static int get_key_num(char* name)
{
int i = 0;
while (key_map[i].name) {
if (!strcmp(key_map[i].name, name))
return key_map[i].num;
i++;
}
return -1;
}
static int js[JOYCOUNT];
void free_js(int sig) {
int j;
(void) sig;
for(j = 0; j < JOYCOUNT; j++) {
printf("Freeing joystick: %d\n", j);
if (ioctl(js[j], UI_DEV_DESTROY) < 0) {
perror("Error freeing joystick");
}
close(js[j]);
}
exit(1);
}
int scan_device(char *f, int nfd) {
#define BITS_PER_LONG (sizeof(long) * 8)
#define NBITS(x) ((((x)-1)/BITS_PER_LONG)+1)
#define OFF(x) ((x)%BITS_PER_LONG)
#define BIT(x) (1UL<<OFF(x))
#define LONG(x) ((x)/BITS_PER_LONG)
#define test_bit(bit, array) ((array[LONG(bit)] >> OFF(bit)) & 1)
int i, j;
int version;
unsigned short id[4];
char name[256] = "Unknown";
unsigned long bit[EV_MAX][NBITS(KEY_MAX)];
int fd;
fd = open(f, O_RDONLY);
if (ioctl(fd, EVIOCGVERSION, &version)) {
perror("evtest: can't get version");
return 1;
}
printf("Input driver version is %d.%d.%d\n",
version >> 16, (version >> 8) & 0xff, version & 0xff);
ioctl(fd, EVIOCGID, id);
printf("Input device ID: bus 0x%x vendor 0x%x product 0x%x version 0x%x\n",
id[ID_BUS], id[ID_VENDOR], id[ID_PRODUCT], id[ID_VERSION]);
ioctl(fd, EVIOCGNAME(sizeof(name)), name);
printf("Input device name: \"%s\"\n", name);
memset(bit, 0, sizeof(bit));
ioctl(fd, EVIOCGBIT(0, EV_MAX), bit[0]);
printf("Supported events:\n");
for (i = 0; i < EV_MAX; i++)
if (test_bit(i, bit[0])) {
/*printf(" Event type %d (%s)\n", i, events[i] ? events[i] : "?");*/
if (!i) continue;
/* Skip ev_syn; daarna kan je ook storen in bit[i], want i != 0*/
printf("major ioctl: %d, %ld, %d\n", nfd, UI_SET_EVBIT, i);
printf("major ioctl: %d\n", ioctl(nfd, UI_SET_EVBIT, i));
ioctl(fd, EVIOCGBIT(i, KEY_MAX), bit[i]);
for (j = 0; j < KEY_MAX; j++)
if (test_bit(j, bit[i])) {
long kbit = 0;
switch (i) {
case EV_KEY: kbit = UI_SET_KEYBIT; break;
case EV_REL: kbit = UI_SET_RELBIT; break;
case EV_ABS: kbit = UI_SET_ABSBIT; break;
}
if (!kbit)
continue;
printf("Setting key: %d\n", j);
printf("ioctl: %d\n", ioctl(nfd, kbit, j));
/*printf(" Event code %d (%s)\n", j, names[i] ? (names[i][j] ? names[i][j] : "?") : "?");*/
if (i == EV_ABS) {
/* XXX: TODO */
/*print_absdata(fd, j);*/
}
}
}
return 0;
}
int main(int argc, char** argv) {
int j, nowrite, rfds, fdrr = 0;
int in[INPUT_DEVICE_COUNT]; /* fds */
struct pollfd pin[INPUT_DEVICE_COUNT];
struct input_event e, je;
struct uinput_user_dev uidev;
(void)argc;
(void)argv;
(void)get_key_num;
/* Open required input devices */
#define H_CONFIGURE_EVENTS
#include "config.h"
/* Now setup poll structure */
for (j = 0; j < INPUT_DEVICE_COUNT; j++)
{
pin[j].fd = in[j];
pin[j].events = POLLIN;
}
if(signal(SIGINT, free_js) == SIG_ERR) {
printf("SIGINT handler registration failed\n");
return 1;
}
for(j = 0; j < JOYCOUNT; j++) {
/* Memset because we are already setting the absmax/absmin */
memset(&uidev, '\0', sizeof(struct uinput_user_dev));
js[j] = open("/dev/uinput", O_WRONLY | O_NONBLOCK);
if (js[j] < 0) {
perror("(NOT FATAL YET) Could not open: /dev/uinput");
js[j] = open("/dev/input/uinput", O_WRONLY | O_NONBLOCK);
if (js[j] < 0) {
perror("(FATAL) Could not open: /dev/input/uinput");
return 1;
}
}
printf("js[j] %d\n", js[j]);
#define H_CONFIGURE_JOYSTICKS
#include "config.h"
scan_device("/dev/input/event8", js[j]);
/* Allocate device info */
snprintf(uidev.name, UINPUT_MAX_NAME_SIZE, "key2joy:%d", j);
uidev.id.bustype = BUS_USB;
uidev.id.vendor = 0x42;
uidev.id.product = 0xbebe;
uidev.id.version = 1;
if (write(js[j], &uidev, sizeof(uidev)) < 0) {
perror("write");
return EXIT_FAILURE;
}
if (ioctl(js[j], UI_DEV_CREATE)) {
perror("ioctl create");
return EXIT_FAILURE;
}
}
/* Do it! */
while (1) {
printf("Entering poll..\n");
/* Any data available? */
if ((rfds = poll(pin, INPUT_DEVICE_COUNT, -1)) < 0) {
/* Interrupted by signal */
if (errno == EINTR)
continue;
perror("poll");
return EXIT_FAILURE;
}
printf("Leaving poll..\n");
/* Round-robin check readers */
while (rfds) {
if (pin[fdrr].revents & POLLIN) {
printf("Device %d has input\n", fdrr);
/* XXX: Need checking for complete read? */
if (read(in[fdrr], &e, sizeof(struct input_event)) < 0) {
/* Interrupted by singal? Retry */
if (errno == EINTR)
continue;
#if 0
if (errno == EWOULDBLOCK || errno == EAGAIN) {
printf("poll tells us device %d is readable.. it is not\n", fdrr);
rfds -= 1;
fdrr = (fdrr + 1) % INPUT_DEVICE_COUNT;
continue;
}
#endif
err(EXIT_FAILURE, "reading input device nr. %d failed", fdrr);
}
printf("Event: (Type: %d, Code: %d, Value %d)\n", e.type, e.code, e.value);
} else {
/* Update poll read mechanism */
fdrr = (fdrr + 1) % INPUT_DEVICE_COUNT;
continue;
}
/* Now handle received event */
memset(&je, '\0', sizeof(struct input_event));
nowrite = 1;
j = 0;
je.type = e.type;
je.code = e.code;
je.value = e.value;
nowrite = 0;
/*
#define H_JOYMAP
#include "config.h"
*/
/* Update poll read mechanism */
fdrr = (fdrr + 1) % INPUT_DEVICE_COUNT;
rfds -= 1;
if (nowrite == 0) {
printf("Writing %d to %d\n", e.code, j);
if(write(js[j], &je, sizeof(struct input_event)) < 0) {
perror("Event write event");
return EXIT_FAILURE;
}
}
/* Synchronisation events */
if (e.type == EV_SYN) {
memset(&je, '\0', sizeof(struct input_event));
printf("SYN event\n");
je.type = EV_SYN;
je.code = 0;
je.value = 0;
if (write(js[j], &je, sizeof(struct input_event)) < 0) {
perror("SYN write event");
return EXIT_FAILURE;
}
}
} /* End reader check loop */
} /* End main loop */
return 0;
}