[pcsx_rearmed.git] / frontend / gp2x / in_gp2x.c

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <unistd.h>

#include "../common/input.h"
#include "in_gp2x.h"

#define IN_GP2X_PREFIX "gp2x:"
#define IN_GP2X_NBUTTONS 32

/* note: in_gp2x hadles combos (if 2 btns have the same bind,
 * both must be pressed for action to happen) */
static int in_gp2x_combo_keys = 0;
static int in_gp2x_combo_acts = 0;
static int gpiodev = -1;	/* Wiz only */

static int (*in_gp2x_get_bits)(void);

static const char *in_gp2x_keys[IN_GP2X_NBUTTONS] = {
	[0 ... IN_GP2X_NBUTTONS-1] = NULL,
	[GP2X_BTN_UP]    = "Up",    [GP2X_BTN_LEFT]   = "Left",
	[GP2X_BTN_DOWN]  = "Down",  [GP2X_BTN_RIGHT]  = "Right",
	[GP2X_BTN_START] = "Start", [GP2X_BTN_SELECT] = "Select",
	[GP2X_BTN_L]     = "L",     [GP2X_BTN_R]      = "R",
	[GP2X_BTN_A]     = "A",     [GP2X_BTN_B]      = "B",
	[GP2X_BTN_X]     = "X",     [GP2X_BTN_Y]      = "Y",
	[GP2X_BTN_VOL_DOWN] = "VOL DOWN",
	[GP2X_BTN_VOL_UP]   = "VOL UP",
	[GP2X_BTN_PUSH]     = "PUSH"
};


static int in_gp2x_get_mmsp2_bits(void)
{
	extern volatile unsigned short *gp2x_memregs;
	int value;
	value = gp2x_memregs[0x1198>>1] & 0xff; // GPIO M
	if (value == 0xFD) value = 0xFA;
	if (value == 0xF7) value = 0xEB;
	if (value == 0xDF) value = 0xAF;
	if (value == 0x7F) value = 0xBE;
	value |= gp2x_memregs[0x1184>>1] & 0xFF00; // GPIO C
	value |= gp2x_memregs[0x1186>>1] << 16; // GPIO D
	value = ~value & 0x08c0ff55;

	return value;
}

static int in_gp2x_get_wiz_bits(void)
{
	int r, value = 0;
	r = read(gpiodev, &value, 4);
	if (value & 0x02)
		value |= 0x05;
	if (value & 0x08)
		value |= 0x14;
	if (value & 0x20)
		value |= 0x50;
	if (value & 0x80)
		value |= 0x41;

	/* convert to GP2X style */
	value &= 0x7ff55;
	if (value & (1 << 16))
		value |= 1 << GP2X_BTN_VOL_UP;
	if (value & (1 << 17))
		value |= 1 << GP2X_BTN_VOL_DOWN;
	if (value & (1 << 18))
		value |= 1 << GP2X_BTN_PUSH;
	value &= ~0x70000;

	return value;
}

#ifdef FAKE_IN_GP2X
volatile unsigned short *gp2x_memregs;
int gp2x_dev_id = -1;

static int in_gp2x_get_fake_bits(void)
{
	extern int current_keys;
	return current_keys;
}
#endif

static void in_gp2x_probe(void)
{
	switch (gp2x_dev_id)
	{
	case GP2X_DEV_GP2X:
		in_gp2x_get_bits = in_gp2x_get_mmsp2_bits;
		break;
	case GP2X_DEV_WIZ:
		gpiodev = open("/dev/GPIO", O_RDONLY);
		if (gpiodev < 0) {
			perror("in_gp2x: couldn't open /dev/GPIO");
			return;
		}
		in_gp2x_get_bits = in_gp2x_get_wiz_bits;
		break;
	// we'll use evdev for Caanoo
	default:
#ifdef FAKE_IN_GP2X
		in_gp2x_get_bits = in_gp2x_get_fake_bits;
		break;
#endif
		return;
	}

	in_register(IN_GP2X_PREFIX "GP2X pad", -1, NULL,
		IN_GP2X_NBUTTONS, in_gp2x_keys, 1);
}

static void in_gp2x_free(void *drv_data)
{
	if (gpiodev >= 0) {
		close(gpiodev);
		gpiodev = -1;
	}
}

static const char * const *
in_gp2x_get_key_names(int *count)
{
	*count = IN_GP2X_NBUTTONS;
	return in_gp2x_keys;
}

/* ORs result with pressed buttons */
static int in_gp2x_update(void *drv_data, const int *binds, int *result)
{
	int type_start = 0;
	int i, t, keys;

	keys = in_gp2x_get_bits();

	if (keys & in_gp2x_combo_keys) {
		result[IN_BINDTYPE_EMU] = in_combos_do(keys, binds, GP2X_BTN_PUSH,
						in_gp2x_combo_keys, in_gp2x_combo_acts);
		type_start = IN_BINDTYPE_PLAYER12;
	}

	for (i = 0; keys; i++, keys >>= 1) {
		if (!(keys & 1))
			continue;

		for (t = type_start; t < IN_BINDTYPE_COUNT; t++)
			result[t] |= binds[IN_BIND_OFFS(i, t)];
	}

	return 0;
}

int in_gp2x_update_keycode(void *data, int *is_down)
{
	static int old_val = 0;
	int val, diff, i;

	val = in_gp2x_get_bits();
	diff = val ^ old_val;
	if (diff == 0)
		return -1;

	/* take one bit only */
	for (i = 0; i < sizeof(diff)*8; i++)
		if (diff & (1<<i))
			break;

	old_val ^= 1 << i;

	if (is_down)
		*is_down = !!(val & (1<<i));
	return i;
}

static const struct {
	short key;
	short pbtn;
} key_pbtn_map[] =
{
	{ GP2X_BTN_UP,		PBTN_UP },
	{ GP2X_BTN_DOWN,	PBTN_DOWN },
	{ GP2X_BTN_LEFT,	PBTN_LEFT },
	{ GP2X_BTN_RIGHT,	PBTN_RIGHT },
	{ GP2X_BTN_B,		PBTN_MOK },
	{ GP2X_BTN_X,		PBTN_MBACK },
	{ GP2X_BTN_A,		PBTN_MA2 },
	{ GP2X_BTN_Y,		PBTN_MA3 },
	{ GP2X_BTN_L,		PBTN_L },
	{ GP2X_BTN_R,		PBTN_R },
	{ GP2X_BTN_SELECT,	PBTN_MENU },
};

#define KEY_PBTN_MAP_SIZE (sizeof(key_pbtn_map) / sizeof(key_pbtn_map[0]))

static int in_gp2x_menu_translate(void *drv_data, int keycode)
{
	int i;
	if (keycode < 0)
	{
		/* menu -> kc */
		keycode = -keycode;
		for (i = 0; i < KEY_PBTN_MAP_SIZE; i++)
			if (key_pbtn_map[i].pbtn == keycode)
				return key_pbtn_map[i].key;
	}
	else
	{
		for (i = 0; i < KEY_PBTN_MAP_SIZE; i++)
			if (key_pbtn_map[i].key == keycode)
				return key_pbtn_map[i].pbtn;
	}

	return 0;
}

#if 0 // TODO: move to pico
static const struct {
	short code;
	char btype;
	char bit;
} in_gp2x_defbinds[] =
{
	/* MXYZ SACB RLDU */
	{ BTN_UP,	IN_BINDTYPE_PLAYER12, 0 },
	{ BTN_DOWN,	IN_BINDTYPE_PLAYER12, 1 },
	{ BTN_LEFT,	IN_BINDTYPE_PLAYER12, 2 },
	{ BTN_RIGHT,	IN_BINDTYPE_PLAYER12, 3 },
	{ BTN_X,	IN_BINDTYPE_PLAYER12, 4 },	/* B */
	{ BTN_B,	IN_BINDTYPE_PLAYER12, 5 },	/* C */
	{ BTN_A,	IN_BINDTYPE_PLAYER12, 6 },	/* A */
	{ BTN_START,	IN_BINDTYPE_PLAYER12, 7 },
	{ BTN_SELECT,	IN_BINDTYPE_EMU, PEVB_MENU },
//	{ BTN_Y,	IN_BINDTYPE_EMU, PEVB_SWITCH_RND },
	{ BTN_L,	IN_BINDTYPE_EMU, PEVB_STATE_SAVE },
	{ BTN_R,	IN_BINDTYPE_EMU, PEVB_STATE_LOAD },
	{ BTN_VOL_UP,	IN_BINDTYPE_EMU, PEVB_VOL_UP },
	{ BTN_VOL_DOWN,	IN_BINDTYPE_EMU, PEVB_VOL_DOWN },
	{ 0, 0, 0 },
};
#endif

/* remove binds of missing keys, count remaining ones */
static int in_gp2x_clean_binds(void *drv_data, int *binds, int *def_binds)
{
	int i, count = 0;
//	int eb, have_vol = 0, have_menu = 0;

	for (i = 0; i < IN_GP2X_NBUTTONS; i++) {
		int t, offs;
		for (t = 0; t < IN_BINDTYPE_COUNT; t++) {
			offs = IN_BIND_OFFS(i, t);
			if (in_gp2x_keys[i] == NULL)
				binds[offs] = def_binds[offs] = 0;
			if (binds[offs])
				count++;
		}
#if 0
		eb = binds[IN_BIND_OFFS(i, IN_BINDTYPE_EMU)];
		if (eb & (PEV_VOL_DOWN|PEV_VOL_UP))
			have_vol = 1;
		if (eb & PEV_MENU)
			have_menu = 1;
#endif
	}

	// TODO: move to pico
#if 0
	/* autobind some important keys, if they are unbound */
	if (!have_vol && binds[GP2X_BTN_VOL_UP] == 0 && binds[GP2X_BTN_VOL_DOWN] == 0) {
		binds[IN_BIND_OFFS(GP2X_BTN_VOL_UP, IN_BINDTYPE_EMU)]   = PEV_VOL_UP;
		binds[IN_BIND_OFFS(GP2X_BTN_VOL_DOWN, IN_BINDTYPE_EMU)] = PEV_VOL_DOWN;
		count += 2;
	}

	if (!have_menu) {
		binds[IN_BIND_OFFS(GP2X_BTN_SELECT, IN_BINDTYPE_EMU)] = PEV_MENU;
		count++;
	}
#endif

	in_combos_find(binds, GP2X_BTN_PUSH, &in_gp2x_combo_keys, &in_gp2x_combo_acts);

	return count;
}

static const in_drv_t in_gp2x_drv = {
	.prefix         = IN_GP2X_PREFIX,
	.probe          = in_gp2x_probe,
	.free           = in_gp2x_free,
	.get_key_names  = in_gp2x_get_key_names,
	.clean_binds    = in_gp2x_clean_binds,
	.update         = in_gp2x_update,
	.update_keycode = in_gp2x_update_keycode,
	.menu_translate = in_gp2x_menu_translate,
};

void in_gp2x_init(const struct in_default_bind *defbinds)
{
	if (gp2x_dev_id == GP2X_DEV_WIZ)
		in_gp2x_keys[GP2X_BTN_START] = "MENU";
	
	in_gp2x_combo_keys = in_gp2x_combo_acts = 0;

	in_register_driver(&in_gp2x_drv, defbinds);
}
Commit	Line	Data
221be40d	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
	12	#define IN_GP2X_PREFIX "gp2x:"
	13	#define IN_GP2X_NBUTTONS 32
	14
	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;
	19	static int gpiodev = -1; /* Wiz only */
	20
	21	static int (*in_gp2x_get_bits)(void);
	22
	23	static const char *in_gp2x_keys[IN_GP2X_NBUTTONS] = {
	24	[0 ... IN_GP2X_NBUTTONS-1] = NULL,
	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"
	34	};
	35
	36
	37	static int in_gp2x_get_mmsp2_bits(void)
	38	{
	39	extern volatile unsigned short *gp2x_memregs;
	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;
	51	}
	52
	53	static int in_gp2x_get_wiz_bits(void)
	54	{
	55	int r, value = 0;
	56	r = read(gpiodev, &value, 4);
	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))
69	value \|= 1 << GP2X_BTN_VOL_UP;
70	if (value & (1 << 17))
71	value \|= 1 << GP2X_BTN_VOL_DOWN;
72	if (value & (1 << 18))
73	value \|= 1 << GP2X_BTN_PUSH;
74	value &= ~0x70000;
75
76	return value;
77	}
78
79	#ifdef FAKE_IN_GP2X
80	volatile unsigned short *gp2x_memregs;
81	int gp2x_dev_id = -1;
82
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	{
92	switch (gp2x_dev_id)
93	{
94	case GP2X_DEV_GP2X:
95	in_gp2x_get_bits = in_gp2x_get_mmsp2_bits;
96	break;
97	case GP2X_DEV_WIZ:
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;
105	// we'll use evdev for Caanoo
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
114	in_register(IN_GP2X_PREFIX "GP2X pad", -1, NULL,
115	IN_GP2X_NBUTTONS, in_gp2x_keys, 1);
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
126	static const char * const *
127	in_gp2x_get_key_names(int *count)
128	{
129	*count = IN_GP2X_NBUTTONS;
130	return in_gp2x_keys;
131	}
132
133	/* ORs result with pressed buttons */
134	static int 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, GP2X_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
158	int 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
180	static const struct {
181	short key;
182	short pbtn;
183	} key_pbtn_map[] =
184	{
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 },
196	};
197
198	#define KEY_PBTN_MAP_SIZE (sizeof(key_pbtn_map) / sizeof(key_pbtn_map[0]))
199
200	static int in_gp2x_menu_translate(void *drv_data, 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
221	#if 0 // TODO: move to pico
222	static const struct {
223	short code;
224	char btype;
225	char bit;
226	} in_gp2x_defbinds[] =
227	{
228	/* MXYZ SACB RLDU */
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 },
238	// { BTN_Y, IN_BINDTYPE_EMU, PEVB_SWITCH_RND },
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 },
243	{ 0, 0, 0 },
244	};
245	#endif
246
221be40d	247	/* remove binds of missing keys, count remaining ones */
	248	static int in_gp2x_clean_binds(void drv_data, int binds, int *def_binds)
	249	{
	250	int i, count = 0;
	251	// int eb, have_vol = 0, have_menu = 0;
	252
	253	for (i = 0; i < IN_GP2X_NBUTTONS; i++) {
	254	int t, offs;
	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++;
	261	}
	262	#if 0
	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;
	268	#endif
	269	}
	270
	271	// TODO: move to pico
	272	#if 0
	273	/* autobind some important keys, if they are unbound */
	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;
	277	count += 2;
	278	}
	279
	280	if (!have_menu) {
	281	binds[IN_BIND_OFFS(GP2X_BTN_SELECT, IN_BINDTYPE_EMU)] = PEV_MENU;
	282	count++;
	283	}
	284	#endif
	285
	286	in_combos_find(binds, GP2X_BTN_PUSH, &in_gp2x_combo_keys, &in_gp2x_combo_acts);
	287
	288	return count;
	289	}
	290
	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,
221be40d	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	};
	301
b07c18e8	302	void in_gp2x_init(const struct in_default_bind *defbinds)
221be40d	303	{
	304	if (gp2x_dev_id == GP2X_DEV_WIZ)
	305	in_gp2x_keys[GP2X_BTN_START] = "MENU";
	306
	307	in_gp2x_combo_keys = in_gp2x_combo_acts = 0;
	308
b07c18e8	309	in_register_driver(&in_gp2x_drv, defbinds);
221be40d	310	}
221be40d	311