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