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 | |
a86e9a3e |
9 | #include "../input.h" |
13b692eb |
10 | #include "in_gp2x.h" |
11 | |
e99d8048 |
12 | #define IN_GP2X_PREFIX "gp2x:" |
13b692eb |
13 | #define IN_GP2X_NBUTTONS 32 |
14 | |
2c600560 |
15 | /* note: in_gp2x hadles combos (if 2 btns have the same bind, |
16 | * both must be pressed for action to happen) */ |
17 | static int in_gp2x_combo_keys = 0; |
18 | static int in_gp2x_combo_acts = 0; |
fa8d1331 |
19 | static int gpiodev = -1; /* Wiz only */ |
20 | |
21 | static int (*in_gp2x_get_bits)(void); |
2c600560 |
22 | |
8af2da72 |
23 | static const char *in_gp2x_keys[IN_GP2X_NBUTTONS] = { |
13b692eb |
24 | [0 ... IN_GP2X_NBUTTONS-1] = NULL, |
e99d8048 |
25 | [GP2X_BTN_UP] = "Up", [GP2X_BTN_LEFT] = "Left", |
26 | [GP2X_BTN_DOWN] = "Down", [GP2X_BTN_RIGHT] = "Right", |
27 | [GP2X_BTN_START] = "Start", [GP2X_BTN_SELECT] = "Select", |
28 | [GP2X_BTN_L] = "L", [GP2X_BTN_R] = "R", |
29 | [GP2X_BTN_A] = "A", [GP2X_BTN_B] = "B", |
30 | [GP2X_BTN_X] = "X", [GP2X_BTN_Y] = "Y", |
31 | [GP2X_BTN_VOL_DOWN] = "VOL DOWN", |
32 | [GP2X_BTN_VOL_UP] = "VOL UP", |
33 | [GP2X_BTN_PUSH] = "PUSH" |
13b692eb |
34 | }; |
35 | |
13b692eb |
36 | |
fa8d1331 |
37 | static int in_gp2x_get_mmsp2_bits(void) |
13b692eb |
38 | { |
d572cbad |
39 | extern volatile unsigned short *gp2x_memregs; |
13b692eb |
40 | int value; |
41 | value = gp2x_memregs[0x1198>>1] & 0xff; // GPIO M |
42 | if (value == 0xFD) value = 0xFA; |
43 | if (value == 0xF7) value = 0xEB; |
44 | if (value == 0xDF) value = 0xAF; |
45 | if (value == 0x7F) value = 0xBE; |
46 | value |= gp2x_memregs[0x1184>>1] & 0xFF00; // GPIO C |
47 | value |= gp2x_memregs[0x1186>>1] << 16; // GPIO D |
48 | value = ~value & 0x08c0ff55; |
49 | |
50 | return value; |
13b692eb |
51 | } |
52 | |
fa8d1331 |
53 | static int in_gp2x_get_wiz_bits(void) |
54 | { |
5f7b5155 |
55 | int r, value = 0; |
56 | r = read(gpiodev, &value, 4); |
fa8d1331 |
57 | if (value & 0x02) |
58 | value |= 0x05; |
59 | if (value & 0x08) |
60 | value |= 0x14; |
61 | if (value & 0x20) |
62 | value |= 0x50; |
63 | if (value & 0x80) |
64 | value |= 0x41; |
65 | |
66 | /* convert to GP2X style */ |
67 | value &= 0x7ff55; |
68 | if (value & (1 << 16)) |
e99d8048 |
69 | value |= 1 << GP2X_BTN_VOL_UP; |
fa8d1331 |
70 | if (value & (1 << 17)) |
e99d8048 |
71 | value |= 1 << GP2X_BTN_VOL_DOWN; |
fa8d1331 |
72 | if (value & (1 << 18)) |
e99d8048 |
73 | value |= 1 << GP2X_BTN_PUSH; |
fa8d1331 |
74 | value &= ~0x70000; |
75 | |
76 | return value; |
77 | } |
78 | |
0114ccc4 |
79 | #ifdef FAKE_IN_GP2X |
d2f29611 |
80 | volatile unsigned short *gp2x_memregs; |
e9b29264 |
81 | int gp2x_dev_id = -1; |
d2f29611 |
82 | |
0114ccc4 |
83 | static int in_gp2x_get_fake_bits(void) |
84 | { |
85 | extern int current_keys; |
86 | return current_keys; |
87 | } |
88 | #endif |
89 | |
90 | static void in_gp2x_probe(void) |
91 | { |
b6072c17 |
92 | switch (gp2x_dev_id) |
0114ccc4 |
93 | { |
b6072c17 |
94 | case GP2X_DEV_GP2X: |
0114ccc4 |
95 | in_gp2x_get_bits = in_gp2x_get_mmsp2_bits; |
96 | break; |
b6072c17 |
97 | case GP2X_DEV_WIZ: |
0114ccc4 |
98 | gpiodev = open("/dev/GPIO", O_RDONLY); |
99 | if (gpiodev < 0) { |
100 | perror("in_gp2x: couldn't open /dev/GPIO"); |
101 | return; |
102 | } |
103 | in_gp2x_get_bits = in_gp2x_get_wiz_bits; |
104 | break; |
e9b29264 |
105 | // we'll use evdev for Caanoo |
0114ccc4 |
106 | default: |
107 | #ifdef FAKE_IN_GP2X |
108 | in_gp2x_get_bits = in_gp2x_get_fake_bits; |
109 | break; |
110 | #endif |
111 | return; |
112 | } |
113 | |
e99d8048 |
114 | in_register(IN_GP2X_PREFIX "GP2X pad", -1, NULL, |
e9b29264 |
115 | IN_GP2X_NBUTTONS, in_gp2x_keys, 1); |
0114ccc4 |
116 | } |
117 | |
118 | static void in_gp2x_free(void *drv_data) |
119 | { |
120 | if (gpiodev >= 0) { |
121 | close(gpiodev); |
122 | gpiodev = -1; |
123 | } |
124 | } |
125 | |
e99d8048 |
126 | static const char * const * |
127 | in_gp2x_get_key_names(int *count) |
0114ccc4 |
128 | { |
e99d8048 |
129 | *count = IN_GP2X_NBUTTONS; |
130 | return in_gp2x_keys; |
0114ccc4 |
131 | } |
132 | |
8e77275e |
133 | /* ORs result with pressed buttons */ |
e99d8048 |
134 | static int 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) { |
e99d8048 |
142 | result[IN_BINDTYPE_EMU] = in_combos_do(keys, binds, GP2X_BTN_PUSH, |
8e77275e |
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 | |
158 | int 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 |
180 | static const struct { |
181 | short key; |
182 | short pbtn; |
183 | } key_pbtn_map[] = |
184 | { |
e99d8048 |
185 | { GP2X_BTN_UP, PBTN_UP }, |
186 | { GP2X_BTN_DOWN, PBTN_DOWN }, |
187 | { GP2X_BTN_LEFT, PBTN_LEFT }, |
188 | { GP2X_BTN_RIGHT, PBTN_RIGHT }, |
189 | { GP2X_BTN_B, PBTN_MOK }, |
190 | { GP2X_BTN_X, PBTN_MBACK }, |
191 | { GP2X_BTN_A, PBTN_MA2 }, |
192 | { GP2X_BTN_Y, PBTN_MA3 }, |
193 | { GP2X_BTN_L, PBTN_L }, |
194 | { GP2X_BTN_R, PBTN_R }, |
195 | { GP2X_BTN_SELECT, PBTN_MENU }, |
82abf46f |
196 | }; |
197 | |
198 | #define KEY_PBTN_MAP_SIZE (sizeof(key_pbtn_map) / sizeof(key_pbtn_map[0])) |
199 | |
e9b29264 |
200 | static int in_gp2x_menu_translate(void *drv_data, int keycode) |
13b692eb |
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 | |
e99d8048 |
221 | #if 0 // TODO: move to pico |
13b692eb |
222 | static const struct { |
223 | short code; |
8e77275e |
224 | char btype; |
225 | char bit; |
e99d8048 |
226 | } in_gp2x_defbinds[] = |
13b692eb |
227 | { |
228 | /* MXYZ SACB RLDU */ |
8e77275e |
229 | { BTN_UP, IN_BINDTYPE_PLAYER12, 0 }, |
230 | { BTN_DOWN, IN_BINDTYPE_PLAYER12, 1 }, |
231 | { BTN_LEFT, IN_BINDTYPE_PLAYER12, 2 }, |
232 | { BTN_RIGHT, IN_BINDTYPE_PLAYER12, 3 }, |
233 | { BTN_X, IN_BINDTYPE_PLAYER12, 4 }, /* B */ |
234 | { BTN_B, IN_BINDTYPE_PLAYER12, 5 }, /* C */ |
235 | { BTN_A, IN_BINDTYPE_PLAYER12, 6 }, /* A */ |
236 | { BTN_START, IN_BINDTYPE_PLAYER12, 7 }, |
237 | { BTN_SELECT, IN_BINDTYPE_EMU, PEVB_MENU }, |
b7911801 |
238 | // { BTN_Y, IN_BINDTYPE_EMU, PEVB_SWITCH_RND }, |
8e77275e |
239 | { BTN_L, IN_BINDTYPE_EMU, PEVB_STATE_SAVE }, |
240 | { BTN_R, IN_BINDTYPE_EMU, PEVB_STATE_LOAD }, |
241 | { BTN_VOL_UP, IN_BINDTYPE_EMU, PEVB_VOL_UP }, |
242 | { BTN_VOL_DOWN, IN_BINDTYPE_EMU, PEVB_VOL_DOWN }, |
e99d8048 |
243 | { 0, 0, 0 }, |
13b692eb |
244 | }; |
e99d8048 |
245 | #endif |
13b692eb |
246 | |
247 | /* remove binds of missing keys, count remaining ones */ |
8e77275e |
248 | static int in_gp2x_clean_binds(void *drv_data, int *binds, int *def_binds) |
13b692eb |
249 | { |
e99d8048 |
250 | int i, count = 0; |
251 | // int eb, have_vol = 0, have_menu = 0; |
13b692eb |
252 | |
253 | for (i = 0; i < IN_GP2X_NBUTTONS; i++) { |
e99d8048 |
254 | int t, offs; |
8e77275e |
255 | for (t = 0; t < IN_BINDTYPE_COUNT; t++) { |
256 | offs = IN_BIND_OFFS(i, t); |
257 | if (in_gp2x_keys[i] == NULL) |
258 | binds[offs] = def_binds[offs] = 0; |
259 | if (binds[offs]) |
260 | count++; |
82abf46f |
261 | } |
e99d8048 |
262 | #if 0 |
8e77275e |
263 | eb = binds[IN_BIND_OFFS(i, IN_BINDTYPE_EMU)]; |
264 | if (eb & (PEV_VOL_DOWN|PEV_VOL_UP)) |
265 | have_vol = 1; |
266 | if (eb & PEV_MENU) |
267 | have_menu = 1; |
e99d8048 |
268 | #endif |
13b692eb |
269 | } |
270 | |
e99d8048 |
271 | // TODO: move to pico |
272 | #if 0 |
82abf46f |
273 | /* autobind some important keys, if they are unbound */ |
e99d8048 |
274 | if (!have_vol && binds[GP2X_BTN_VOL_UP] == 0 && binds[GP2X_BTN_VOL_DOWN] == 0) { |
275 | binds[IN_BIND_OFFS(GP2X_BTN_VOL_UP, IN_BINDTYPE_EMU)] = PEV_VOL_UP; |
276 | binds[IN_BIND_OFFS(GP2X_BTN_VOL_DOWN, IN_BINDTYPE_EMU)] = PEV_VOL_DOWN; |
8e77275e |
277 | count += 2; |
82abf46f |
278 | } |
279 | |
8e77275e |
280 | if (!have_menu) { |
e99d8048 |
281 | binds[IN_BIND_OFFS(GP2X_BTN_SELECT, IN_BINDTYPE_EMU)] = PEV_MENU; |
8e77275e |
282 | count++; |
283 | } |
e99d8048 |
284 | #endif |
82abf46f |
285 | |
e99d8048 |
286 | in_combos_find(binds, GP2X_BTN_PUSH, &in_gp2x_combo_keys, &in_gp2x_combo_acts); |
2c600560 |
287 | |
13b692eb |
288 | return count; |
13b692eb |
289 | } |
290 | |
e99d8048 |
291 | static const in_drv_t in_gp2x_drv = { |
292 | .prefix = IN_GP2X_PREFIX, |
293 | .probe = in_gp2x_probe, |
294 | .free = in_gp2x_free, |
295 | .get_key_names = in_gp2x_get_key_names, |
296 | .clean_binds = in_gp2x_clean_binds, |
297 | .update = in_gp2x_update, |
298 | .update_keycode = in_gp2x_update_keycode, |
299 | .menu_translate = in_gp2x_menu_translate, |
300 | }; |
13b692eb |
301 | |
e99d8048 |
302 | void in_gp2x_init(const struct in_default_bind *defbinds) |
303 | { |
b6072c17 |
304 | if (gp2x_dev_id == GP2X_DEV_WIZ) |
e99d8048 |
305 | in_gp2x_keys[GP2X_BTN_START] = "MENU"; |
4858c633 |
306 | |
2c600560 |
307 | in_gp2x_combo_keys = in_gp2x_combo_acts = 0; |
308 | |
e99d8048 |
309 | in_register_driver(&in_gp2x_drv, defbinds); |
13b692eb |
310 | } |
311 | |