1 /*
2  * (C) Gražvydas "notaz" Ignotas, 2008-2011
3  *
4  * This work is licensed under the terms of any of these licenses
5  * (at your option):
6  *  - GNU GPL, version 2 or later.
7  *  - GNU LGPL, version 2.1 or later.
8  *  - MAME license.
9  * See the COPYING file in the top-level directory.
10  */
11 
12 #include <stdio.h>
13 #include <stdlib.h>
14 #include <string.h>
15 
16 #include "input.h"
17 #include "plat.h"
18 #include "lprintf.h"
19 
20 #ifdef IN_VK
21 #error needs update: in_vk_init in_vk_update
22 #include "../win32/in_vk.h"
23 #endif
24 
25 typedef struct
26 {
27 	int drv_id;
28 	int drv_fd_hnd;
29 	void *drv_data;
30 	char *name;
31 	int key_count;
32 	int *binds;	/* total = key_count * bindtypes * 2 */
33 	const char * const *key_names;
34 	unsigned int probed:1;
35 	unsigned int does_combos:1;
36 } in_dev_t;
37 
38 static in_drv_t *in_drivers;
39 static in_dev_t in_devices[IN_MAX_DEVS];
40 static int in_driver_count = 0;
41 static int in_dev_count = 0;		/* probed + bind devices */
42 static int in_have_async_devs = 0;
43 static int in_probe_dev_id;
44 static int menu_key_state = 0;
45 static int menu_last_used_dev = 0;
46 static int menu_key_prev = 0;
47 static int menu_key_mask = 0;
48 static int menu_key_repeat = 0;
49 
50 #define DRV(id) in_drivers[id]
51 
52 
in_alloc_binds(int drv_id,int key_count)53 static int *in_alloc_binds(int drv_id, int key_count)
54 {
55 	const struct in_default_bind *defbinds;
56 	int *binds, *binds_d;
57 	int i;
58 
59 	binds = calloc(key_count * IN_BINDTYPE_COUNT * 2, sizeof(binds[0]));
60 	if (binds == NULL)
61 		return NULL;
62 
63 	binds_d = binds + key_count * IN_BINDTYPE_COUNT;
64 
65 	/* always have a copy of defbinds */
66 	defbinds = DRV(drv_id).defbinds;
67 	if (defbinds != NULL) {
68 		for (i = 0; ; i++) {
69 			if (defbinds[i].code == 0 && defbinds[i].btype == 0
70 			    && defbinds[i].bit == 0)
71 				break;
72 
73 			binds_d[IN_BIND_OFFS(defbinds[i].code, defbinds[i].btype)] |=
74 				1 << defbinds[i].bit;
75 		}
76 	}
77 
78 	return binds;
79 }
80 
in_unprobe(in_dev_t * dev)81 static void in_unprobe(in_dev_t *dev)
82 {
83 	if (dev->probed)
84 		DRV(dev->drv_id).free(dev->drv_data);
85 	dev->probed = 0;
86 	dev->drv_data = NULL;
87 }
88 
in_free(in_dev_t * dev)89 static void in_free(in_dev_t *dev)
90 {
91 	in_unprobe(dev);
92 	free(dev->name);
93 	dev->name = NULL;
94 	free(dev->binds);
95 	dev->binds = NULL;
96 }
97 
98 /* to be called by drivers
99  * async devices must set drv_fd_hnd to -1 */
in_register(const char * nname,int drv_fd_hnd,void * drv_data,int key_count,const char * const * key_names,int combos)100 void in_register(const char *nname, int drv_fd_hnd, void *drv_data,
101 		int key_count, const char * const *key_names, int combos)
102 {
103 	int i, ret, dupe_count = 0, *binds;
104 	char name[256], *name_end, *tmp;
105 
106 	strncpy(name, nname, sizeof(name));
107 	name[sizeof(name)-12] = 0;
108 	name_end = name + strlen(name);
109 
110 	for (i = 0; i < in_dev_count; i++)
111 	{
112 		if (in_devices[i].name == NULL)
113 			continue;
114 		if (strcmp(in_devices[i].name, name) == 0)
115 		{
116 			if (in_devices[i].probed) {
117 				dupe_count++;
118 				sprintf(name_end, " [%d]", dupe_count);
119 				continue;
120 			}
121 			goto update;
122 		}
123 	}
124 
125 	if (i >= IN_MAX_DEVS)
126 	{
127 		/* try to find unused device */
128 		for (i = 0; i < IN_MAX_DEVS; i++)
129 			if (!in_devices[i].probed) break;
130 		if (i >= IN_MAX_DEVS) {
131 			lprintf("input: too many devices, can't add %s\n", name);
132 			return;
133 		}
134 		in_free(&in_devices[i]);
135 	}
136 
137 	tmp = strdup(name);
138 	if (tmp == NULL)
139 		return;
140 
141 	binds = in_alloc_binds(in_probe_dev_id, key_count);
142 	if (binds == NULL) {
143 		free(tmp);
144 		return;
145 	}
146 
147 	memcpy(binds, binds + key_count * IN_BINDTYPE_COUNT,
148 		sizeof(binds[0]) * key_count * IN_BINDTYPE_COUNT);
149 
150 	in_devices[i].name = tmp;
151 	in_devices[i].binds = binds;
152 	in_devices[i].key_count = key_count;
153 	if (i + 1 > in_dev_count)
154 		in_dev_count = i + 1;
155 
156 	lprintf("input: new device #%d \"%s\"\n", i, name);
157 update:
158 	in_devices[i].probed = 1;
159 	in_devices[i].does_combos = combos;
160 	in_devices[i].drv_id = in_probe_dev_id;
161 	in_devices[i].drv_fd_hnd = drv_fd_hnd;
162 	in_devices[i].key_names = key_names;
163 	in_devices[i].drv_data = drv_data;
164 
165 	if (in_devices[i].binds != NULL) {
166 		ret = DRV(in_probe_dev_id).clean_binds(drv_data, in_devices[i].binds,
167 			in_devices[i].binds + key_count * IN_BINDTYPE_COUNT);
168 		if (ret == 0) {
169 			/* no useable binds */
170 			free(in_devices[i].binds);
171 			in_devices[i].binds = NULL;
172 		}
173 	}
174 }
175 
176 /* key combo handling, to be called by drivers that support it.
177  * Only care about IN_BINDTYPE_EMU */
in_combos_find(const int * binds,int last_key,int * combo_keys,int * combo_acts)178 void in_combos_find(const int *binds, int last_key, int *combo_keys, int *combo_acts)
179 {
180 	int act, u;
181 
182 	*combo_keys = *combo_acts = 0;
183 	for (act = 0; act < sizeof(binds[0]) * 8; act++)
184 	{
185 		int keyc = 0;
186 		for (u = 0; u <= last_key; u++)
187 			if (binds[IN_BIND_OFFS(u, IN_BINDTYPE_EMU)] & (1 << act))
188 				keyc++;
189 
190 		if (keyc > 1)
191 		{
192 			// loop again and mark those keys and actions as combo
193 			for (u = 0; u <= last_key; u++)
194 			{
195 				if (binds[IN_BIND_OFFS(u, IN_BINDTYPE_EMU)] & (1 << act)) {
196 					*combo_keys |= 1 << u;
197 					*combo_acts |= 1 << act;
198 				}
199 			}
200 		}
201 	}
202 }
203 
in_combos_do(int keys,const int * binds,int last_key,int combo_keys,int combo_acts)204 int in_combos_do(int keys, const int *binds, int last_key, int combo_keys, int combo_acts)
205 {
206 	int i, ret = 0;
207 
208 	for (i = 0; i <= last_key; i++)
209 	{
210 		int acts, acts_c, u;
211 
212 		if (!(keys & (1 << i)))
213 			continue;
214 
215 		acts = binds[IN_BIND_OFFS(i, IN_BINDTYPE_EMU)];
216 		if (!acts)
217 			continue;
218 
219 		if (!(combo_keys & (1 << i))) {
220 			ret |= acts;
221 			continue;
222 		}
223 
224 		acts_c = acts & combo_acts;
225 		u = last_key;
226 		if (acts_c) {
227 			// let's try to find the other one
228 			for (u = i + 1; u <= last_key; u++)
229 				if ( (keys & (1 << u)) && (binds[IN_BIND_OFFS(u, IN_BINDTYPE_EMU)] & acts_c) ) {
230 					ret |= acts_c & binds[IN_BIND_OFFS(u, IN_BINDTYPE_EMU)];
231 					keys &= ~((1 << i) | (1 << u));
232 					break;
233 				}
234 		}
235 		// add non-combo actions if combo ones were not found
236 		if (u >= last_key)
237 			ret |= acts & ~combo_acts;
238 	}
239 
240 	return ret;
241 }
242 
in_probe(void)243 void in_probe(void)
244 {
245 	int i;
246 
247 	in_have_async_devs = 0;
248 	menu_key_state = 0;
249 	menu_last_used_dev = 0;
250 
251 	for (i = 0; i < in_dev_count; i++)
252 		in_unprobe(&in_devices[i]);
253 
254 	for (i = 0; i < in_driver_count; i++) {
255 		in_probe_dev_id = i;
256 		in_drivers[i].probe(&DRV(i));
257 	}
258 
259 	/* get rid of devs without binds and probes */
260 	for (i = 0; i < in_dev_count; i++) {
261 		if (!in_devices[i].probed && in_devices[i].binds == NULL) {
262 			in_dev_count--;
263 			if (i < in_dev_count) {
264 				free(in_devices[i].name);
265 				memmove(&in_devices[i], &in_devices[i+1],
266 					(in_dev_count - i) * sizeof(in_devices[0]));
267 			}
268 
269 			continue;
270 		}
271 
272 		if (in_devices[i].probed && in_devices[i].drv_fd_hnd == -1)
273 			in_have_async_devs = 1;
274 	}
275 
276 	if (in_have_async_devs)
277 		lprintf("input: async-only devices detected..\n");
278 
279 	in_debug_dump();
280 }
281 
282 /* async update */
in_update(int * result)283 int in_update(int *result)
284 {
285 	int i, ret = 0;
286 
287 	for (i = 0; i < in_dev_count; i++) {
288 		in_dev_t *dev = &in_devices[i];
289 		if (dev->probed && dev->binds != NULL)
290 			ret |= DRV(dev->drv_id).update(dev->drv_data, dev->binds, result);
291 	}
292 
293 	return ret;
294 }
295 
get_dev(int dev_id)296 static in_dev_t *get_dev(int dev_id)
297 {
298 	if (dev_id < 0 || dev_id >= IN_MAX_DEVS)
299 		return NULL;
300 
301 	return &in_devices[dev_id];
302 }
303 
in_update_analog(int dev_id,int axis_id,int * result)304 int in_update_analog(int dev_id, int axis_id, int *result)
305 {
306 	in_dev_t *dev = get_dev(dev_id);
307 
308 	if (dev == NULL || !dev->probed)
309 		return -1;
310 
311 	return DRV(dev->drv_id).update_analog(dev->drv_data, axis_id, result);
312 }
313 
in_update_kc_async(int * dev_id_out,int * is_down_out,int timeout_ms)314 static int in_update_kc_async(int *dev_id_out, int *is_down_out, int timeout_ms)
315 {
316 	int i, is_down, result;
317 	unsigned int ticks;
318 
319 	ticks = plat_get_ticks_ms();
320 
321 	while (1)
322 	{
323 		for (i = 0; i < in_dev_count; i++) {
324 			in_dev_t *d = &in_devices[i];
325 			if (!d->probed)
326 				continue;
327 
328 			result = DRV(d->drv_id).update_keycode(d->drv_data, &is_down);
329 			if (result == -1)
330 				continue;
331 
332 			if (dev_id_out)
333 				*dev_id_out = i;
334 			if (is_down_out)
335 				*is_down_out = is_down;
336 			return result;
337 		}
338 
339 		if (timeout_ms >= 0 && (int)(plat_get_ticks_ms() - ticks) > timeout_ms)
340 			break;
341 
342 		plat_sleep_ms(10);
343 	}
344 
345 	return -1;
346 }
347 
348 /*
349  * wait for a press, always return some keycode or -1 on timeout or error
350  */
in_update_keycode(int * dev_id_out,int * is_down_out,char * charcode,int timeout_ms)351 int in_update_keycode(int *dev_id_out, int *is_down_out, char *charcode, int timeout_ms)
352 {
353 	int result = -1, dev_id = 0, is_down, result_menu;
354 	int fds_hnds[IN_MAX_DEVS];
355 	int i, ret, count = 0;
356 	in_drv_t *drv = NULL;
357 	unsigned int ticks;
358 
359 	if (in_have_async_devs) {
360 		result = in_update_kc_async(&dev_id, &is_down, timeout_ms);
361 		if (result == -1)
362 			return -1;
363 		drv = &DRV(in_devices[dev_id].drv_id);
364 		goto finish;
365 	}
366 
367 	ticks = plat_get_ticks_ms();
368 
369 	for (i = 0; i < in_dev_count; i++) {
370 		if (in_devices[i].probed)
371 			fds_hnds[count++] = in_devices[i].drv_fd_hnd;
372 	}
373 
374 	if (count == 0) {
375 		/* don't deadlock, fail */
376 		lprintf("input: failed to find devices to read\n");
377 		exit(1);
378 	}
379 
380 	while (1)
381 	{
382 		ret = plat_wait_event(fds_hnds, count, timeout_ms);
383 		if (ret < 0)
384 			break;
385 
386 		for (i = 0; i < in_dev_count; i++) {
387 			if (in_devices[i].drv_fd_hnd == ret) {
388 				dev_id = i;
389 				break;
390 			}
391 		}
392 
393 		drv = &DRV(in_devices[dev_id].drv_id);
394 		result = drv->update_keycode(in_devices[dev_id].drv_data, &is_down);
395 		if (result >= 0)
396 			break;
397 
398 		if (result == -2) {
399 			lprintf("input: \"%s\" errored out, removing.\n", in_devices[dev_id].name);
400 			in_unprobe(&in_devices[dev_id]);
401 			break;
402 		}
403 
404 		if (timeout_ms >= 0) {
405 			unsigned int ticks2 = plat_get_ticks_ms();
406 			timeout_ms -= ticks2 - ticks;
407 			ticks = ticks2;
408 			if (timeout_ms <= 0)
409 				break;
410 		}
411 	}
412 
413 	if (result < 0)
414 		return -1;
415 finish:
416 	/* keep track of menu key state, to allow mixing
417 	 * in_update_keycode() and in_menu_wait_any() calls */
418 	result_menu = drv->menu_translate(in_devices[dev_id].drv_data, result, charcode);
419 	if (result_menu != 0) {
420 		if (is_down)
421 			menu_key_state |=  result_menu;
422 		else
423 			menu_key_state &= ~result_menu;
424 	}
425 
426 	if (dev_id_out != NULL)
427 		*dev_id_out = dev_id;
428 	if (is_down_out != NULL)
429 		*is_down_out = is_down;
430 	return result;
431 }
432 
433 /* same as above, only return bitfield of PBTN_*  */
in_menu_wait_any(char * charcode,int timeout_ms)434 int in_menu_wait_any(char *charcode, int timeout_ms)
435 {
436 	int keys_old = menu_key_state;
437 	int ret;
438 	int dev_id = 0;
439 
440 	menu_key_prev = menu_key_state;
441 
442 	in_update_keycode(&dev_id, NULL, charcode, timeout_ms);
443 
444 	if (keys_old != menu_key_state)
445 		menu_last_used_dev = dev_id;
446 
447 	ret = menu_key_state;
448 	if (ret == 0)
449 		menu_key_mask = menu_key_prev = 0;
450 	else if (ret != menu_key_prev)
451 		menu_key_mask = menu_key_prev;
452 
453 	return ret;
454 }
455 
456 /* wait for menu input, do autorepeat */
in_menu_wait(int interesting,char * charcode,int autorep_delay_ms)457 int in_menu_wait(int interesting, char *charcode, int autorep_delay_ms)
458 {
459 	int ret, wait = 450;
460 
461 	if (menu_key_repeat)
462 		wait = autorep_delay_ms;
463 
464 	/* wait until either key repeat or a new key has been pressed */
465 	do {
466 		ret = in_menu_wait_any(charcode, wait);
467 		if (ret == 0 || ret != menu_key_prev)
468 			menu_key_repeat = 0;
469 		else
470 			menu_key_repeat++;
471 		wait = -1;
472 	 	/* mask away all old keys if an additional new key is pressed */
473 		/* XXX what if old and new keys share bits (PBTN_CHAR)? */
474 		ret &= ~menu_key_mask;
475 	} while (!(ret & interesting));
476 
477 	/* we don't need diagonals in menus */
478 	if (ret & (PBTN_UP|PBTN_DOWN))  ret &= ~(PBTN_LEFT|PBTN_RIGHT);
479 
480 	return ret;
481 }
482 
in_get_dev_binds(int dev_id)483 const int *in_get_dev_binds(int dev_id)
484 {
485 	in_dev_t *dev = get_dev(dev_id);
486 
487 	return dev ? dev->binds : NULL;
488 }
489 
in_get_dev_def_binds(int dev_id)490 const int *in_get_dev_def_binds(int dev_id)
491 {
492 	in_dev_t *dev = get_dev(dev_id);
493 	if (dev == NULL)
494 		return NULL;
495 	if (dev->binds == NULL)
496 		return NULL;
497 
498 	return dev->binds + dev->key_count * IN_BINDTYPE_COUNT;
499 }
500 
in_get_config(int dev_id,int what,void * val)501 int in_get_config(int dev_id, int what, void *val)
502 {
503 	int *ival = val;
504 	in_dev_t *dev;
505 
506 	dev = get_dev(dev_id);
507 	if (dev == NULL || val == NULL)
508 		return -1;
509 
510 	switch (what) {
511 	case IN_CFG_BIND_COUNT:
512 		*ival = dev->key_count;
513 		break;
514 	case IN_CFG_DOES_COMBOS:
515 		*ival = dev->does_combos;
516 		break;
517 	case IN_CFG_BLOCKING:
518 	case IN_CFG_KEY_NAMES:
519 		return -1; /* not implemented */
520 	default:
521 		if (!dev->probed)
522 			return -1;
523 
524 		return DRV(dev->drv_id).get_config(dev->drv_data, what, ival);
525 	}
526 
527 	return 0;
528 }
529 
in_set_blocking(int is_blocking)530 static int in_set_blocking(int is_blocking)
531 {
532 	int i, ret;
533 
534 	/* have_async_devs means we will have to do all reads async anyway.. */
535 	if (!in_have_async_devs) {
536 		for (i = 0; i < in_dev_count; i++) {
537 			if (!in_devices[i].probed)
538 				continue;
539 
540 			DRV(in_devices[i].drv_id).set_config(
541 				in_devices[i].drv_data, IN_CFG_BLOCKING,
542 				is_blocking);
543 		}
544 	}
545 
546 	/* flush events */
547 	do {
548 		ret = in_update_keycode(NULL, NULL, NULL, 0);
549 	} while (ret >= 0);
550 
551 	menu_key_state = 0;
552 
553 	return 0;
554 }
555 
in_set_config(int dev_id,int what,const void * val,int size)556 int in_set_config(int dev_id, int what, const void *val, int size)
557 {
558 	const char * const *names;
559 	const int *ival = val;
560 	in_dev_t *dev;
561 	int count;
562 
563 	if (what == IN_CFG_BLOCKING)
564 		return in_set_blocking(*ival);
565 
566 	dev = get_dev(dev_id);
567 	if (dev == NULL)
568 		return -1;
569 
570 	switch (what) {
571 	case IN_CFG_KEY_NAMES:
572 		names = val;
573 		count = size / sizeof(names[0]);
574 
575 		if (count < dev->key_count) {
576 			lprintf("input: set_key_names: not enough keys\n");
577 			return -1;
578 		}
579 
580 		dev->key_names = names;
581 		return 0;
582 	case IN_CFG_DEFAULT_DEV:
583 		/* just set last used dev, for now */
584 		menu_last_used_dev = dev_id;
585 		return 0;
586 	default:
587 		break;
588 	}
589 
590 	if (dev->probed)
591 		return DRV(dev->drv_id).set_config(dev->drv_data, what, *ival);
592 
593 	return -1;
594 }
595 
in_get_dev_name(int dev_id,int must_be_active,int skip_pfix)596 const char *in_get_dev_name(int dev_id, int must_be_active, int skip_pfix)
597 {
598 	const char *name, *tmp;
599 	in_dev_t *dev;
600 
601 	dev = get_dev(dev_id);
602 	if (dev == NULL)
603 		return NULL;
604 
605 	if (must_be_active && !dev->probed)
606 		return NULL;
607 
608 	name = dev->name;
609 	if (name == NULL || !skip_pfix)
610 		return name;
611 
612 	/* skip prefix */
613 	tmp = strchr(name, ':');
614 	if (tmp != NULL)
615 		name = tmp + 1;
616 
617 	return name;
618 }
619 
in_name_to_id(const char * dev_name)620 int in_name_to_id(const char *dev_name)
621 {
622 	int i;
623 
624 	for (i = 0; i < in_dev_count; i++)
625 		if (strcmp(dev_name, in_devices[i].name) == 0)
626 			break;
627 
628 	if (i >= in_dev_count) {
629 		lprintf("input: in_name_to_id: no such device: %s\n", dev_name);
630 		return -1;
631 	}
632 
633 	return i;
634 }
635 
636 /* never returns NULL */
in_get_key_name(int dev_id,int keycode)637 const char *in_get_key_name(int dev_id, int keycode)
638 {
639 	const char *name = NULL;
640 	static char xname[16];
641 	in_drv_t *drv;
642 	in_dev_t *dev;
643 
644 	if (dev_id < 0)		/* want last used dev? */
645 		dev_id = menu_last_used_dev;
646 
647 	dev = get_dev(dev_id);
648 	if (dev == NULL)
649 		return "Unkn0";
650 
651 	drv = &DRV(dev->drv_id);
652 	if (keycode < 0)	/* want name for menu key? */
653 		keycode = drv->menu_translate(dev->drv_data, keycode, NULL);
654 
655 	if (dev->key_names != NULL && 0 <= keycode && keycode < dev->key_count)
656 		name = dev->key_names[keycode];
657 	if (name != NULL)
658 		return name;
659 
660 	if (drv->get_key_name != NULL)
661 		name = drv->get_key_name(keycode);
662 	if (name != NULL)
663 		return name;
664 
665 	/* assume scancode */
666 	if ((keycode >= '0' && keycode <= '9') || (keycode >= 'a' && keycode <= 'z')
667 			|| (keycode >= 'A' && keycode <= 'Z'))
668 		sprintf(xname, "%c", keycode);
669 	else
670 		sprintf(xname, "\\x%02X", keycode);
671 	return xname;
672 }
673 
in_get_key_code(int dev_id,const char * key_name)674 int in_get_key_code(int dev_id, const char *key_name)
675 {
676 	in_dev_t *dev;
677 	int i;
678 
679 	if (dev_id < 0)		/* want last used dev? */
680 		dev_id = menu_last_used_dev;
681 
682 	dev = get_dev(dev_id);
683 	if (dev == NULL)
684 		return -1;
685 
686 	if (dev->key_names == NULL)
687 		return -1;
688 
689 	for (i = 0; i < dev->key_count; i++)
690 		if (dev->key_names[i] && strcasecmp(dev->key_names[i], key_name) == 0)
691 			return i;
692 
693 	return -1;
694 }
695 
in_bind_key(int dev_id,int keycode,int mask,int bind_type,int force_unbind)696 int in_bind_key(int dev_id, int keycode, int mask, int bind_type, int force_unbind)
697 {
698 	int ret, count;
699 	in_dev_t *dev;
700 
701 	dev = get_dev(dev_id);
702 	if (dev == NULL || bind_type >= IN_BINDTYPE_COUNT)
703 		return -1;
704 
705 	count = dev->key_count;
706 
707 	if (dev->binds == NULL) {
708 		if (force_unbind)
709 			return 0;
710 		dev->binds = in_alloc_binds(dev->drv_id, count);
711 		if (dev->binds == NULL)
712 			return -1;
713 	}
714 
715 	if (keycode < 0 || keycode >= count)
716 		return -1;
717 
718 	if (force_unbind)
719 		dev->binds[IN_BIND_OFFS(keycode, bind_type)] &= ~mask;
720 	else
721 		dev->binds[IN_BIND_OFFS(keycode, bind_type)] ^=  mask;
722 
723 	ret = DRV(dev->drv_id).clean_binds(dev->drv_data, dev->binds,
724 				dev->binds + count * IN_BINDTYPE_COUNT);
725 	if (ret == 0) {
726 		free(dev->binds);
727 		dev->binds = NULL;
728 	}
729 
730 	return 0;
731 }
732 
733 /*
734  * Unbind act_mask on binds with type bind_type
735  * - if dev_id_ < 0, affects all devices
736  *   else only affects dev_id_
737  * - if act_mask == -1, unbind all keys
738  *   else only actions in mask
739  */
in_unbind_all(int dev_id_,int act_mask,int bind_type)740 void in_unbind_all(int dev_id_, int act_mask, int bind_type)
741 {
742 	int dev_id = 0, dev_last = IN_MAX_DEVS - 1;
743 	int i, count;
744 	in_dev_t *dev;
745 
746 	if (dev_id_ >= 0)
747 		dev_id = dev_last = dev_id_;
748 
749 	if (bind_type >= IN_BINDTYPE_COUNT)
750 		return;
751 
752 	for (; dev_id <= dev_last; dev_id++) {
753 		dev = &in_devices[dev_id];
754 		count = dev->key_count;
755 
756 		if (dev->binds == NULL)
757 			continue;
758 
759 		if (act_mask != -1) {
760 			for (i = 0; i < count; i++)
761 				dev->binds[IN_BIND_OFFS(i, bind_type)] &= ~act_mask;
762 		}
763 		else
764 			memset(dev->binds, 0, sizeof(dev->binds[0]) * count * IN_BINDTYPE_COUNT);
765 	}
766 }
767 
768 /* returns device id, or -1 on error */
in_config_parse_dev(const char * name)769 int in_config_parse_dev(const char *name)
770 {
771 	int drv_id = -1, i;
772 
773 	for (i = 0; i < in_driver_count; i++) {
774 		int len = strlen(in_drivers[i].prefix);
775 		if (strncmp(name, in_drivers[i].prefix, len) == 0) {
776 			drv_id = i;
777 			break;
778 		}
779 	}
780 
781 	if (drv_id < 0) {
782 		lprintf("input: missing driver for '%s'\n", name);
783 		return -1;
784 	}
785 
786 	for (i = 0; i < in_dev_count; i++)
787 	{
788 		if (in_devices[i].name == NULL)
789 			continue;
790 		if (strcmp(in_devices[i].name, name) == 0)
791 			return i;
792 	}
793 
794 	if (i >= IN_MAX_DEVS)
795 	{
796 		/* try to find unused device */
797 		for (i = 0; i < IN_MAX_DEVS; i++)
798 			if (in_devices[i].name == NULL) break;
799 		if (i >= IN_MAX_DEVS) {
800 			lprintf("input: too many devices, can't add '%s'\n",
801 				name);
802 			return -1;
803 		}
804 	}
805 
806 	memset(&in_devices[i], 0, sizeof(in_devices[i]));
807 
808 	in_devices[i].name = strdup(name);
809 	if (in_devices[i].name == NULL)
810 		return -1;
811 
812 	in_devices[i].key_names = DRV(drv_id).get_key_names(&DRV(drv_id),
813 				&in_devices[i].key_count);
814 	in_devices[i].drv_id = drv_id;
815 
816 	if (i + 1 > in_dev_count)
817 		in_dev_count = i + 1;
818 
819 	return i;
820 }
821 
in_config_bind_key(int dev_id,const char * key,int acts,int bind_type)822 int in_config_bind_key(int dev_id, const char *key, int acts, int bind_type)
823 {
824 	in_dev_t *dev;
825 	int i, offs, kc;
826 
827 	dev = get_dev(dev_id);
828 	if (dev == NULL || bind_type >= IN_BINDTYPE_COUNT)
829 		return -1;
830 
831 	/* maybe a raw code? */
832 	if (key[0] == '\\' && key[1] == 'x') {
833 		char *p = NULL;
834 		kc = (int)strtoul(key + 2, &p, 16);
835 		if (p == NULL || *p != 0)
836 			kc = -1;
837 	}
838 	else {
839 		/* device specific key name */
840 		if (dev->binds == NULL) {
841 			dev->binds = in_alloc_binds(dev->drv_id, dev->key_count);
842 			if (dev->binds == NULL)
843 				return -1;
844 		}
845 
846 		kc = -1;
847 		if (dev->key_names != NULL) {
848 			for (i = 0; i < dev->key_count; i++) {
849 				const char *k = dev->key_names[i];
850 				if (k != NULL && strcasecmp(k, key) == 0) {
851 					kc = i;
852 					break;
853 				}
854 			}
855 		}
856 
857 		if (kc < 0)
858 			kc = DRV(dev->drv_id).get_key_code(key);
859 		if (kc < 0 && strlen(key) == 1) {
860 			/* assume scancode */
861 			kc = key[0];
862 		}
863 	}
864 
865 	if (kc < 0 || kc >= dev->key_count) {
866 		lprintf("input: bad key: '%s' for device '%s'\n",
867 			key, dev->name);
868 		return -1;
869 	}
870 
871 	if (bind_type == IN_BINDTYPE_NONE) {
872 		for (i = 0; i < IN_BINDTYPE_COUNT; i++)
873 			dev->binds[IN_BIND_OFFS(kc, i)] = 0;
874 		return 0;
875 	}
876 
877 	offs = IN_BIND_OFFS(kc, bind_type);
878 	if (dev->binds[offs] == -1)
879 		dev->binds[offs] = 0;
880 	dev->binds[offs] |= acts;
881 	return 0;
882 }
883 
in_clean_binds(void)884 void in_clean_binds(void)
885 {
886 	int i;
887 
888 	for (i = 0; i < IN_MAX_DEVS; i++) {
889 		int ret, count, *binds, *def_binds;
890 		in_dev_t *dev = &in_devices[i];
891 
892 		if (dev->binds == NULL || !dev->probed)
893 			continue;
894 
895 		count = dev->key_count;
896 		binds = dev->binds;
897 		def_binds = binds + count * IN_BINDTYPE_COUNT;
898 
899 		ret = DRV(dev->drv_id).clean_binds(dev->drv_data, binds, def_binds);
900 		if (ret == 0) {
901 			/* no useable binds */
902 			free(dev->binds);
903 			dev->binds = NULL;
904 		}
905 	}
906 }
907 
in_debug_dump(void)908 void in_debug_dump(void)
909 {
910 	int i;
911 
912 	lprintf("# drv probed binds name\n");
913 	for (i = 0; i < IN_MAX_DEVS; i++) {
914 		in_dev_t *d = &in_devices[i];
915 		if (!d->probed && d->name == NULL && d->binds == NULL)
916 			continue;
917 		lprintf("%d %3d %6c %5c %s\n", i, d->drv_id,
918 			d->probed ? 'y' : 'n',
919 			d->binds ? 'y' : 'n', d->name);
920 #if 0
921 		if (d->binds) {
922 			int kc, o, t, h;
923 			for (kc = 0; kc < d->key_count; kc++) {
924 				o = IN_BIND_OFFS(kc, 0);
925 				for (t = h = 0; t < IN_BINDTYPE_COUNT; t++)
926 					h |= d->binds[o + t];
927 				if (h == 0)
928 					continue;
929 				lprintf("  [%3d] =", kc);
930 				for (t = 0; t < IN_BINDTYPE_COUNT; t++)
931 					printf(" %x", d->binds[o + t]);
932 				printf("\n");
933 			}
934 		}
935 #endif
936 	}
937 }
938 
939 /* stubs for drivers that choose not to implement something */
940 
in_def_free(void * drv_data)941 static void in_def_free(void *drv_data) {}
in_def_clean_binds(void * drv_data,int * b,int * db)942 static int  in_def_clean_binds(void *drv_data, int *b, int *db) { return 1; }
in_def_get_config(void * drv_data,int what,int * val)943 static int  in_def_get_config(void *drv_data, int what, int *val) { return -1; }
in_def_set_config(void * drv_data,int what,int val)944 static int  in_def_set_config(void *drv_data, int what, int val) { return -1; }
in_def_update_analog(void * drv_data,int axis_id,int * result)945 static int  in_def_update_analog(void *drv_data, int axis_id, int *result) { return -1; }
in_def_update_keycode(void * drv_data,int * is_down)946 static int  in_def_update_keycode(void *drv_data, int *is_down) { return 0; }
in_def_menu_translate(void * drv_data,int keycode,char * ccode)947 static int  in_def_menu_translate(void *drv_data, int keycode, char *ccode) { return 0; }
in_def_get_key_code(const char * key_name)948 static int  in_def_get_key_code(const char *key_name) { return -1; }
in_def_get_key_name(int keycode)949 static const char *in_def_get_key_name(int keycode) { return NULL; }
950 
951 #define CHECK_ADD_STUB(d, f) \
952 	if (d.f == NULL) d.f = in_def_##f
953 
954 /* to be called by drivers */
in_register_driver(const in_drv_t * drv,const struct in_default_bind * defbinds,const void * pdata)955 int in_register_driver(const in_drv_t *drv,
956 			const struct in_default_bind *defbinds, const void *pdata)
957 {
958 	int count_new = in_driver_count + 1;
959 	in_drv_t *new_drivers;
960 
961 	new_drivers = realloc(in_drivers, count_new * sizeof(in_drivers[0]));
962 	if (new_drivers == NULL) {
963 		lprintf("input: in_register_driver OOM\n");
964 		return -1;
965 	}
966 
967 	memcpy(&new_drivers[in_driver_count], drv, sizeof(new_drivers[0]));
968 
969 	CHECK_ADD_STUB(new_drivers[in_driver_count], free);
970 	CHECK_ADD_STUB(new_drivers[in_driver_count], clean_binds);
971 	CHECK_ADD_STUB(new_drivers[in_driver_count], get_config);
972 	CHECK_ADD_STUB(new_drivers[in_driver_count], set_config);
973 	CHECK_ADD_STUB(new_drivers[in_driver_count], update_analog);
974 	CHECK_ADD_STUB(new_drivers[in_driver_count], update_keycode);
975 	CHECK_ADD_STUB(new_drivers[in_driver_count], menu_translate);
976 	CHECK_ADD_STUB(new_drivers[in_driver_count], get_key_code);
977 	CHECK_ADD_STUB(new_drivers[in_driver_count], get_key_name);
978 	if (pdata)
979 		new_drivers[in_driver_count].pdata = pdata;
980 	if (defbinds)
981 		new_drivers[in_driver_count].defbinds = defbinds;
982 	in_drivers = new_drivers;
983 	in_driver_count = count_new;
984 
985 	return 0;
986 }
987 
in_init(void)988 void in_init(void)
989 {
990 	in_drivers = NULL;
991 	memset(in_devices, 0, sizeof(in_devices));
992 	in_driver_count = 0;
993 	in_dev_count = 0;
994 }
995 
996 #if 0
997 int main(void)
998 {
999 	int ret;
1000 
1001 	in_init();
1002 	in_probe();
1003 
1004 	in_set_blocking(1);
1005 
1006 #if 1
1007 	while (1) {
1008 		int dev = 0, down;
1009 		ret = in_update_keycode(&dev, &down);
1010 		lprintf("#%i: %i %i (%s)\n", dev, down, ret, in_get_key_name(dev, ret));
1011 	}
1012 #else
1013 	while (1) {
1014 		ret = in_menu_wait_any();
1015 		lprintf("%08x\n", ret);
1016 	}
1017 #endif
1018 
1019 	return 0;
1020 }
1021 #endif
1022