[libpicofe.git] / common / input.c

#include <stdio.h>
#include <stdlib.h>
#include <string.h>

#include "common.h"
#include "input.h"
#include "plat.h"
#include "../linux/in_evdev.h"
#include "../gp2x/in_gp2x.h"

typedef struct
{
	int drv_id;
	int drv_fd_hnd;
	void *drv_data;
	char *name;
	int *binds;
	int probed:1;
} in_dev_t;

static in_drv_t in_drivers[IN_DRVID_COUNT];
static in_dev_t in_devices[IN_MAX_DEVS];
static int in_dev_count = 0;
static int in_have_async_devs = 0;

#define DRV(id) in_drivers[(unsigned)(id) < IN_DRVID_COUNT ? (id) : 0]


static int in_bind_count(int drv_id)
{
	int count = DRV(drv_id).get_bind_count();
	if (count <= 0)
		printf("input: failed to get bind count for drv %d\n", drv_id);

	return count;
}

static int *in_alloc_binds(int drv_id)
{
	int count, *binds;

	count = in_bind_count(drv_id);
	if (count <= 0)
		return NULL;

	binds = calloc(count * 2, sizeof(binds[0]));
	if (binds == NULL)
		return NULL;

	DRV(drv_id).get_def_binds(binds + count);
	memcpy(binds, binds + count, count * sizeof(binds[0]));

	return binds;
}

static void in_free(in_dev_t *dev)
{
	if (dev->probed)
		DRV(dev->drv_id).free(dev->drv_data);
	dev->probed = 0;
	dev->drv_data = NULL;
	free(dev->name);
	dev->name = NULL;
	free(dev->binds);
	dev->binds = NULL;
}

/* to be called by drivers
 * async devices must set drv_fd_hnd to -1 */
void in_register(const char *nname, int drv_id, int drv_fd_hnd, void *drv_data)
{
	int i, ret, dupe_count = 0, *binds;
	char name[256], *name_end, *tmp;

	strncpy(name, nname, sizeof(name));
	name[sizeof(name)-12] = 0;
	name_end = name + strlen(name);

	for (i = 0; i < in_dev_count; i++)
	{
		if (in_devices[i].name == NULL)
			continue;
		if (strcmp(in_devices[i].name, name) == 0)
		{
			if (in_devices[i].probed) {
				dupe_count++;
				sprintf(name_end, " [%d]", dupe_count);
				continue;
			}
			goto update;
		}
	}

	if (i >= IN_MAX_DEVS)
	{
		/* try to find unused device */
		for (i = 0; i < IN_MAX_DEVS; i++)
			if (!in_devices[i].probed) break;
		if (i >= IN_MAX_DEVS) {
			printf("input: too many devices, can't add %s\n", name);
			return;
		}
		in_free(&in_devices[i]);
	}

	tmp = strdup(name);
	if (tmp == NULL)
		return;

	binds = in_alloc_binds(drv_id);
	if (binds == NULL) {
		free(tmp);
		return;
	}

	in_devices[i].name = tmp;
	in_devices[i].binds = binds;
	if (i + 1 > in_dev_count)
		in_dev_count = i + 1;

	printf("input: new device #%d \"%s\"\n", i, name);
update:
	in_devices[i].probed = 1;
	in_devices[i].drv_id = drv_id;
	in_devices[i].drv_fd_hnd = drv_fd_hnd;
	in_devices[i].drv_data = drv_data;

	if (in_devices[i].binds != NULL) {
		ret = DRV(drv_id).clean_binds(drv_data, in_devices[i].binds);
		if (ret == 0) {
			/* no useable binds */
			free(in_devices[i].binds);
			in_devices[i].binds = NULL;
		}
	}
}

void in_probe(void)
{
	int i;

	in_have_async_devs = 0;
	for (i = 0; i < in_dev_count; i++)
		in_devices[i].probed = 0;

	for (i = 1; i < IN_DRVID_COUNT; i++)
		in_drivers[i].probe();

	/* get rid of devs without binds and probes */
	for (i = 0; i < in_dev_count; i++) {
		if (!in_devices[i].probed && in_devices[i].binds == NULL) {
			in_dev_count--;
			if (i < in_dev_count) {
				free(in_devices[i].name);
				memmove(&in_devices[i], &in_devices[i+1],
					(in_dev_count - i) * sizeof(in_devices[0]));
			}

			continue;
		}

		if (in_devices[i].probed && in_devices[i].drv_fd_hnd == -1)
			in_have_async_devs = 1;
	}

	if (in_have_async_devs)
		printf("input: async-only devices detected..\n");
}

/* async update */
int in_update(void)
{
	int i, result = 0;

	for (i = 0; i < in_dev_count; i++) {
		in_dev_t *dev = &in_devices[i];
		if (dev->probed && dev->binds != NULL) {
			switch (dev->drv_id) {
#ifdef IN_EVDEV
			case IN_DRVID_EVDEV:
				result |= in_evdev_update(dev->drv_data, dev->binds);
				break;
#endif
#ifdef IN_GP2X
			case IN_DRVID_GP2X:
				result |= in_gp2x_update(dev->drv_data, dev->binds);
				break;
#endif
			}
		}
	}

	return result;
}

static int menu_key_state = 0;

void in_set_blocking(int is_blocking)
{
	int i, ret;

	/* have_async_devs means we will have to do all reads async anyway.. */
	if (!in_have_async_devs) {
		for (i = 0; i < in_dev_count; i++) {
			if (in_devices[i].probed)
				DRV(in_devices[i].drv_id).set_blocking(in_devices[i].drv_data, is_blocking);
		}
	}

	menu_key_state = 0;

	/* flush events */
	do {
		ret = in_update_keycode(NULL, NULL, 0);
	} while (ret >= 0);
}

static int in_update_kc_async(int *dev_id_out, int *is_down_out, int timeout_ms)
{
	int i, is_down, result;
	unsigned int ticks;

	ticks = plat_get_ticks_ms();

	while (1)
	{
		for (i = 0; i < in_dev_count; i++) {
			in_dev_t *d = &in_devices[i];
			if (!d->probed)
				continue;

			result = DRV(d->drv_id).update_keycode(d->drv_data, &is_down);
			if (result == -1)
				continue;

			if (dev_id_out)
				*dev_id_out = i;
			if (is_down_out)
				*is_down_out = is_down;
			return result;
		}

		if (timeout_ms >= 0 && (int)(plat_get_ticks_ms() - ticks) > timeout_ms)
			break;

		plat_sleep_ms(10);
	}

	return -1;
}

/* 
 * wait for a press, always return some keycode or -1 on timeout or error
 */
int in_update_keycode(int *dev_id_out, int *is_down_out, int timeout_ms)
{
	int result = -1, dev_id = 0, is_down, result_menu;
	int fds_hnds[IN_MAX_DEVS];
	int i, ret, count = 0;
	in_drv_t *drv = NULL;
	unsigned int ticks;

	if (in_have_async_devs) {
		result = in_update_kc_async(&dev_id, &is_down, timeout_ms);
		if (result == -1)
			return -1;
		drv = &DRV(in_devices[dev_id].drv_id);
		goto finish;
	}

	ticks = plat_get_ticks_ms();

	for (i = 0; i < in_dev_count; i++) {
		if (in_devices[i].probed)
			fds_hnds[count++] = in_devices[i].drv_fd_hnd;
	}

	if (count == 0) {
		/* don't deadlock, fail */
		printf("input: failed to find devices to read\n");
		exit(1);
	}

	while (1)
	{
		ret = plat_wait_event(fds_hnds, count, timeout_ms);
		if (ret < 0)
			break;

		for (i = 0; i < in_dev_count; i++) {
			if (in_devices[i].drv_fd_hnd == ret) {
				dev_id = i;
				break;
			}
		}

		drv = &DRV(in_devices[dev_id].drv_id);
		result = drv->update_keycode(in_devices[dev_id].drv_data, &is_down);

		/* update_keycode() might return -1 when some not interesting
		 * event happened, like sync event for evdev. */
		if (result >= 0)
			break;

		if (timeout_ms >= 0) {
			unsigned int ticks2 = plat_get_ticks_ms();
			timeout_ms -= ticks2 - ticks;
			ticks = ticks2;
			if (timeout_ms <= 0)
				break;
		}
	}

	if (result == -1)
		return -1;
finish:
	/* keep track of menu key state, to allow mixing
	 * in_update_keycode() and in_menu_wait_any() calls */
	result_menu = drv->menu_translate(result);
	if (result_menu != 0) {
		if (is_down)
			menu_key_state |=  result_menu;
		else
			menu_key_state &= ~result_menu;
	}

	if (dev_id_out != NULL)
		*dev_id_out = dev_id;
	if (is_down_out != NULL)
		*is_down_out = is_down;
	return result;
}

/* same as above, only return bitfield of PBTN_*  */
int in_menu_wait_any(int timeout_ms)
{
	int keys_old = menu_key_state;

	while (1)
	{
		int code, is_down = 0, dev_id = 0;

		code = in_update_keycode(&dev_id, &is_down, timeout_ms);
		if (code >= 0)
			code = DRV(in_devices[dev_id].drv_id).menu_translate(code);

		if (timeout_ms >= 0)
			break;
		if (code < 0)
			continue;
		if (keys_old != menu_key_state)
			break;
	}

	return menu_key_state;
}

/* wait for menu input, do autorepeat */
int in_menu_wait(int interesting, int autorep_delay_ms)
{
	static int inp_prev = 0;
	static int repeats = 0;
	int ret, release = 0, wait = 666;

	if (repeats)
		wait = autorep_delay_ms;

	ret = in_menu_wait_any(wait);
	if (ret == inp_prev)
		repeats++;

	while (!(ret & interesting)) {
		ret = in_menu_wait_any(-1);
		release = 1;
	}

	if (release || ret != inp_prev)
		repeats = 0;

	inp_prev = ret;

	/* we don't need diagonals in menus */
	if ((ret & PBTN_UP)   && (ret & PBTN_LEFT))  ret &= ~PBTN_LEFT;
	if ((ret & PBTN_UP)   && (ret & PBTN_RIGHT)) ret &= ~PBTN_RIGHT;
	if ((ret & PBTN_DOWN) && (ret & PBTN_LEFT))  ret &= ~PBTN_LEFT;
	if ((ret & PBTN_DOWN) && (ret & PBTN_RIGHT)) ret &= ~PBTN_RIGHT;

	return ret;
}

const int *in_get_dev_binds(int dev_id)
{
	if (dev_id < 0 || dev_id >= IN_MAX_DEVS)
		return NULL;

	return in_devices[dev_id].binds;
}

const int *in_get_dev_def_binds(int dev_id)
{
	int count;

	if (dev_id < 0 || dev_id >= IN_MAX_DEVS)
		return NULL;

	count = in_bind_count(in_devices[dev_id].drv_id);
	return in_devices[dev_id].binds + count;
}

int in_get_dev_bind_count(int dev_id)
{
	if (dev_id < 0 || dev_id >= IN_MAX_DEVS)
		return 0;

	return in_bind_count(in_devices[dev_id].drv_id);
}

const char *in_get_dev_name(int dev_id, int must_be_active, int skip_pfix)
{
	const char *name, *tmp;

	if (dev_id < 0 || dev_id >= IN_MAX_DEVS)
		return NULL;

	if (must_be_active && !in_devices[dev_id].probed)
		return NULL;

	name = in_devices[dev_id].name;
	if (name == NULL || !skip_pfix)
		return name;

	/* skip prefix */
	tmp = strchr(name, ':');
	if (tmp != NULL)
		name = tmp + 1;

	return name;
}

/* never returns NULL */
const char *in_get_key_name(int dev_id, int keycode)
{
	static char xname[16];
	const char *name;

	if (dev_id < 0 || dev_id >= IN_MAX_DEVS)
		return "Unkn0";

	name = DRV(in_devices[dev_id].drv_id).get_key_name(keycode);
	if (name != NULL)
		return name;

	/* assume scancode */
	if ((keycode >= '0' && keycode <= '9') || (keycode >= 'a' && keycode <= 'z')
			|| (keycode >= 'A' && keycode <= 'Z'))
		sprintf(xname, "%c", keycode);
	else
		sprintf(xname, "\\x%02X", keycode);
	return xname;
}

int in_bind_key(int dev_id, int keycode, int mask, int force_unbind)
{
	int ret, count;
	in_dev_t *dev;

	if (dev_id < 0 || dev_id >= IN_MAX_DEVS)
		return -1;
	dev = &in_devices[dev_id];

	if (dev->binds == NULL) {
		if (force_unbind)
			return 0;
		dev->binds = in_alloc_binds(dev->drv_id);
		if (dev->binds == NULL)
			return -1;
	}

	count = in_bind_count(dev->drv_id);
	if (keycode < 0 || keycode >= count)
		return -1;
	
	if (force_unbind)
		dev->binds[keycode] &= ~mask;
	else
		dev->binds[keycode] ^=  mask;
	
	ret = DRV(dev->drv_id).clean_binds(dev->drv_data, dev->binds);
	if (ret == 0) {
		free(dev->binds);
		dev->binds = NULL;
	}

	return 0;
}

/* returns device id, or -1 on error */
int in_config_parse_dev(const char *name)
{
	int drv_id = -1, i;

	for (i = 0; i < IN_DRVID_COUNT; i++) {
		int len = strlen(in_drivers[i].prefix);
		if (strncmp(name, in_drivers[i].prefix, len) == 0) {
			drv_id = i;
			break;
		}
	}

	if (drv_id < 0) {
		printf("input: missing driver for %s\n", name);
		return -1;
	}

	for (i = 0; i < in_dev_count; i++)
	{
		if (in_devices[i].name == NULL)
			continue;
		if (strcmp(in_devices[i].name, name) == 0)
			return i;
	}

	if (i >= IN_MAX_DEVS)
	{
		/* try to find unused device */
		for (i = 0; i < IN_MAX_DEVS; i++)
			if (in_devices[i].name == NULL) break;
		if (i >= IN_MAX_DEVS) {
			printf("input: too many devices, can't add %s\n", name);
			return -1;
		}
	}

	memset(&in_devices[i], 0, sizeof(in_devices[i]));

	in_devices[i].name = strdup(name);
	if (in_devices[i].name == NULL)
		return -1;

	if (i + 1 > in_dev_count)
		in_dev_count = i + 1;
	in_devices[i].drv_id = drv_id;

	return i;
}

/*
 * To reduce size of game specific configs, default binds are not saved.
 * So we mark default binds in in_config_start(), override them in in_config_bind_key(),
 * and restore whatever default binds are left in in_config_end().
 */
void in_config_start(void)
{
	int i;

	/* mark all default binds, so they get overwritten by func below */
	for (i = 0; i < IN_MAX_DEVS; i++) {
		int n, count, *binds, *def_binds;

		binds = in_devices[i].binds;
		if (binds == NULL)
			continue;

		count = in_bind_count(in_devices[i].drv_id);
		def_binds = binds + count;

		for (n = 0; n < count; n++)
			if (binds[n] == def_binds[n])
				binds[n] = -1;
	}
}

int in_config_bind_key(int dev_id, const char *key, int binds)
{
	int count, kc;
	in_dev_t *dev;

	if (dev_id < 0 || dev_id >= IN_MAX_DEVS)
		return -1;
	dev = &in_devices[dev_id];

	count = in_bind_count(dev->drv_id);

	/* maybe a raw code? */
	if (key[0] == '\\' && key[1] == 'x') {
		char *p = NULL;
		kc = (int)strtoul(key + 2, &p, 16);
		if (p == NULL || *p != 0)
			kc = -1;
	}
	else {
		/* device specific key name */
		if (dev->binds == NULL) {
			dev->binds = in_alloc_binds(dev->drv_id);
			if (dev->binds == NULL)
				return -1;
			in_config_start();
		}

		kc = DRV(dev->drv_id).get_key_code(key);
		if (kc < 0 && strlen(key) == 1) {
			/* assume scancode */
			kc = key[0];
		}
	}

	if (kc < 0 || kc >= count) {
		printf("input: bad key: %s\n", key);
		return -1;
	}

	if (dev->binds[kc] == -1)
		dev->binds[kc] = 0;
	dev->binds[kc] |= binds;

	return 0;
}

void in_config_end(void)
{
	int i;

	for (i = 0; i < IN_MAX_DEVS; i++) {
		int n, ret, count, *binds, *def_binds;
		in_dev_t *dev = &in_devices[i];

		if (dev->binds == NULL)
			continue;

		count = in_bind_count(dev->drv_id);
		binds = dev->binds;
		def_binds = binds + count;

		for (n = 0; n < count; n++)
			if (binds[n] == -1)
				binds[n] = def_binds[n];

		if (dev->drv_data == NULL)
			continue;

		ret = DRV(dev->drv_id).clean_binds(dev->drv_data, binds);
		if (ret == 0) {
			/* no useable binds */
			free(dev->binds);
			dev->binds = NULL;
		}
	}
}

void in_debug_dump(void)
{
	int i;

	printf("# drv probed binds name\n");
	for (i = 0; i < IN_MAX_DEVS; i++) {
		in_dev_t *d = &in_devices[i];
		if (!d->probed && d->name == NULL && d->binds == NULL)
			continue;
		printf("%d %3d %6c %5c %s\n", i, d->drv_id, d->probed ? 'y' : 'n',
			d->binds ? 'y' : 'n', d->name);
	}
}

/* handlers for unknown/not_preset drivers */

static void in_def_probe(void) {}
static void in_def_free(void *drv_data) {}
static int  in_def_get_bind_count(void) { return 0; }
static void in_def_get_def_binds(int *binds) {}
static int  in_def_clean_binds(void *drv_data, int *binds) { return 0; }
static void in_def_set_blocking(void *data, int y) {}
static int  in_def_update_keycode(void *drv_data, int *is_down) { return 0; }
static int  in_def_menu_translate(int keycode) { return keycode; }
static int  in_def_get_key_code(const char *key_name) { return 0; }
static const char *in_def_get_key_name(int keycode) { return NULL; }

void in_init(void)
{
	int i;

	memset(in_drivers, 0, sizeof(in_drivers));
	memset(in_devices, 0, sizeof(in_devices));
	in_dev_count = 0;

	for (i = 0; i < IN_DRVID_COUNT; i++) {
		in_drivers[i].prefix = "none:";
		in_drivers[i].probe = in_def_probe;
		in_drivers[i].free = in_def_free;
		in_drivers[i].get_bind_count = in_def_get_bind_count;
		in_drivers[i].get_def_binds = in_def_get_def_binds;
		in_drivers[i].clean_binds = in_def_clean_binds;
		in_drivers[i].set_blocking = in_def_set_blocking;
		in_drivers[i].update_keycode = in_def_update_keycode;
		in_drivers[i].menu_translate = in_def_menu_translate;
		in_drivers[i].get_key_code = in_def_get_key_code;
		in_drivers[i].get_key_name = in_def_get_key_name;
	}

#ifdef IN_GP2X
	in_gp2x_init(&in_drivers[IN_DRVID_GP2X]);
#endif
#ifdef IN_EVDEV
	in_evdev_init(&in_drivers[IN_DRVID_EVDEV]);
#endif
}

#if 0
int main(void)
{
	int ret;

	in_init();
	in_probe();

	in_set_blocking(1);

#if 1
	while (1) {
		int dev = 0, down;
		ret = in_update_keycode(&dev, &down);
		printf("#%i: %i %i (%s)\n", dev, down, ret, in_get_key_name(dev, ret));
	}
#else
	while (1) {
		ret = in_menu_wait_any();
		printf("%08x\n", ret);
	}
#endif

	return 0;
}
#endif
Commit	Line	Data
2258f158	1	#include <stdio.h>
	2	#include <stdlib.h>
	3	#include <string.h>
	4
fce20e73	5	#include "common.h"
2258f158	6	#include "input.h"
4ab30ad4	7	#include "plat.h"
34581c95	8	#include "../linux/in_evdev.h"
13b692eb	9	#include "../gp2x/in_gp2x.h"
2258f158	10
	11	typedef struct
	12	{
	13	int drv_id;
7f022a8d	14	int drv_fd_hnd;
2258f158	15	void *drv_data;
2258f158	16	char *name;
906bdc9f	17	int *binds;
2258f158	18	int probed:1;
2258f158	19	} in_dev_t;
2258f158	20
da767bd5	21	static in_drv_t in_drivers[IN_DRVID_COUNT];
2258f158	22	static in_dev_t in_devices[IN_MAX_DEVS];
2258f158	23	static int in_dev_count = 0;
13b692eb	24	static int in_have_async_devs = 0;
2258f158	25
da767bd5	26	#define DRV(id) in_drivers[(unsigned)(id) < IN_DRVID_COUNT ? (id) : 0]
da767bd5	27
13b692eb	28
2258f158	29	static int in_bind_count(int drv_id)
2258f158	30	{
da767bd5	31	int count = DRV(drv_id).get_bind_count();
2258f158	32	if (count <= 0)
	33	printf("input: failed to get bind count for drv %d\n", drv_id);
	34
	35	return count;
	36	}
	37
	38	static int *in_alloc_binds(int drv_id)
	39	{
da767bd5	40	int count, *binds;
2258f158	41
2258f158	42	count = in_bind_count(drv_id);
da767bd5	43	if (count <= 0)
2258f158	44	return NULL;
2258f158	45
da767bd5	46	binds = calloc(count * 2, sizeof(binds[0]));
	47	if (binds == NULL)
	48	return NULL;
	49
	50	DRV(drv_id).get_def_binds(binds + count);
	51	memcpy(binds, binds + count, count * sizeof(binds[0]));
	52
	53	return binds;
2258f158	54	}
	55
	56	static void in_free(in_dev_t *dev)
	57	{
da767bd5	58	if (dev->probed)
da767bd5	59	DRV(dev->drv_id).free(dev->drv_data);
2258f158	60	dev->probed = 0;
	61	dev->drv_data = NULL;
	62	free(dev->name);
	63	dev->name = NULL;
	64	free(dev->binds);
	65	dev->binds = NULL;
	66	}
	67
13b692eb	68	/* to be called by drivers
13b692eb	69	* async devices must set drv_fd_hnd to -1 */
7f022a8d	70	void in_register(const char nname, int drv_id, int drv_fd_hnd, void drv_data)
2258f158	71	{
da767bd5	72	int i, ret, dupe_count = 0, *binds;
2258f158	73	char name[256], name_end, tmp;
	74
	75	strncpy(name, nname, sizeof(name));
	76	name[sizeof(name)-12] = 0;
	77	name_end = name + strlen(name);
	78
	79	for (i = 0; i < in_dev_count; i++)
	80	{
	81	if (in_devices[i].name == NULL)
	82	continue;
	83	if (strcmp(in_devices[i].name, name) == 0)
	84	{
	85	if (in_devices[i].probed) {
	86	dupe_count++;
	87	sprintf(name_end, " [%d]", dupe_count);
	88	continue;
	89	}
	90	goto update;
	91	}
	92	}
	93
	94	if (i >= IN_MAX_DEVS)
	95	{
	96	/* try to find unused device */
	97	for (i = 0; i < IN_MAX_DEVS; i++)
	98	if (!in_devices[i].probed) break;
	99	if (i >= IN_MAX_DEVS) {
	100	printf("input: too many devices, can't add %s\n", name);
	101	return;
	102	}
	103	in_free(&in_devices[i]);
	104	}
	105
	106	tmp = strdup(name);
	107	if (tmp == NULL)
	108	return;
	109
	110	binds = in_alloc_binds(drv_id);
	111	if (binds == NULL) {
	112	free(tmp);
	113	return;
	114	}
	115
	116	in_devices[i].name = tmp;
	117	in_devices[i].binds = binds;
	118	if (i + 1 > in_dev_count)
	119	in_dev_count = i + 1;
	120
	121	printf("input: new device #%d \"%s\"\n", i, name);
	122	update:
	123	in_devices[i].probed = 1;
	124	in_devices[i].drv_id = drv_id;
7f022a8d	125	in_devices[i].drv_fd_hnd = drv_fd_hnd;
2258f158	126	in_devices[i].drv_data = drv_data;
da767bd5	127
	128	if (in_devices[i].binds != NULL) {
	129	ret = DRV(drv_id).clean_binds(drv_data, in_devices[i].binds);
	130	if (ret == 0) {
	131	/* no useable binds */
	132	free(in_devices[i].binds);
	133	in_devices[i].binds = NULL;
	134	}
	135	}
2258f158	136	}
	137
	138	void in_probe(void)
	139	{
	140	int i;
13b692eb	141
13b692eb	142	in_have_async_devs = 0;
2258f158	143	for (i = 0; i < in_dev_count; i++)
	144	in_devices[i].probed = 0;
	145
da767bd5	146	for (i = 1; i < IN_DRVID_COUNT; i++)
da767bd5	147	in_drivers[i].probe();
2258f158	148
	149	/* get rid of devs without binds and probes */
	150	for (i = 0; i < in_dev_count; i++) {
	151	if (!in_devices[i].probed && in_devices[i].binds == NULL) {
	152	in_dev_count--;
	153	if (i < in_dev_count) {
	154	free(in_devices[i].name);
	155	memmove(&in_devices[i], &in_devices[i+1],
	156	(in_dev_count - i) * sizeof(in_devices[0]));
	157	}
13b692eb	158
13b692eb	159	continue;
2258f158	160	}
13b692eb	161
	162	if (in_devices[i].probed && in_devices[i].drv_fd_hnd == -1)
	163	in_have_async_devs = 1;
2258f158	164	}
13b692eb	165
	166	if (in_have_async_devs)
	167	printf("input: async-only devices detected..\n");
2258f158	168	}
2258f158	169
7f022a8d	170	/* async update */
2258f158	171	int in_update(void)
	172	{
	173	int i, result = 0;
	174
	175	for (i = 0; i < in_dev_count; i++) {
906bdc9f	176	in_dev_t *dev = &in_devices[i];
906bdc9f	177	if (dev->probed && dev->binds != NULL) {
906bdc9f	178	switch (dev->drv_id) {
da767bd5	179	#ifdef IN_EVDEV
595491c4	180	case IN_DRVID_EVDEV:
86883f7f	181	result \|= in_evdev_update(dev->drv_data, dev->binds);
595491c4	182	break;
13b692eb	183	#endif
	184	#ifdef IN_GP2X
	185	case IN_DRVID_GP2X:
	186	result \|= in_gp2x_update(dev->drv_data, dev->binds);
	187	break;
da767bd5	188	#endif
595491c4	189	}
2258f158	190	}
	191	}
	192
	193	return result;
	194	}
	195
906bdc9f	196	static int menu_key_state = 0;
906bdc9f	197
595491c4	198	void in_set_blocking(int is_blocking)
595491c4	199	{
13b692eb	200	int i, ret;
595491c4	201
13b692eb	202	/* have_async_devs means we will have to do all reads async anyway.. */
	203	if (!in_have_async_devs) {
	204	for (i = 0; i < in_dev_count; i++) {
	205	if (in_devices[i].probed)
	206	DRV(in_devices[i].drv_id).set_blocking(in_devices[i].drv_data, is_blocking);
	207	}
595491c4	208	}
906bdc9f	209
906bdc9f	210	menu_key_state = 0;
13b692eb	211
906bdc9f	212	/* flush events */
13b692eb	213	do {
	214	ret = in_update_keycode(NULL, NULL, 0);
	215	} while (ret >= 0);
595491c4	216	}
595491c4	217
13b692eb	218	static int in_update_kc_async(int dev_id_out, int is_down_out, int timeout_ms)
13b692eb	219	{
13b692eb	220	int i, is_down, result;
4ab30ad4	221	unsigned int ticks;
13b692eb	222
4ab30ad4	223	ticks = plat_get_ticks_ms();
13b692eb	224
	225	while (1)
	226	{
	227	for (i = 0; i < in_dev_count; i++) {
	228	in_dev_t *d = &in_devices[i];
	229	if (!d->probed)
	230	continue;
	231
	232	result = DRV(d->drv_id).update_keycode(d->drv_data, &is_down);
	233	if (result == -1)
	234	continue;
	235
	236	if (dev_id_out)
	237	*dev_id_out = i;
	238	if (is_down_out)
	239	*is_down_out = is_down;
	240	return result;
	241	}
	242
4ab30ad4	243	if (timeout_ms >= 0 && (int)(plat_get_ticks_ms() - ticks) > timeout_ms)
4ab30ad4	244	break;
13b692eb	245
4ab30ad4	246	plat_sleep_ms(10);
13b692eb	247	}
	248
	249	return -1;
	250	}
7f022a8d	251
34581c95	252	/*
13b692eb	253	* wait for a press, always return some keycode or -1 on timeout or error
34581c95	254	*/
906bdc9f	255	int in_update_keycode(int dev_id_out, int is_down_out, int timeout_ms)
34581c95	256	{
4ab30ad4	257	int result = -1, dev_id = 0, is_down, result_menu;
7f022a8d	258	int fds_hnds[IN_MAX_DEVS];
7f022a8d	259	int i, ret, count = 0;
7fd581f4	260	in_drv_t *drv = NULL;
4ab30ad4	261	unsigned int ticks;
7f022a8d	262
13b692eb	263	if (in_have_async_devs) {
	264	result = in_update_kc_async(&dev_id, &is_down, timeout_ms);
	265	if (result == -1)
	266	return -1;
	267	drv = &DRV(in_devices[dev_id].drv_id);
	268	goto finish;
	269	}
	270
4ab30ad4	271	ticks = plat_get_ticks_ms();
4ab30ad4	272
7f022a8d	273	for (i = 0; i < in_dev_count; i++) {
	274	if (in_devices[i].probed)
	275	fds_hnds[count++] = in_devices[i].drv_fd_hnd;
	276	}
34581c95	277
	278	if (count == 0) {
	279	/* don't deadlock, fail */
	280	printf("input: failed to find devices to read\n");
	281	exit(1);
	282	}
	283
4ab30ad4	284	while (1)
7f022a8d	285	{
4ab30ad4	286	ret = plat_wait_event(fds_hnds, count, timeout_ms);
	287	if (ret < 0)
	288	break;
7f022a8d	289
4ab30ad4	290	for (i = 0; i < in_dev_count; i++) {
	291	if (in_devices[i].drv_fd_hnd == ret) {
	292	dev_id = i;
	293	break;
	294	}
7f022a8d	295	}
7f022a8d	296
4ab30ad4	297	drv = &DRV(in_devices[dev_id].drv_id);
4ab30ad4	298	result = drv->update_keycode(in_devices[dev_id].drv_data, &is_down);
7f022a8d	299
4ab30ad4	300	/* update_keycode() might return -1 when some not interesting
	301	* event happened, like sync event for evdev. */
	302	if (result >= 0)
906bdc9f	303	break;
4ab30ad4	304
	305	if (timeout_ms >= 0) {
	306	unsigned int ticks2 = plat_get_ticks_ms();
	307	timeout_ms -= ticks2 - ticks;
	308	ticks = ticks2;
	309	if (timeout_ms <= 0)
	310	break;
595491c4	311	}
595491c4	312	}
7f022a8d	313
13b692eb	314	if (result == -1)
4ab30ad4	315	return -1;
13b692eb	316	finish:
906bdc9f	317	/* keep track of menu key state, to allow mixing
fce20e73	318	* in_update_keycode() and in_menu_wait_any() calls */
7f022a8d	319	result_menu = drv->menu_translate(result);
906bdc9f	320	if (result_menu != 0) {
	321	if (is_down)
	322	menu_key_state \|= result_menu;
	323	else
	324	menu_key_state &= ~result_menu;
	325	}
	326
	327	if (dev_id_out != NULL)
	328	*dev_id_out = dev_id;
	329	if (is_down_out != NULL)
	330	*is_down_out = is_down;
34581c95	331	return result;
	332	}
	333
fce20e73	334	/* same as above, only return bitfield of PBTN_* */
fce20e73	335	int in_menu_wait_any(int timeout_ms)
595491c4	336	{
906bdc9f	337	int keys_old = menu_key_state;
595491c4	338
	339	while (1)
	340	{
da767bd5	341	int code, is_down = 0, dev_id = 0;
595491c4	342
906bdc9f	343	code = in_update_keycode(&dev_id, &is_down, timeout_ms);
13b692eb	344	if (code >= 0)
13b692eb	345	code = DRV(in_devices[dev_id].drv_id).menu_translate(code);
595491c4	346
fce20e73	347	if (timeout_ms >= 0)
906bdc9f	348	break;
13b692eb	349	if (code < 0)
906bdc9f	350	continue;
906bdc9f	351	if (keys_old != menu_key_state)
595491c4	352	break;
	353	}
	354
906bdc9f	355	return menu_key_state;
595491c4	356	}
595491c4	357
fce20e73	358	/* wait for menu input, do autorepeat */
049a6b3e	359	int in_menu_wait(int interesting, int autorep_delay_ms)
fce20e73	360	{
fce20e73	361	static int inp_prev = 0;
6c263f30	362	static int repeats = 0;
6c263f30	363	int ret, release = 0, wait = 666;
fce20e73	364
6c263f30	365	if (repeats)
049a6b3e	366	wait = autorep_delay_ms;
fce20e73	367
6c263f30	368	ret = in_menu_wait_any(wait);
	369	if (ret == inp_prev)
	370	repeats++;
fce20e73	371
	372	while (!(ret & interesting)) {
	373	ret = in_menu_wait_any(-1);
	374	release = 1;
	375	}
	376
6c263f30	377	if (release \|\| ret != inp_prev)
fce20e73	378	repeats = 0;
6c263f30	379
fce20e73	380	inp_prev = ret;
fce20e73	381
6c263f30	382	/* we don't need diagonals in menus */
fce20e73	383	if ((ret & PBTN_UP) && (ret & PBTN_LEFT)) ret &= ~PBTN_LEFT;
	384	if ((ret & PBTN_UP) && (ret & PBTN_RIGHT)) ret &= ~PBTN_RIGHT;
	385	if ((ret & PBTN_DOWN) && (ret & PBTN_LEFT)) ret &= ~PBTN_LEFT;
	386	if ((ret & PBTN_DOWN) && (ret & PBTN_RIGHT)) ret &= ~PBTN_RIGHT;
	387
	388	return ret;
	389	}
	390
da767bd5	391	const int *in_get_dev_binds(int dev_id)
	392	{
	393	if (dev_id < 0 \|\| dev_id >= IN_MAX_DEVS)
	394	return NULL;
	395
	396	return in_devices[dev_id].binds;
	397	}
	398
	399	const int *in_get_dev_def_binds(int dev_id)
	400	{
	401	int count;
	402
	403	if (dev_id < 0 \|\| dev_id >= IN_MAX_DEVS)
	404	return NULL;
	405
	406	count = in_bind_count(in_devices[dev_id].drv_id);
	407	return in_devices[dev_id].binds + count;
	408	}
	409
	410	int in_get_dev_bind_count(int dev_id)
	411	{
	412	if (dev_id < 0 \|\| dev_id >= IN_MAX_DEVS)
	413	return 0;
	414
	415	return in_bind_count(in_devices[dev_id].drv_id);
	416	}
	417
049a6b3e	418	const char *in_get_dev_name(int dev_id, int must_be_active, int skip_pfix)
da767bd5	419	{
049a6b3e	420	const char name, tmp;
049a6b3e	421
da767bd5	422	if (dev_id < 0 \|\| dev_id >= IN_MAX_DEVS)
	423	return NULL;
	424
fce20e73	425	if (must_be_active && !in_devices[dev_id].probed)
fce20e73	426	return NULL;
049a6b3e	427
049a6b3e	428	name = in_devices[dev_id].name;
bf3c44f4	429	if (name == NULL \|\| !skip_pfix)
bf3c44f4	430	return name;
f3b6f133	431
bf3c44f4	432	/* skip prefix */
049a6b3e	433	tmp = strchr(name, ':');
	434	if (tmp != NULL)
	435	name = tmp + 1;
	436
	437	return name;
da767bd5	438	}
da767bd5	439
906bdc9f	440	/* never returns NULL */
595491c4	441	const char *in_get_key_name(int dev_id, int keycode)
595491c4	442	{
906bdc9f	443	static char xname[16];
	444	const char *name;
	445
595491c4	446	if (dev_id < 0 \|\| dev_id >= IN_MAX_DEVS)
595491c4	447	return "Unkn0";
da767bd5	448
906bdc9f	449	name = DRV(in_devices[dev_id].drv_id).get_key_name(keycode);
	450	if (name != NULL)
	451	return name;
	452
	453	/* assume scancode */
	454	if ((keycode >= '0' && keycode <= '9') \|\| (keycode >= 'a' && keycode <= 'z')
	455	\|\| (keycode >= 'A' && keycode <= 'Z'))
	456	sprintf(xname, "%c", keycode);
	457	else
	458	sprintf(xname, "\\x%02X", keycode);
	459	return xname;
	460	}
	461
	462	int in_bind_key(int dev_id, int keycode, int mask, int force_unbind)
	463	{
	464	int ret, count;
	465	in_dev_t *dev;
	466
	467	if (dev_id < 0 \|\| dev_id >= IN_MAX_DEVS)
	468	return -1;
	469	dev = &in_devices[dev_id];
	470
	471	if (dev->binds == NULL) {
	472	if (force_unbind)
	473	return 0;
	474	dev->binds = in_alloc_binds(dev->drv_id);
	475	if (dev->binds == NULL)
	476	return -1;
	477	}
	478
	479	count = in_bind_count(dev->drv_id);
	480	if (keycode < 0 \|\| keycode >= count)
	481	return -1;
	482
	483	if (force_unbind)
	484	dev->binds[keycode] &= ~mask;
	485	else
	486	dev->binds[keycode] ^= mask;
	487
	488	ret = DRV(dev->drv_id).clean_binds(dev->drv_data, dev->binds);
	489	if (ret == 0) {
	490	free(dev->binds);
	491	dev->binds = NULL;
	492	}
	493
	494	return 0;
da767bd5	495	}
	496
	497	/* returns device id, or -1 on error */
	498	int in_config_parse_dev(const char *name)
	499	{
	500	int drv_id = -1, i;
	501
	502	for (i = 0; i < IN_DRVID_COUNT; i++) {
	503	int len = strlen(in_drivers[i].prefix);
	504	if (strncmp(name, in_drivers[i].prefix, len) == 0) {
	505	drv_id = i;
	506	break;
	507	}
	508	}
	509
	510	if (drv_id < 0) {
	511	printf("input: missing driver for %s\n", name);
	512	return -1;
	513	}
	514
	515	for (i = 0; i < in_dev_count; i++)
	516	{
	517	if (in_devices[i].name == NULL)
	518	continue;
	519	if (strcmp(in_devices[i].name, name) == 0)
	520	return i;
	521	}
	522
	523	if (i >= IN_MAX_DEVS)
	524	{
	525	/* try to find unused device */
	526	for (i = 0; i < IN_MAX_DEVS; i++)
	527	if (in_devices[i].name == NULL) break;
	528	if (i >= IN_MAX_DEVS) {
	529	printf("input: too many devices, can't add %s\n", name);
	530	return -1;
	531	}
	532	}
	533
	534	memset(&in_devices[i], 0, sizeof(in_devices[i]));
	535
	536	in_devices[i].name = strdup(name);
	537	if (in_devices[i].name == NULL)
	538	return -1;
	539
	540	if (i + 1 > in_dev_count)
	541	in_dev_count = i + 1;
	542	in_devices[i].drv_id = drv_id;
	543
	544	return i;
	545	}
	546
6c263f30	547	/*
	548	* To reduce size of game specific configs, default binds are not saved.
	549	* So we mark default binds in in_config_start(), override them in in_config_bind_key(),
	550	* and restore whatever default binds are left in in_config_end().
	551	*/
da767bd5	552	void in_config_start(void)
	553	{
	554	int i;
	555
	556	/* mark all default binds, so they get overwritten by func below */
	557	for (i = 0; i < IN_MAX_DEVS; i++) {
	558	int n, count, binds, def_binds;
	559
906bdc9f	560	binds = in_devices[i].binds;
906bdc9f	561	if (binds == NULL)
da767bd5	562	continue;
	563
	564	count = in_bind_count(in_devices[i].drv_id);
da767bd5	565	def_binds = binds + count;
	566
	567	for (n = 0; n < count; n++)
	568	if (binds[n] == def_binds[n])
	569	binds[n] = -1;
	570	}
	571	}
	572
	573	int in_config_bind_key(int dev_id, const char *key, int binds)
	574	{
906bdc9f	575	int count, kc;
906bdc9f	576	in_dev_t *dev;
da767bd5	577
	578	if (dev_id < 0 \|\| dev_id >= IN_MAX_DEVS)
	579	return -1;
906bdc9f	580	dev = &in_devices[dev_id];
da767bd5	581
906bdc9f	582	count = in_bind_count(dev->drv_id);
	583
	584	/* maybe a raw code? */
	585	if (key[0] == '\\' && key[1] == 'x') {
	586	char *p = NULL;
	587	kc = (int)strtoul(key + 2, &p, 16);
	588	if (p == NULL \|\| *p != 0)
	589	kc = -1;
	590	}
	591	else {
	592	/* device specific key name */
	593	if (dev->binds == NULL) {
	594	dev->binds = in_alloc_binds(dev->drv_id);
	595	if (dev->binds == NULL)
	596	return -1;
	597	in_config_start();
	598	}
	599
	600	kc = DRV(dev->drv_id).get_key_code(key);
	601	if (kc < 0 && strlen(key) == 1) {
	602	/* assume scancode */
	603	kc = key[0];
	604	}
da767bd5	605	}
da767bd5	606
906bdc9f	607	if (kc < 0 \|\| kc >= count) {
da767bd5	608	printf("input: bad key: %s\n", key);
da767bd5	609	return -1;
595491c4	610	}
595491c4	611
906bdc9f	612	if (dev->binds[kc] == -1)
	613	dev->binds[kc] = 0;
	614	dev->binds[kc] \|= binds;
da767bd5	615
	616	return 0;
	617	}
	618
	619	void in_config_end(void)
	620	{
	621	int i;
	622
	623	for (i = 0; i < IN_MAX_DEVS; i++) {
	624	int n, ret, count, binds, def_binds;
906bdc9f	625	in_dev_t *dev = &in_devices[i];
da767bd5	626
906bdc9f	627	if (dev->binds == NULL)
da767bd5	628	continue;
da767bd5	629
906bdc9f	630	count = in_bind_count(dev->drv_id);
906bdc9f	631	binds = dev->binds;
da767bd5	632	def_binds = binds + count;
	633
	634	for (n = 0; n < count; n++)
	635	if (binds[n] == -1)
	636	binds[n] = def_binds[n];
	637
906bdc9f	638	if (dev->drv_data == NULL)
da767bd5	639	continue;
da767bd5	640
906bdc9f	641	ret = DRV(dev->drv_id).clean_binds(dev->drv_data, binds);
da767bd5	642	if (ret == 0) {
da767bd5	643	/* no useable binds */
906bdc9f	644	free(dev->binds);
906bdc9f	645	dev->binds = NULL;
da767bd5	646	}
da767bd5	647	}
595491c4	648	}
595491c4	649
da767bd5	650	void in_debug_dump(void)
	651	{
	652	int i;
	653
	654	printf("# drv probed binds name\n");
	655	for (i = 0; i < IN_MAX_DEVS; i++) {
	656	in_dev_t *d = &in_devices[i];
	657	if (!d->probed && d->name == NULL && d->binds == NULL)
	658	continue;
	659	printf("%d %3d %6c %5c %s\n", i, d->drv_id, d->probed ? 'y' : 'n',
	660	d->binds ? 'y' : 'n', d->name);
	661	}
	662	}
	663
	664	/* handlers for unknown/not_preset drivers */
	665
	666	static void in_def_probe(void) {}
	667	static void in_def_free(void *drv_data) {}
	668	static int in_def_get_bind_count(void) { return 0; }
	669	static void in_def_get_def_binds(int *binds) {}
	670	static int in_def_clean_binds(void drv_data, int binds) { return 0; }
	671	static void in_def_set_blocking(void *data, int y) {}
7f022a8d	672	static int in_def_update_keycode(void drv_data, int is_down) { return 0; }
da767bd5	673	static int in_def_menu_translate(int keycode) { return keycode; }
	674	static int in_def_get_key_code(const char *key_name) { return 0; }
	675	static const char *in_def_get_key_name(int keycode) { return NULL; }
	676
2258f158	677	void in_init(void)
2258f158	678	{
da767bd5	679	int i;
	680
	681	memset(in_drivers, 0, sizeof(in_drivers));
2258f158	682	memset(in_devices, 0, sizeof(in_devices));
2258f158	683	in_dev_count = 0;
da767bd5	684
	685	for (i = 0; i < IN_DRVID_COUNT; i++) {
	686	in_drivers[i].prefix = "none:";
	687	in_drivers[i].probe = in_def_probe;
	688	in_drivers[i].free = in_def_free;
	689	in_drivers[i].get_bind_count = in_def_get_bind_count;
	690	in_drivers[i].get_def_binds = in_def_get_def_binds;
	691	in_drivers[i].clean_binds = in_def_clean_binds;
	692	in_drivers[i].set_blocking = in_def_set_blocking;
7f022a8d	693	in_drivers[i].update_keycode = in_def_update_keycode;
da767bd5	694	in_drivers[i].menu_translate = in_def_menu_translate;
	695	in_drivers[i].get_key_code = in_def_get_key_code;
	696	in_drivers[i].get_key_name = in_def_get_key_name;
	697	}
	698
13b692eb	699	#ifdef IN_GP2X
	700	in_gp2x_init(&in_drivers[IN_DRVID_GP2X]);
	701	#endif
da767bd5	702	#ifdef IN_EVDEV
	703	in_evdev_init(&in_drivers[IN_DRVID_EVDEV]);
	704	#endif
2258f158	705	}
2258f158	706
da767bd5	707	#if 0
2258f158	708	int main(void)
2258f158	709	{
34581c95	710	int ret;
34581c95	711
2258f158	712	in_init();
	713	in_probe();
	714
595491c4	715	in_set_blocking(1);
	716
	717	#if 1
	718	while (1) {
	719	int dev = 0, down;
	720	ret = in_update_keycode(&dev, &down);
	721	printf("#%i: %i %i (%s)\n", dev, down, ret, in_get_key_name(dev, ret));
	722	}
	723	#else
2258f158	724	while (1) {
fce20e73	725	ret = in_menu_wait_any();
34581c95	726	printf("%08x\n", ret);
2258f158	727	}
595491c4	728	#endif
2258f158	729
	730	return 0;
	731	}
da767bd5	732	#endif