minor xlib fix
[picodrive.git] / platform / gp2x / in_gp2x.c
... / ...
CommitLineData
1#include <stdio.h>
2#include <stdlib.h>
3#include <string.h>
4#include <sys/types.h>
5#include <sys/stat.h>
6#include <fcntl.h>
7#include <unistd.h>
8
9#include "../common/input.h"
10#include "in_gp2x.h"
11#include "soc.h"
12
13#define IN_PREFIX "gp2x:"
14#define IN_GP2X_NBUTTONS 32
15
16/* note: in_gp2x hadles combos (if 2 btns have the same bind,
17 * both must be pressed for action to happen) */
18static int in_gp2x_combo_keys = 0;
19static int in_gp2x_combo_acts = 0;
20static int gpiodev = -1; /* Wiz only */
21
22static int (*in_gp2x_get_bits)(void);
23
24enum { BTN_UP = 0, BTN_LEFT = 2, BTN_DOWN = 4, BTN_RIGHT = 6,
25 BTN_START = 8, BTN_SELECT = 9, BTN_L = 10, BTN_R = 11,
26 BTN_A = 12, BTN_B = 13, BTN_X = 14, BTN_Y = 15,
27 BTN_VOL_UP = 23, BTN_VOL_DOWN = 22, BTN_PUSH = 27 };
28
29static const char * const in_gp2x_prefix = IN_PREFIX;
30static const char *in_gp2x_keys[IN_GP2X_NBUTTONS] = {
31 [0 ... IN_GP2X_NBUTTONS-1] = NULL,
32 [BTN_UP] = "UP", [BTN_LEFT] = "LEFT", [BTN_DOWN] = "DOWN", [BTN_RIGHT] = "RIGHT",
33 [BTN_START] = "START", [BTN_SELECT] = "SELECT", [BTN_L] = "L", [BTN_R] = "R",
34 [BTN_A] = "A", [BTN_B] = "B", [BTN_X] = "X", [BTN_Y] = "Y",
35 [BTN_VOL_DOWN]= "VOL DOWN", [BTN_VOL_UP] = "VOL UP",
36 [BTN_PUSH] = "PUSH"
37};
38
39
40static int in_gp2x_get_mmsp2_bits(void)
41{
42 extern volatile unsigned short *gp2x_memregs;
43 int value;
44 value = gp2x_memregs[0x1198>>1] & 0xff; // GPIO M
45 if (value == 0xFD) value = 0xFA;
46 if (value == 0xF7) value = 0xEB;
47 if (value == 0xDF) value = 0xAF;
48 if (value == 0x7F) value = 0xBE;
49 value |= gp2x_memregs[0x1184>>1] & 0xFF00; // GPIO C
50 value |= gp2x_memregs[0x1186>>1] << 16; // GPIO D
51 value = ~value & 0x08c0ff55;
52
53 return value;
54}
55
56static int in_gp2x_get_wiz_bits(void)
57{
58 int value = 0;
59 read(gpiodev, &value, 4);
60 if (value & 0x02)
61 value |= 0x05;
62 if (value & 0x08)
63 value |= 0x14;
64 if (value & 0x20)
65 value |= 0x50;
66 if (value & 0x80)
67 value |= 0x41;
68
69 /* convert to GP2X style */
70 value &= 0x7ff55;
71 if (value & (1 << 16))
72 value |= 1 << BTN_VOL_UP;
73 if (value & (1 << 17))
74 value |= 1 << BTN_VOL_DOWN;
75 if (value & (1 << 18))
76 value |= 1 << BTN_PUSH;
77 value &= ~0x70000;
78
79 return value;
80}
81
82#ifdef FAKE_IN_GP2X
83static int in_gp2x_get_fake_bits(void)
84{
85 extern int current_keys;
86 return current_keys;
87}
88#endif
89
90static void in_gp2x_probe(void)
91{
92 gp2x_soc_t soc;
93
94 soc = soc_detect();
95 switch (soc)
96 {
97 case SOCID_MMSP2:
98 in_gp2x_get_bits = in_gp2x_get_mmsp2_bits;
99 break;
100 case SOCID_POLLUX:
101 gpiodev = open("/dev/GPIO", O_RDONLY);
102 if (gpiodev < 0) {
103 perror("in_gp2x: couldn't open /dev/GPIO");
104 return;
105 }
106 in_gp2x_get_bits = in_gp2x_get_wiz_bits;
107 break;
108 default:
109#ifdef FAKE_IN_GP2X
110 in_gp2x_get_bits = in_gp2x_get_fake_bits;
111 break;
112#endif
113 return;
114 }
115
116 in_register(IN_PREFIX "GP2X pad", IN_DRVID_GP2X, -1, (void *)1,
117 IN_GP2X_NBUTTONS, 1);
118}
119
120static void in_gp2x_free(void *drv_data)
121{
122 if (gpiodev >= 0) {
123 close(gpiodev);
124 gpiodev = -1;
125 }
126}
127
128static int in_gp2x_get_bind_count(void)
129{
130 return IN_GP2X_NBUTTONS;
131}
132
133/* ORs result with pressed buttons */
134int in_gp2x_update(void *drv_data, const int *binds, int *result)
135{
136 int type_start = 0;
137 int i, t, keys;
138
139 keys = in_gp2x_get_bits();
140
141 if (keys & in_gp2x_combo_keys) {
142 result[IN_BINDTYPE_EMU] = in_combos_do(keys, binds, BTN_PUSH,
143 in_gp2x_combo_keys, in_gp2x_combo_acts);
144 type_start = IN_BINDTYPE_PLAYER12;
145 }
146
147 for (i = 0; keys; i++, keys >>= 1) {
148 if (!(keys & 1))
149 continue;
150
151 for (t = type_start; t < IN_BINDTYPE_COUNT; t++)
152 result[t] |= binds[IN_BIND_OFFS(i, t)];
153 }
154
155 return 0;
156}
157
158int in_gp2x_update_keycode(void *data, int *is_down)
159{
160 static int old_val = 0;
161 int val, diff, i;
162
163 val = in_gp2x_get_bits();
164 diff = val ^ old_val;
165 if (diff == 0)
166 return -1;
167
168 /* take one bit only */
169 for (i = 0; i < sizeof(diff)*8; i++)
170 if (diff & (1<<i))
171 break;
172
173 old_val ^= 1 << i;
174
175 if (is_down)
176 *is_down = !!(val & (1<<i));
177 return i;
178}
179
180static const struct {
181 short key;
182 short pbtn;
183} key_pbtn_map[] =
184{
185 { BTN_UP, PBTN_UP },
186 { BTN_DOWN, PBTN_DOWN },
187 { BTN_LEFT, PBTN_LEFT },
188 { BTN_RIGHT, PBTN_RIGHT },
189 { BTN_B, PBTN_MOK },
190 { BTN_X, PBTN_MBACK },
191 { BTN_A, PBTN_MA2 },
192 { BTN_Y, PBTN_MA3 },
193 { BTN_L, PBTN_L },
194 { BTN_R, PBTN_R },
195 { BTN_SELECT, PBTN_MENU },
196};
197
198#define KEY_PBTN_MAP_SIZE (sizeof(key_pbtn_map) / sizeof(key_pbtn_map[0]))
199
200static int in_gp2x_menu_translate(int keycode)
201{
202 int i;
203 if (keycode < 0)
204 {
205 /* menu -> kc */
206 keycode = -keycode;
207 for (i = 0; i < KEY_PBTN_MAP_SIZE; i++)
208 if (key_pbtn_map[i].pbtn == keycode)
209 return key_pbtn_map[i].key;
210 }
211 else
212 {
213 for (i = 0; i < KEY_PBTN_MAP_SIZE; i++)
214 if (key_pbtn_map[i].key == keycode)
215 return key_pbtn_map[i].pbtn;
216 }
217
218 return 0;
219}
220
221static int in_gp2x_get_key_code(const char *key_name)
222{
223 int i;
224
225 for (i = 0; i < IN_GP2X_NBUTTONS; i++) {
226 const char *k = in_gp2x_keys[i];
227 if (k != NULL && strcasecmp(k, key_name) == 0)
228 return i;
229 }
230
231 return -1;
232}
233
234static const char *in_gp2x_get_key_name(int keycode)
235{
236 const char *name = NULL;
237 if (keycode >= 0 && keycode < IN_GP2X_NBUTTONS)
238 name = in_gp2x_keys[keycode];
239 if (name == NULL)
240 name = "Unkn";
241
242 return name;
243}
244
245static const struct {
246 short code;
247 char btype;
248 char bit;
249} in_gp2x_def_binds[] =
250{
251 /* MXYZ SACB RLDU */
252 { BTN_UP, IN_BINDTYPE_PLAYER12, 0 },
253 { BTN_DOWN, IN_BINDTYPE_PLAYER12, 1 },
254 { BTN_LEFT, IN_BINDTYPE_PLAYER12, 2 },
255 { BTN_RIGHT, IN_BINDTYPE_PLAYER12, 3 },
256 { BTN_X, IN_BINDTYPE_PLAYER12, 4 }, /* B */
257 { BTN_B, IN_BINDTYPE_PLAYER12, 5 }, /* C */
258 { BTN_A, IN_BINDTYPE_PLAYER12, 6 }, /* A */
259 { BTN_START, IN_BINDTYPE_PLAYER12, 7 },
260 { BTN_SELECT, IN_BINDTYPE_EMU, PEVB_MENU },
261// { BTN_Y, IN_BINDTYPE_EMU, PEVB_SWITCH_RND },
262 { BTN_L, IN_BINDTYPE_EMU, PEVB_STATE_SAVE },
263 { BTN_R, IN_BINDTYPE_EMU, PEVB_STATE_LOAD },
264 { BTN_VOL_UP, IN_BINDTYPE_EMU, PEVB_VOL_UP },
265 { BTN_VOL_DOWN, IN_BINDTYPE_EMU, PEVB_VOL_DOWN },
266};
267
268#define DEF_BIND_COUNT (sizeof(in_gp2x_def_binds) / sizeof(in_gp2x_def_binds[0]))
269
270static void in_gp2x_get_def_binds(int *binds)
271{
272 int i;
273
274 for (i = 0; i < DEF_BIND_COUNT; i++)
275 binds[IN_BIND_OFFS(in_gp2x_def_binds[i].code, in_gp2x_def_binds[i].btype)] =
276 1 << in_gp2x_def_binds[i].bit;
277}
278
279/* remove binds of missing keys, count remaining ones */
280static int in_gp2x_clean_binds(void *drv_data, int *binds, int *def_binds)
281{
282 int i, count = 0, have_vol = 0, have_menu = 0;
283
284 for (i = 0; i < IN_GP2X_NBUTTONS; i++) {
285 int t, eb, offs;
286 for (t = 0; t < IN_BINDTYPE_COUNT; t++) {
287 offs = IN_BIND_OFFS(i, t);
288 if (in_gp2x_keys[i] == NULL)
289 binds[offs] = def_binds[offs] = 0;
290 if (binds[offs])
291 count++;
292 }
293 eb = binds[IN_BIND_OFFS(i, IN_BINDTYPE_EMU)];
294 if (eb & (PEV_VOL_DOWN|PEV_VOL_UP))
295 have_vol = 1;
296 if (eb & PEV_MENU)
297 have_menu = 1;
298 }
299
300 /* autobind some important keys, if they are unbound */
301 if (!have_vol && binds[BTN_VOL_UP] == 0 && binds[BTN_VOL_DOWN] == 0) {
302 binds[IN_BIND_OFFS(BTN_VOL_UP, IN_BINDTYPE_EMU)] = PEV_VOL_UP;
303 binds[IN_BIND_OFFS(BTN_VOL_DOWN, IN_BINDTYPE_EMU)] = PEV_VOL_DOWN;
304 count += 2;
305 }
306
307 if (!have_menu) {
308 binds[IN_BIND_OFFS(BTN_SELECT, IN_BINDTYPE_EMU)] = PEV_MENU;
309 count++;
310 }
311
312 in_combos_find(binds, BTN_PUSH, &in_gp2x_combo_keys, &in_gp2x_combo_acts);
313
314 return count;
315}
316
317void in_gp2x_init(void *vdrv)
318{
319 in_drv_t *drv = vdrv;
320 gp2x_soc_t soc;
321
322 soc = soc_detect();
323 if (soc == SOCID_POLLUX)
324 in_gp2x_keys[BTN_START] = "MENU";
325
326 in_gp2x_combo_keys = in_gp2x_combo_acts = 0;
327
328 drv->prefix = in_gp2x_prefix;
329 drv->probe = in_gp2x_probe;
330 drv->free = in_gp2x_free;
331 drv->get_bind_count = in_gp2x_get_bind_count;
332 drv->get_def_binds = in_gp2x_get_def_binds;
333 drv->clean_binds = in_gp2x_clean_binds;
334 drv->menu_translate = in_gp2x_menu_translate;
335 drv->get_key_code = in_gp2x_get_key_code;
336 drv->get_key_name = in_gp2x_get_key_name;
337 drv->update_keycode = in_gp2x_update_keycode;
338}
339