input.c

   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
  47 #define DRV(id) in_drivers[id]
  48
  49
  50 static int *in_alloc_binds(int drv_id, int key_count)
  51 {
  52         const struct in_default_bind *defbinds;
  53         int *binds;
  54         int i;
  55
  56         binds = calloc(key_count * IN_BINDTYPE_COUNT * 2, sizeof(binds[0]));
  57         if (binds == NULL)
  58                 return NULL;
  59
  60         defbinds = DRV(drv_id).defbinds;
  61         if (defbinds != NULL) {
  62                 for (i = 0; ; i++) {
  63                         if (defbinds[i].bit == 0 && defbinds[i].btype == 0
  64                             && defbinds[i].bit == 0)
  65                                 break;
  66                         binds[IN_BIND_OFFS(defbinds[i].code, defbinds[i].btype)] =
  67                                 1 << defbinds[i].bit;
  68                 }
  69
  70                 /* always have a copy of defbinds */
  71                 memcpy(binds + key_count * IN_BINDTYPE_COUNT, binds,
  72                         sizeof(binds[0]) * key_count * IN_BINDTYPE_COUNT);
  73         }
  74
  75         return binds;
  76 }
  77
  78 static void in_unprobe(in_dev_t *dev)
  79 {
  80         if (dev->probed)
  81                 DRV(dev->drv_id).free(dev->drv_data);
  82         dev->probed = 0;
  83         dev->drv_data = NULL;
  84 }
  85
  86 static void in_free(in_dev_t *dev)
  87 {
  88         in_unprobe(dev);
  89         free(dev->name);
  90         dev->name = NULL;
  91         free(dev->binds);
  92         dev->binds = NULL;
  93 }
  94
  95 /* to be called by drivers
  96  * async devices must set drv_fd_hnd to -1 */
  97 void in_register(const char *nname, int drv_fd_hnd, void *drv_data,
  98                 int key_count, const char * const *key_names, int combos)
  99 {
 100         int i, ret, dupe_count = 0, *binds;
 101         char name[256], *name_end, *tmp;
 102
 103         strncpy(name, nname, sizeof(name));
 104         name[sizeof(name)-12] = 0;
 105         name_end = name + strlen(name);
 106
 107         for (i = 0; i < in_dev_count; i++)
 108         {
 109                 if (in_devices[i].name == NULL)
 110                         continue;
 111                 if (strcmp(in_devices[i].name, name) == 0)
 112                 {
 113                         if (in_devices[i].probed) {
 114                                 dupe_count++;
 115                                 sprintf(name_end, " [%d]", dupe_count);
 116                                 continue;
 117                         }
 118                         goto update;
 119                 }
 120         }
 121
 122         if (i >= IN_MAX_DEVS)
 123         {
 124                 /* try to find unused device */
 125                 for (i = 0; i < IN_MAX_DEVS; i++)
 126                         if (!in_devices[i].probed) break;
 127                 if (i >= IN_MAX_DEVS) {
 128                         lprintf("input: too many devices, can't add %s\n", name);
 129                         return;
 130                 }
 131                 in_free(&in_devices[i]);
 132         }
 133
 134         tmp = strdup(name);
 135         if (tmp == NULL)
 136                 return;
 137
 138         binds = in_alloc_binds(in_probe_dev_id, key_count);
 139         if (binds == NULL) {
 140                 free(tmp);
 141                 return;
 142         }
 143
 144         in_devices[i].name = tmp;
 145         in_devices[i].binds = binds;
 146         in_devices[i].key_count = key_count;
 147         if (i + 1 > in_dev_count)
 148                 in_dev_count = i + 1;
 149
 150         lprintf("input: new device #%d \"%s\"\n", i, name);
 151 update:
 152         in_devices[i].probed = 1;
 153         in_devices[i].does_combos = combos;
 154         in_devices[i].drv_id = in_probe_dev_id;
 155         in_devices[i].drv_fd_hnd = drv_fd_hnd;
 156         in_devices[i].key_names = key_names;
 157         in_devices[i].drv_data = drv_data;
 158
 159         if (in_devices[i].binds != NULL) {
 160                 ret = DRV(in_probe_dev_id).clean_binds(drv_data, in_devices[i].binds,
 161                         in_devices[i].binds + key_count * IN_BINDTYPE_COUNT);
 162                 if (ret == 0) {
 163                         /* no useable binds */
 164                         free(in_devices[i].binds);
 165                         in_devices[i].binds = NULL;
 166                 }
 167         }
 168 }
 169
 170 /* key combo handling, to be called by drivers that support it.
 171  * Only care about IN_BINDTYPE_EMU */
 172 void in_combos_find(const int *binds, int last_key, int *combo_keys, int *combo_acts)
 173 {
 174         int act, u;
 175
 176         *combo_keys = *combo_acts = 0;
 177         for (act = 0; act < sizeof(binds[0]) * 8; act++)
 178         {
 179                 int keyc = 0;
 180                 for (u = 0; u <= last_key; u++)
 181                         if (binds[IN_BIND_OFFS(u, IN_BINDTYPE_EMU)] & (1 << act))
 182                                 keyc++;
 183
 184                 if (keyc > 1)
 185                 {
 186                         // loop again and mark those keys and actions as combo
 187                         for (u = 0; u <= last_key; u++)
 188                         {
 189                                 if (binds[IN_BIND_OFFS(u, IN_BINDTYPE_EMU)] & (1 << act)) {
 190                                         *combo_keys |= 1 << u;
 191                                         *combo_acts |= 1 << act;
 192                                 }
 193                         }
 194                 }
 195         }
 196 }
 197
 198 int in_combos_do(int keys, const int *binds, int last_key, int combo_keys, int combo_acts)
 199 {
 200         int i, ret = 0;
 201
 202         for (i = 0; i <= last_key; i++)
 203         {
 204                 int acts, acts_c, u;
 205
 206                 if (!(keys & (1 << i)))
 207                         continue;
 208
 209                 acts = binds[IN_BIND_OFFS(i, IN_BINDTYPE_EMU)];
 210                 if (!acts)
 211                         continue;
 212
 213                 if (!(combo_keys & (1 << i))) {
 214                         ret |= acts;
 215                         continue;
 216                 }
 217
 218                 acts_c = acts & combo_acts;
 219                 u = last_key;
 220                 if (acts_c) {
 221                         // let's try to find the other one
 222                         for (u = i + 1; u <= last_key; u++)
 223                                 if ( (keys & (1 << u)) && (binds[IN_BIND_OFFS(u, IN_BINDTYPE_EMU)] & acts_c) ) {
 224                                         ret |= acts_c & binds[IN_BIND_OFFS(u, IN_BINDTYPE_EMU)];
 225                                         keys &= ~((1 << i) | (1 << u));
 226                                         break;
 227                                 }
 228                 }
 229                 // add non-combo actions if combo ones were not found
 230                 if (u >= last_key)
 231                         ret |= acts & ~combo_acts;
 232         }
 233
 234         return ret;
 235 }
 236
 237 void in_probe(void)
 238 {
 239         int i;
 240
 241         in_have_async_devs = 0;
 242         menu_key_state = 0;
 243         menu_last_used_dev = 0;
 244
 245         for (i = 0; i < in_dev_count; i++)
 246                 in_unprobe(&in_devices[i]);
 247
 248         for (i = 0; i < in_driver_count; i++) {
 249                 in_probe_dev_id = i;
 250                 in_drivers[i].probe(&DRV(i));
 251         }
 252
 253         /* get rid of devs without binds and probes */
 254         for (i = 0; i < in_dev_count; i++) {
 255                 if (!in_devices[i].probed && in_devices[i].binds == NULL) {
 256                         in_dev_count--;
 257                         if (i < in_dev_count) {
 258                                 free(in_devices[i].name);
 259                                 memmove(&in_devices[i], &in_devices[i+1],
 260                                         (in_dev_count - i) * sizeof(in_devices[0]));
 261                         }
 262
 263                         continue;
 264                 }
 265
 266                 if (in_devices[i].probed && in_devices[i].drv_fd_hnd == -1)
 267                         in_have_async_devs = 1;
 268         }
 269
 270         if (in_have_async_devs)
 271                 lprintf("input: async-only devices detected..\n");
 272
 273         in_debug_dump();
 274 }
 275
 276 /* async update */
 277 int in_update(int *result)
 278 {
 279         int i, ret = 0;
 280
 281         for (i = 0; i < in_dev_count; i++) {
 282                 in_dev_t *dev = &in_devices[i];
 283                 if (dev->probed && dev->binds != NULL)
 284                         ret |= DRV(dev->drv_id).update(dev->drv_data, dev->binds, result);
 285         }
 286
 287         return ret;
 288 }
 289
 290 static in_dev_t *get_dev(int dev_id)
 291 {
 292         if (dev_id < 0 || dev_id >= IN_MAX_DEVS)
 293                 return NULL;
 294
 295         return &in_devices[dev_id];
 296 }
 297
 298 int in_update_analog(int dev_id, int axis_id, int *result)
 299 {
 300         in_dev_t *dev = get_dev(dev_id);
 301
 302         if (dev == NULL || !dev->probed)
 303                 return -1;
 304
 305         return DRV(dev->drv_id).update_analog(dev->drv_data, axis_id, result);
 306 }
 307
 308 static int in_update_kc_async(int *dev_id_out, int *is_down_out, int timeout_ms)
 309 {
 310         int i, is_down, result;
 311         unsigned int ticks;
 312
 313         ticks = plat_get_ticks_ms();
 314
 315         while (1)
 316         {
 317                 for (i = 0; i < in_dev_count; i++) {
 318                         in_dev_t *d = &in_devices[i];
 319                         if (!d->probed)
 320                                 continue;
 321
 322                         result = DRV(d->drv_id).update_keycode(d->drv_data, &is_down);
 323                         if (result == -1)
 324                                 continue;
 325
 326                         if (dev_id_out)
 327                                 *dev_id_out = i;
 328                         if (is_down_out)
 329                                 *is_down_out = is_down;
 330                         return result;
 331                 }
 332
 333                 if (timeout_ms >= 0 && (int)(plat_get_ticks_ms() - ticks) > timeout_ms)
 334                         break;
 335
 336                 plat_sleep_ms(10);
 337         }
 338
 339         return -1;
 340 }
 341
 342 /*
 343  * wait for a press, always return some keycode or -1 on timeout or error
 344  */
 345 int in_update_keycode(int *dev_id_out, int *is_down_out, char *charcode, int timeout_ms)
 346 {
 347         int result = -1, dev_id = 0, is_down, result_menu;
 348         int fds_hnds[IN_MAX_DEVS];
 349         int i, ret, count = 0;
 350         in_drv_t *drv = NULL;
 351         unsigned int ticks;
 352
 353         if (in_have_async_devs) {
 354                 result = in_update_kc_async(&dev_id, &is_down, timeout_ms);
 355                 if (result == -1)
 356                         return -1;
 357                 drv = &DRV(in_devices[dev_id].drv_id);
 358                 goto finish;
 359         }
 360
 361         ticks = plat_get_ticks_ms();
 362
 363         for (i = 0; i < in_dev_count; i++) {
 364                 if (in_devices[i].probed)
 365                         fds_hnds[count++] = in_devices[i].drv_fd_hnd;
 366         }
 367
 368         if (count == 0) {
 369                 /* don't deadlock, fail */
 370                 lprintf("input: failed to find devices to read\n");
 371                 exit(1);
 372         }
 373
 374         while (1)
 375         {
 376                 ret = plat_wait_event(fds_hnds, count, timeout_ms);
 377                 if (ret < 0)
 378                         break;
 379
 380                 for (i = 0; i < in_dev_count; i++) {
 381                         if (in_devices[i].drv_fd_hnd == ret) {
 382                                 dev_id = i;
 383                                 break;
 384                         }
 385                 }
 386
 387                 drv = &DRV(in_devices[dev_id].drv_id);
 388                 result = drv->update_keycode(in_devices[dev_id].drv_data, &is_down);
 389                 if (result >= 0)
 390                         break;
 391
 392                 if (result == -2) {
 393                         lprintf("input: \"%s\" errored out, removing.\n", in_devices[dev_id].name);
 394                         in_unprobe(&in_devices[dev_id]);
 395                         break;
 396                 }
 397
 398                 if (timeout_ms >= 0) {
 399                         unsigned int ticks2 = plat_get_ticks_ms();
 400                         timeout_ms -= ticks2 - ticks;
 401                         ticks = ticks2;
 402                         if (timeout_ms <= 0)
 403                                 break;
 404                 }
 405         }
 406
 407         if (result < 0)
 408                 return -1;
 409 finish:
 410         /* keep track of menu key state, to allow mixing
 411          * in_update_keycode() and in_menu_wait_any() calls */
 412         result_menu = drv->menu_translate(in_devices[dev_id].drv_data, result, charcode);
 413         if (result_menu != 0) {
 414                 if (is_down)
 415                         menu_key_state |=  result_menu;
 416                 else
 417                         menu_key_state &= ~result_menu;
 418         }
 419
 420         if (dev_id_out != NULL)
 421                 *dev_id_out = dev_id;
 422         if (is_down_out != NULL)
 423                 *is_down_out = is_down;
 424         return result;
 425 }
 426
 427 /* same as above, only return bitfield of PBTN_*  */
 428 int in_menu_wait_any(char *charcode, int timeout_ms)
 429 {
 430         int keys_old = menu_key_state;
 431         int ret;
 432
 433         while (1)
 434         {
 435                 int code, is_down = 0, dev_id = 0;
 436
 437                 code = in_update_keycode(&dev_id, &is_down, charcode, timeout_ms);
 438                 if (code < 0)
 439                         break;
 440
 441                 if (keys_old != menu_key_state) {
 442                         menu_last_used_dev = dev_id;
 443                         break;
 444                 }
 445         }
 446
 447         ret = menu_key_state;
 448         menu_key_state &= ~PBTN_CHAR;
 449         return ret;
 450 }
 451
 452 /* wait for menu input, do autorepeat */
 453 int in_menu_wait(int interesting, char *charcode, int autorep_delay_ms)
 454 {
 455         static int inp_prev = 0;
 456         static int repeats = 0;
 457         int ret, release = 0, wait = 450;
 458
 459         if (repeats)
 460                 wait = autorep_delay_ms;
 461
 462         ret = in_menu_wait_any(charcode, wait);
 463         if (ret == inp_prev)
 464                 repeats++;
 465
 466         while (!(ret & interesting)) {
 467                 ret = in_menu_wait_any(charcode, -1);
 468                 release = 1;
 469         }
 470
 471         if (release || ret != inp_prev)
 472                 repeats = 0;
 473
 474         inp_prev = ret;
 475
 476         /* we don't need diagonals in menus */
 477         if ((ret & PBTN_UP)   && (ret & PBTN_LEFT))  ret &= ~PBTN_LEFT;
 478         if ((ret & PBTN_UP)   && (ret & PBTN_RIGHT)) ret &= ~PBTN_RIGHT;
 479         if ((ret & PBTN_DOWN) && (ret & PBTN_LEFT))  ret &= ~PBTN_LEFT;
 480         if ((ret & PBTN_DOWN) && (ret & PBTN_RIGHT)) ret &= ~PBTN_RIGHT;
 481
 482         return ret;
 483 }
 484
 485 const int *in_get_dev_binds(int dev_id)
 486 {
 487         in_dev_t *dev = get_dev(dev_id);
 488
 489         return dev ? dev->binds : NULL;
 490 }
 491
 492 const int *in_get_dev_def_binds(int dev_id)
 493 {
 494         in_dev_t *dev = get_dev(dev_id);
 495         if (dev == NULL)
 496                 return NULL;
 497
 498         return dev->binds + dev->key_count * IN_BINDTYPE_COUNT;
 499 }
 500
 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
 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         menu_key_state = 0;
 547
 548         /* flush events */
 549         do {
 550                 ret = in_update_keycode(NULL, NULL, NULL, 0);
 551         } while (ret >= 0);
 552
 553         return 0;
 554 }
 555
 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
 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
 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 */
 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
 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
 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  */
 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 */
 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", name);
 801                         return -1;
 802                 }
 803         }
 804
 805         memset(&in_devices[i], 0, sizeof(in_devices[i]));
 806
 807         in_devices[i].name = strdup(name);
 808         if (in_devices[i].name == NULL)
 809                 return -1;
 810
 811         in_devices[i].key_names = DRV(drv_id).get_key_names(&in_devices[i].key_count);
 812         in_devices[i].drv_id = drv_id;
 813
 814         if (i + 1 > in_dev_count)
 815                 in_dev_count = i + 1;
 816
 817         return i;
 818 }
 819
 820 int in_config_bind_key(int dev_id, const char *key, int acts, int bind_type)
 821 {
 822         in_dev_t *dev;
 823         int i, offs, kc;
 824
 825         dev = get_dev(dev_id);
 826         if (dev == NULL || bind_type >= IN_BINDTYPE_COUNT)
 827                 return -1;
 828
 829         /* maybe a raw code? */
 830         if (key[0] == '\\' && key[1] == 'x') {
 831                 char *p = NULL;
 832                 kc = (int)strtoul(key + 2, &p, 16);
 833                 if (p == NULL || *p != 0)
 834                         kc = -1;
 835         }
 836         else {
 837                 /* device specific key name */
 838                 if (dev->binds == NULL) {
 839                         dev->binds = in_alloc_binds(dev->drv_id, dev->key_count);
 840                         if (dev->binds == NULL)
 841                                 return -1;
 842                 }
 843
 844                 kc = -1;
 845                 if (dev->key_names != NULL) {
 846                         for (i = 0; i < dev->key_count; i++) {
 847                                 const char *k = dev->key_names[i];
 848                                 if (k != NULL && strcasecmp(k, key) == 0) {
 849                                         kc = i;
 850                                         break;
 851                                 }
 852                         }
 853                 }
 854
 855                 if (kc < 0)
 856                         kc = DRV(dev->drv_id).get_key_code(key);
 857                 if (kc < 0 && strlen(key) == 1) {
 858                         /* assume scancode */
 859                         kc = key[0];
 860                 }
 861         }
 862
 863         if (kc < 0 || kc >= dev->key_count) {
 864                 lprintf("input: bad key: %s\n", key);
 865                 return -1;
 866         }
 867
 868         if (bind_type == IN_BINDTYPE_NONE) {
 869                 for (i = 0; i < IN_BINDTYPE_COUNT; i++)
 870                         dev->binds[IN_BIND_OFFS(kc, i)] = 0;
 871                 return 0;
 872         }
 873
 874         offs = IN_BIND_OFFS(kc, bind_type);
 875         if (dev->binds[offs] == -1)
 876                 dev->binds[offs] = 0;
 877         dev->binds[offs] |= acts;
 878         return 0;
 879 }
 880
 881 void in_clean_binds(void)
 882 {
 883         int i;
 884
 885         for (i = 0; i < IN_MAX_DEVS; i++) {
 886                 int ret, count, *binds, *def_binds;
 887                 in_dev_t *dev = &in_devices[i];
 888
 889                 if (dev->binds == NULL || !dev->probed)
 890                         continue;
 891
 892                 count = dev->key_count;
 893                 binds = dev->binds;
 894                 def_binds = binds + count * IN_BINDTYPE_COUNT;
 895
 896                 ret = DRV(dev->drv_id).clean_binds(dev->drv_data, binds, def_binds);
 897                 if (ret == 0) {
 898                         /* no useable binds */
 899                         free(dev->binds);
 900                         dev->binds = NULL;
 901                 }
 902         }
 903 }
 904
 905 void in_debug_dump(void)
 906 {
 907         int i;
 908
 909         lprintf("# drv probed binds name\n");
 910         for (i = 0; i < IN_MAX_DEVS; i++) {
 911                 in_dev_t *d = &in_devices[i];
 912                 if (!d->probed && d->name == NULL && d->binds == NULL)
 913                         continue;
 914                 lprintf("%d %3d %6c %5c %s\n", i, d->drv_id, d->probed ? 'y' : 'n',
 915                         d->binds ? 'y' : 'n', d->name);
 916         }
 917 }
 918
 919 /* stubs for drivers that choose not to implement something */
 920
 921 static void in_def_free(void *drv_data) {}
 922 static int  in_def_clean_binds(void *drv_data, int *b, int *db) { return 1; }
 923 static int  in_def_get_config(void *drv_data, int what, int *val) { return -1; }
 924 static int  in_def_set_config(void *drv_data, int what, int val) { return -1; }
 925 static int  in_def_update_analog(void *drv_data, int axis_id, int *result) { return -1; }
 926 static int  in_def_update_keycode(void *drv_data, int *is_down) { return 0; }
 927 static int  in_def_menu_translate(void *drv_data, int keycode, char *ccode) { return 0; }
 928 static int  in_def_get_key_code(const char *key_name) { return -1; }
 929 static const char *in_def_get_key_name(int keycode) { return NULL; }
 930
 931 #define CHECK_ADD_STUB(d, f) \
 932         if (d.f == NULL) d.f = in_def_##f
 933
 934 /* to be called by drivers */
 935 int in_register_driver(const in_drv_t *drv,
 936                         const struct in_default_bind *defbinds, const void *pdata)
 937 {
 938         int count_new = in_driver_count + 1;
 939         in_drv_t *new_drivers;
 940
 941         new_drivers = realloc(in_drivers, count_new * sizeof(in_drivers[0]));
 942         if (new_drivers == NULL) {
 943                 lprintf("input: in_register_driver OOM\n");
 944                 return -1;
 945         }
 946
 947         memcpy(&new_drivers[in_driver_count], drv, sizeof(new_drivers[0]));
 948
 949         CHECK_ADD_STUB(new_drivers[in_driver_count], free);
 950         CHECK_ADD_STUB(new_drivers[in_driver_count], clean_binds);
 951         CHECK_ADD_STUB(new_drivers[in_driver_count], get_config);
 952         CHECK_ADD_STUB(new_drivers[in_driver_count], set_config);
 953         CHECK_ADD_STUB(new_drivers[in_driver_count], update_analog);
 954         CHECK_ADD_STUB(new_drivers[in_driver_count], update_keycode);
 955         CHECK_ADD_STUB(new_drivers[in_driver_count], menu_translate);
 956         CHECK_ADD_STUB(new_drivers[in_driver_count], get_key_code);
 957         CHECK_ADD_STUB(new_drivers[in_driver_count], get_key_name);
 958         if (pdata)
 959                 new_drivers[in_driver_count].pdata = pdata;
 960         if (defbinds)
 961                 new_drivers[in_driver_count].defbinds = defbinds;
 962         in_drivers = new_drivers;
 963         in_driver_count = count_new;
 964
 965         return 0;
 966 }
 967
 968 void in_init(void)
 969 {
 970         in_drivers = NULL;
 971         memset(in_devices, 0, sizeof(in_devices));
 972         in_driver_count = 0;
 973         in_dev_count = 0;
 974 }
 975
 976 #if 0
 977 int main(void)
 978 {
 979         int ret;
 980
 981         in_init();
 982         in_probe();
 983
 984         in_set_blocking(1);
 985
 986 #if 1
 987         while (1) {
 988                 int dev = 0, down;
 989                 ret = in_update_keycode(&dev, &down);
 990                 lprintf("#%i: %i %i (%s)\n", dev, down, ret, in_get_key_name(dev, ret));
 991         }
 992 #else
 993         while (1) {
 994                 ret = in_menu_wait_any();
 995                 lprintf("%08x\n", ret);
 996         }
 997 #endif
 998
 999         return 0;
1000 }
1001 #endif