loader/host_pnd.c

   1 // vim:shiftwidth=2:expandtab
   2 #define _GNU_SOURCE
   3 #include <stdio.h>
   4 #include <string.h>
   5 #include <sys/types.h>
   6 #include <sys/stat.h>
   7 #include <fcntl.h>
   8 #include <unistd.h>
   9 #include <sys/ioctl.h>
  10 #include <errno.h>
  11 #include <linux/input.h>
  12
  13 #include "header.h"
  14 #include "realfuncs.h"
  15
  16 static int ifds[2] = { -1, -1 };
  17 static int init_done;
  18 static int keystate;
  19
  20 static void init(void)
  21 {
  22   char buff[64];
  23   int i, ifd, ret;
  24
  25   for (ifd = -1, i = 0; ifds[0] == -1 || ifds[1] == -1; i++) {
  26     snprintf(buff, sizeof(buff), "/dev/input/event%i", i);
  27     ifd = open(buff, O_RDONLY | O_NONBLOCK, 0);
  28     if (ifd == -1)
  29       break;
  30
  31     ret = ioctl(ifd, EVIOCGNAME(sizeof(buff)), buff);
  32     if (ret < 0)
  33       break;
  34
  35     if (strcasestr(buff, "gpio") != NULL) {
  36       ifds[0] = ifd;
  37       continue;
  38     }
  39     if (strcasestr(buff, "keypad") != NULL) {
  40       ifds[1] = ifd;
  41       continue;
  42     }
  43     close(ifd);
  44   }
  45
  46   if (ifds[0] < 0)
  47     fprintf(stderr, PFX "missing buttons\n");
  48   if (ifds[1] < 0)
  49     fprintf(stderr, PFX "missing keypad\n");
  50   init_done = 1;
  51 }
  52
  53 static const struct {
  54   unsigned short key;
  55   unsigned short btn;
  56 } key_map[] = {
  57   { KEY_LEFT,       GP2X_LEFT },
  58   { KEY_RIGHT,      GP2X_RIGHT },
  59   { KEY_UP,         GP2X_UP },
  60   { KEY_DOWN,       GP2X_DOWN },
  61   { KEY_PAGEUP,     GP2X_Y },
  62   { BTN_BASE,       GP2X_Y },
  63   { KEY_END,        GP2X_B },
  64   { BTN_BASE2,      GP2X_B },
  65   { KEY_PAGEDOWN,   GP2X_X },
  66   { BTN_BASE3,      GP2X_X },
  67   { KEY_HOME,       GP2X_A },
  68   { BTN_BASE4,      GP2X_A },
  69   { KEY_RIGHTSHIFT, GP2X_L },
  70   { BTN_TL,         GP2X_L },
  71   { KEY_RIGHTCTRL,  GP2X_R },
  72   { BTN_TR,         GP2X_R },
  73   { KEY_LEFTALT,    GP2X_START },
  74   { BTN_START,      GP2X_START },
  75   { KEY_LEFTCTRL,   GP2X_SELECT },
  76   { BTN_SELECT,     GP2X_SELECT },
  77   { KEY_COMMA,      GP2X_VOL_DOWN },
  78   { KEY_DOT,        GP2X_VOL_UP },
  79   { KEY_Q,          GP2X_PUSH },
  80 };
  81
  82 int host_read_btns(void)
  83 {
  84   struct input_event ev;
  85   int i, ret;
  86
  87   if (!init_done)
  88     init();
  89
  90   while (1)
  91   {
  92     ret = read(ifds[0], &ev, sizeof(ev));
  93     if (ret < (int) sizeof(ev)) {
  94       if (errno != EAGAIN && errno != EWOULDBLOCK)
  95         perror(PFX "read error");
  96
  97       ret = read(ifds[1], &ev, sizeof(ev));
  98       if (ret < (int) sizeof(ev))
  99         if (errno != EAGAIN && errno != EWOULDBLOCK)
 100           perror(PFX "read error");
 101     }
 102
 103     if (ret < (int) sizeof(ev))
 104       return keystate;
 105
 106     if (ev.type != EV_KEY)
 107       continue;
 108
 109     for (i = 0; i < sizeof(key_map) / sizeof(key_map[0]); i++) {
 110       if (key_map[i].key != ev.code)
 111         continue;
 112       if (ev.value)
 113         keystate |=  (1 << key_map[i].btn);
 114       else
 115         keystate &= ~(1 << key_map[i].btn);
 116       break;
 117     }
 118   }
 119
 120   return keystate;
 121 }
 122