git.sesse.net Git - pistorm/blob - input/input.c

   1 #include <linux/input.h>
   2 #include <pthread.h>
   3 #include <stdint.h>
   4 #include <stdio.h>
   5 #include <string.h>
   6 #include <termios.h>
   7 #include <unistd.h>
   8
   9 #include "platforms/platforms.h"
  10 #include "input.h"
  11
  12 #define NONE 0x80
  13
  14 static int lshift = 0, rshift = 0, lctrl = 0, rctrl = 0, lalt = 0, altgr = 0;
  15 extern int mouse_fd;
  16 extern int keyboard_fd;
  17
  18 // n.b. $fe and $ff are mapped to newmouse standard wheel up/down keycodes, nonexistant on amiga keyboards
  19 char keymap_amiga[256] = { \
  20 /*      00    01    02    03    04    05    06    07    08    09    0A    0B    0C    0D    0E    0F */ \
  21 /*00*/ 0x80, 0x45, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x41, 0x42, \
  22 /*10*/ 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17, 0x18, 0x19, 0x1A, 0x1B, 0x44, 0x63, 0x20, 0x21, \
  23 /*20*/ 0x22, 0x23, 0x24, 0x25, 0x26, 0x27, 0x28, 0x29, 0x2A, 0x00, 0x60, 0x2B, 0x31, 0x32, 0x33, 0x34, \
  24 /*30*/ 0x35, 0x36, 0x37, 0x38, 0x39, 0x3A, 0x61, 0x5D, 0x64, 0x40, NONE, 0x50, 0x51, 0x52, 0x53, 0x54, \
  25 /*40*/ 0x55, 0x56, 0x57, 0x58, 0x69, 0x5B, NONE, 0x3D, 0x3E, 0x3F, 0x4A, 0x2D, 0x2E, 0x2F, 0x4E, 0x1D, \
  26 /*50*/ 0x1E, 0x1F, 0x0F, 0x3C, NONE, NONE, 0x30, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, \
  27 /*60*/ 0x43, NONE, 0x5C, NONE, NONE, NONE, 0x5F, 0x4C, 0x5A, 0x4F, 0x4E, NONE, 0x4D, NONE, 0x0D, 0x46, \
  28 /*70*/ NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, 0x66, 0x67, 0x67, \
  29 /*80*/ NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, \
  30 /*90*/ NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, \
  31 /*A0*/ NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, \
  32 /*B0*/ NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, \
  33 /*C0*/ NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, \
  34 /*D0*/ NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, \
  35 /*E0*/ NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, \
  36 /*F0*/ NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, NONE, 0x7A, 0x7B }; \
  37
  38 int handle_modifier(struct input_event *ev) {
  39   int *target_modifier = NULL;
  40   if (ev->value != KEYPRESS_REPEAT && (ev->code == KEY_LEFTSHIFT || ev->code == KEY_RIGHTSHIFT || ev->code == KEY_LEFTALT || ev->code == KEY_RIGHTALT || ev->code == KEY_LEFTCTRL || ev->code == KEY_RIGHTCTRL)) {
  41     switch(ev->code) {
  42       case KEY_LEFTSHIFT:
  43         target_modifier = &lshift;
  44         break;
  45       case KEY_RIGHTSHIFT:
  46         target_modifier = &rshift;
  47         break;
  48       case KEY_LEFTALT:
  49         target_modifier = &lalt;
  50         break;
  51       case KEY_RIGHTALT:
  52         target_modifier = &altgr;
  53         break;
  54       case KEY_LEFTCTRL:
  55         target_modifier = &lshift;
  56         break;
  57       case KEY_RIGHTCTRL:
  58         target_modifier = &rshift;
  59         break;
  60     }
  61     *target_modifier = (ev->value == KEYPRESS_RELEASE) ? 0 : 1;
  62     return 1;
  63   }
  64   else {
  65     return 0;
  66   }
  67 }
  68
  69 #define KEYCASE(a, b, c)case a: return (lshift || rshift) ? c : b;
  70
  71 /**
  72  * translates keycodes back into a simpler enumerable value for handling emulator command events
  73  *
  74  * @param *struct/input_event  ev  pointer to input layer event structure
  75  * @return char
  76  */
  77 char char_from_input_event(struct input_event *ev) {
  78   switch(ev->code) {
  79     KEYCASE(KEY_A, 'a', 'A');
  80     KEYCASE(KEY_B, 'b', 'B');
  81     KEYCASE(KEY_C, 'c', 'C');
  82     KEYCASE(KEY_D, 'd', 'D');
  83     KEYCASE(KEY_E, 'e', 'E');
  84     KEYCASE(KEY_F, 'f', 'F');
  85     KEYCASE(KEY_G, 'g', 'G');
  86     KEYCASE(KEY_H, 'h', 'H');
  87     KEYCASE(KEY_I, 'i', 'I');
  88     KEYCASE(KEY_J, 'j', 'J');
  89     KEYCASE(KEY_K, 'k', 'K');
  90     KEYCASE(KEY_L, 'l', 'L');
  91     KEYCASE(KEY_M, 'm', 'M');
  92     KEYCASE(KEY_N, 'n', 'N');
  93     KEYCASE(KEY_O, 'o', 'O');
  94     KEYCASE(KEY_P, 'p', 'P');
  95     KEYCASE(KEY_Q, 'q', 'Q');
  96     KEYCASE(KEY_R, 'r', 'R');
  97     KEYCASE(KEY_S, 's', 'S');
  98     KEYCASE(KEY_T, 't', 'T');
  99     KEYCASE(KEY_U, 'u', 'U');
 100     KEYCASE(KEY_V, 'c', 'V');
 101     KEYCASE(KEY_W, 'w', 'W');
 102     KEYCASE(KEY_X, 'x', 'X');
 103     KEYCASE(KEY_Y, 'y', 'Y');
 104     KEYCASE(KEY_Z, 'z', 'Z');
 105     KEYCASE(KEY_1, '1', '!');
 106     KEYCASE(KEY_2, '2', '@');
 107     KEYCASE(KEY_3, '3', '#');
 108     KEYCASE(KEY_4, '4', '$');
 109     KEYCASE(KEY_5, '5', '%');
 110     KEYCASE(KEY_6, '6', '^');
 111     KEYCASE(KEY_7, '7', '&');
 112     KEYCASE(KEY_8, '8', '*');
 113     KEYCASE(KEY_9, '9', '(');
 114     KEYCASE(KEY_0, '0', ')');
 115     KEYCASE(KEY_F12, 0x1B, 0x1B);
 116     KEYCASE(KEY_PAUSE, 0x01, 0x01);
 117     default:
 118       return 0;
 119   }
 120 }
 121
 122 int get_key_char(char *c, char *code, char *event_type)
 123 {
 124   if (keyboard_fd == -1)
 125     return 0;
 126
 127   struct input_event ie;
 128   while(read(keyboard_fd, &ie, sizeof(struct input_event)) != -1) {
 129     if (ie.type == EV_KEY) {
 130       handle_modifier(&ie);
 131       char ret = char_from_input_event(&ie);
 132       *c = ret;
 133       *code = ie.code;
 134       *event_type = ie.value;
 135       return 1;
 136     }
 137   }
 138
 139   return 0;
 140 }
 141
 142 uint8_t mouse_x = 0, mouse_y = 0;
 143
 144 int get_mouse_status(uint8_t *x, uint8_t *y, uint8_t *b, uint8_t *e) {
 145   uint8_t mouse_ev[4];
 146   if (read(mouse_fd, &mouse_ev, 4) != -1) {
 147     *b = ((uint8_t *)&mouse_ev)[0];
 148     *e = ((uint8_t *)&mouse_ev)[3];
 149
 150     mouse_x += ((uint8_t *)&mouse_ev)[1];
 151     *x = mouse_x;
 152     mouse_y += (-((uint8_t *)&mouse_ev)[2]);
 153     *y = mouse_y;
 154     return 1;
 155   }
 156
 157   return 0;
 158 }
 159
 160 static uint8_t queued_keypresses = 0, queue_output_pos = 0, queue_input_pos = 0;
 161 static uint8_t queued_keys[256];
 162 static uint8_t queued_events[256];
 163
 164 void clear_keypress_queue() {
 165   memset(queued_keys, 0x80, 256);
 166   memset(queued_events, 0x80, 256);
 167   queued_keypresses = 0;
 168   queue_output_pos = 0;
 169   queue_input_pos = 0;
 170 }
 171
 172 int queue_keypress(uint8_t keycode, uint8_t event_type, uint8_t platform) {
 173   char *keymap = NULL;
 174   switch (platform) {
 175     case PLATFORM_AMIGA:
 176       if (event_type != KEYPRESS_REPEAT)
 177         keymap = keymap_amiga;
 178       break;
 179     default:
 180       break;
 181   }
 182   if (keymap != NULL) {
 183     if (keymap[keycode] != NONE) {
 184       if (queued_keypresses < 255) {
 185         // printf("Keypress queued, matched %.2X to host key code %.2X\n", keycode, keymap[keycode]);
 186         queued_keys[queue_output_pos] = keymap[keycode];
 187         queued_events[queue_output_pos] = event_type;
 188         queue_output_pos++;
 189         queued_keypresses++;
 190         return 1;
 191       }
 192     }
 193   }
 194   return 0;
 195 }
 196
 197 int get_num_kb_queued() {
 198   return queued_keypresses;
 199 }
 200
 201 void pop_queued_key(uint8_t *c, uint8_t *t) {
 202   if (queued_keypresses == 0) {
 203     *c = NONE;
 204     *t = NONE;
 205     return;
 206   }
 207   *c = queued_keys[queue_input_pos];
 208   *t = queued_events[queue_input_pos];
 209   queue_input_pos++;
 210   queued_keypresses--;
 211   return;
 212 }