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