supporting caanoo, line doublers, refactoring
[libpicofe.git] / gp2x / in_gp2x.c
CommitLineData
fa8d1331 1#include <stdio.h>
13b692eb 2#include <stdlib.h>
3#include <string.h>
fa8d1331 4#include <sys/types.h>
5#include <sys/stat.h>
6#include <fcntl.h>
7#include <unistd.h>
13b692eb 8
13b692eb 9#include "../common/input.h"
10#include "in_gp2x.h"
b6072c17 11#include "plat_gp2x.h"
13b692eb 12
13#define IN_PREFIX "gp2x:"
14#define IN_GP2X_NBUTTONS 32
15
2c600560 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;
fa8d1331 20static int gpiodev = -1; /* Wiz only */
21
22static int (*in_gp2x_get_bits)(void);
2c600560 23
13b692eb 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;
8af2da72 30static const char *in_gp2x_keys[IN_GP2X_NBUTTONS] = {
13b692eb 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
13b692eb 39
fa8d1331 40static int in_gp2x_get_mmsp2_bits(void)
13b692eb 41{
d572cbad 42 extern volatile unsigned short *gp2x_memregs;
13b692eb 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;
13b692eb 54}
55
fa8d1331 56static int in_gp2x_get_wiz_bits(void)
57{
5f7b5155 58 int r, value = 0;
59 r = read(gpiodev, &value, 4);
fa8d1331 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
0114ccc4 82#ifdef FAKE_IN_GP2X
d2f29611 83volatile unsigned short *gp2x_memregs;
84gp2x_soc_t soc_detect(void) { return -1; }
85
0114ccc4 86static int in_gp2x_get_fake_bits(void)
87{
88 extern int current_keys;
89 return current_keys;
90}
91#endif
92
93static void in_gp2x_probe(void)
94{
b6072c17 95 switch (gp2x_dev_id)
0114ccc4 96 {
b6072c17 97 case GP2X_DEV_GP2X:
0114ccc4 98 in_gp2x_get_bits = in_gp2x_get_mmsp2_bits;
99 break;
b6072c17 100 case GP2X_DEV_WIZ:
0114ccc4 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
8e77275e 116 in_register(IN_PREFIX "GP2X pad", IN_DRVID_GP2X, -1, (void *)1,
117 IN_GP2X_NBUTTONS, 1);
0114ccc4 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
8e77275e 133/* ORs result with pressed buttons */
134int in_gp2x_update(void *drv_data, const int *binds, int *result)
13b692eb 135{
8e77275e 136 int type_start = 0;
137 int i, t, keys;
2c600560 138
fa8d1331 139 keys = in_gp2x_get_bits();
13b692eb 140
8e77275e 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;
13b692eb 150
8e77275e 151 for (t = type_start; t < IN_BINDTYPE_COUNT; t++)
152 result[t] |= binds[IN_BIND_OFFS(i, t)];
13b692eb 153 }
154
8e77275e 155 return 0;
13b692eb 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
fa8d1331 163 val = in_gp2x_get_bits();
13b692eb 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
82abf46f 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
13b692eb 200static int in_gp2x_menu_translate(int keycode)
201{
82abf46f 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;
13b692eb 210 }
82abf46f 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;
13b692eb 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;
8e77275e 247 char btype;
248 char bit;
13b692eb 249} in_gp2x_def_binds[] =
250{
251 /* MXYZ SACB RLDU */
8e77275e 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 },
b7911801 261// { BTN_Y, IN_BINDTYPE_EMU, PEVB_SWITCH_RND },
8e77275e 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 },
13b692eb 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++)
8e77275e 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;
13b692eb 277}
278
279/* remove binds of missing keys, count remaining ones */
8e77275e 280static int in_gp2x_clean_binds(void *drv_data, int *binds, int *def_binds)
13b692eb 281{
82abf46f 282 int i, count = 0, have_vol = 0, have_menu = 0;
13b692eb 283
284 for (i = 0; i < IN_GP2X_NBUTTONS; i++) {
8e77275e 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++;
82abf46f 292 }
8e77275e 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;
13b692eb 298 }
299
82abf46f 300 /* autobind some important keys, if they are unbound */
301 if (!have_vol && binds[BTN_VOL_UP] == 0 && binds[BTN_VOL_DOWN] == 0) {
8e77275e 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;
82abf46f 305 }
306
8e77275e 307 if (!have_menu) {
308 binds[IN_BIND_OFFS(BTN_SELECT, IN_BINDTYPE_EMU)] = PEV_MENU;
309 count++;
310 }
82abf46f 311
2c600560 312 in_combos_find(binds, BTN_PUSH, &in_gp2x_combo_keys, &in_gp2x_combo_acts);
313
13b692eb 314 return count;
13b692eb 315}
316
317void in_gp2x_init(void *vdrv)
318{
319 in_drv_t *drv = vdrv;
320
b6072c17 321 if (gp2x_dev_id == GP2X_DEV_WIZ)
4858c633 322 in_gp2x_keys[BTN_START] = "MENU";
323
2c600560 324 in_gp2x_combo_keys = in_gp2x_combo_acts = 0;
325
13b692eb 326 drv->prefix = in_gp2x_prefix;
327 drv->probe = in_gp2x_probe;
fa8d1331 328 drv->free = in_gp2x_free;
13b692eb 329 drv->get_bind_count = in_gp2x_get_bind_count;
330 drv->get_def_binds = in_gp2x_get_def_binds;
331 drv->clean_binds = in_gp2x_clean_binds;
332 drv->menu_translate = in_gp2x_menu_translate;
333 drv->get_key_code = in_gp2x_get_key_code;
334 drv->get_key_name = in_gp2x_get_key_name;
335 drv->update_keycode = in_gp2x_update_keycode;
336}
337