Debian Codegraph @

src/gp2xwiz/wiz_joystick.c

raw
1 /* ______ ___ ___
2 * /\ _ \ /\_ \ /\_ \
3 * \ \ \L\ \\//\ \ \//\ \ __ __ _ __ ___
4 * \ \ __ \ \ \ \ \ \ \ /'__`\ /'_ `\/\`'__\/ __`\
5 * \ \ \/\ \ \_\ \_ \_\ \_/\ __//\ \L\ \ \ \//\ \L\ \
6 * \ \_\ \_\/\____\/\____\ \____\ \____ \ \_\\ \____/
7 * \/_/\/_/\/____/\/____/\/____/\/___L\ \/_/ \/___/
8 * /\____/
9 * \_/__/
10 *
11 * GP2X Wiz joystick driver
12 *
13 * by Trent Gamblin.
14 *
15 */
16
17 #include <stdint.h>
18 #include <stdlib.h>
19 #include <stdio.h>
20 #include <fcntl.h>
21 #include <sys/mman.h>
22 #include <sys/ioctl.h>
23 #include <unistd.h>
24 #include <string.h>
25
26 #include "allegro5/allegro.h"
27 #include "allegro5/joystick.h"
28 #include "allegro5/internal/aintern.h"
29 #include "allegro5/platform/aintwiz.h"
30 #include "allegro5/platform/alwiz.h"
31 #include "allegro5/internal/aintern_events.h"
32 #include "allegro5/internal/aintern_joystick.h"
33 #include "allegro5/internal/aintern_gp2xwiz.h"
34
35 static ALLEGRO_JOYSTICK joy;
36
37 static ALLEGRO_JOYSTICK_STATE joystate;
38 static ALLEGRO_THREAD *wiz_joystick_thread;
39
40 const int POLLS_PER_SECOND = 60;
41
42 #define BUTTON(x) (buttons & x)
43
44 static void joywiz_fill_joystate(ALLEGRO_JOYSTICK_STATE *state)
45 {
46 uint32_t buttons = lc_getbuttons();
47
48 /* Left-right axis */
49 if (BUTTON(BTN_LEFT)) {
50 state->stick[0].axis[0] = -1;
51 }
52 else if (BUTTON(BTN_RIGHT)) {
53 state->stick[0].axis[0] = 1;
54 }
55 else {
56 state->stick[0].axis[0] = 0;
57 }
58
59 /* Up-down axis */
60 if (BUTTON(BTN_UP)) {
61 state->stick[0].axis[1] = -1;
62 }
63 else if (BUTTON(BTN_DOWN)) {
64 state->stick[0].axis[1] = 1;
65 }
66 else {
67 state->stick[0].axis[1] = 0;
68 }
69
70 /* Other buttons */
71 state->button[0] = BUTTON(BTN_A);
72 state->button[1] = BUTTON(BTN_B);
73 state->button[2] = BUTTON(BTN_X);
74 state->button[3] = BUTTON(BTN_Y);
75 state->button[4] = BUTTON(BTN_L);
76 state->button[5] = BUTTON(BTN_R);
77 state->button[6] = BUTTON(BTN_MENU);
78 state->button[7] = BUTTON(BTN_SELECT);
79 state->button[8] = BUTTON(BTN_VOLUP);
80 state->button[9] = BUTTON(BTN_VOLDOWN);
81 }
82
83
84 static void generate_axis_event(ALLEGRO_JOYSTICK *joy, int stick, int axis, float pos)
85 {
86 ALLEGRO_EVENT event;
87
88 if (!_al_event_source_needs_to_generate_event(&joy->es))
89 return;
90
91 event.joystick.type = ALLEGRO_EVENT_JOYSTICK_AXIS;
92 event.joystick.timestamp = al_get_time();
93 event.joystick.stick = stick;
94 event.joystick.axis = axis;
95 event.joystick.pos = pos; event.joystick.button = 0;
96
97 _al_event_source_emit_event(&joy->es, &event);
98 }
99
100
101 static void generate_button_event(ALLEGRO_JOYSTICK *joy, int button, ALLEGRO_EVENT_TYPE event_type)
102 {
103 ALLEGRO_EVENT event;
104
105 if (!_al_event_source_needs_to_generate_event(&joy->es))
106 return;
107
108 event.joystick.type = event_type;
109 event.joystick.timestamp = al_get_time();
110 event.joystick.stick = 0;
111 event.joystick.axis = 0;
112 event.joystick.pos = 0.0;
113 event.joystick.button = button;
114
115 _al_event_source_emit_event(&joy->es, &event);
116 }
117
118 static void *joywiz_thread_proc(ALLEGRO_THREAD *thread, void *unused)
119 {
120 ALLEGRO_JOYSTICK_STATE oldstate;
121 memset(&oldstate, 0, sizeof(ALLEGRO_JOYSTICK_STATE));
122
123 (void)unused;
124
125 while (!al_get_thread_should_stop(thread)) {
126 joywiz_fill_joystate(&joystate);
127 if (joystate.stick[0].axis[0] != oldstate.stick[0].axis[0]) {
128 generate_axis_event(&joy, 0, 0,
129 joystate.stick[0].axis[0]);
130 }
131 if (joystate.stick[0].axis[1] != oldstate.stick[0].axis[1]) {
132 generate_axis_event(&joy, 0, 1,
133 joystate.stick[0].axis[1]);
134 }
135 int i;
136 for (i = 0; i < 10; i++) {
137 ALLEGRO_EVENT_TYPE type;
138 if (oldstate.button[i] == 0)
139 type = ALLEGRO_EVENT_JOYSTICK_BUTTON_DOWN;
140 else
141 type = ALLEGRO_EVENT_JOYSTICK_BUTTON_UP;
142 if (joystate.button[i] != oldstate.button[i]) {
143 generate_button_event(&joy, i, type);
144 }
145 }
146 oldstate = joystate;
147 al_rest(1.0/POLLS_PER_SECOND);
148 }
149
150 return NULL;
151 }
152
153 static void joywiz_fill_joy(void)
154 {
155 joy.info.num_sticks = 1;
156 joy.info.num_buttons = 10;
157
158 joy.info.stick[0].flags = ALLEGRO_JOYFLAG_DIGITAL;
159 joy.info.stick[0].num_axes = 2;
160 joy.info.stick[0].name = "Wiz D-pad";
161 joy.info.stick[0].axis[0].name = "Left-right axis";
162 joy.info.stick[0].axis[1].name = "Up-down axis";
163
164 joy.info.button[0].name = "A";
165 joy.info.button[1].name = "B";
166 joy.info.button[2].name = "X";
167 joy.info.button[3].name = "Y";
168 joy.info.button[4].name = "L";
169 joy.info.button[5].name = "R";
170 joy.info.button[6].name = "Menu";
171 joy.info.button[7].name = "Select";
172 joy.info.button[8].name = "VolUp";
173 joy.info.button[9].name = "VolDown";
174
175 joy.num = 0;
176 }
177
178 static bool joywiz_init_joystick(void)
179 {
180 lc_init_joy();
181
182 joywiz_fill_joy();
183
184 _al_event_source_init(&joy.es);
185
186 memset(&joystate, 0, sizeof(ALLEGRO_JOYSTICK_STATE));
187
188 wiz_joystick_thread = al_create_thread(joywiz_thread_proc, NULL);
189 if (!wiz_joystick_thread) {
190 return false;
191 }
192
193 al_start_thread(wiz_joystick_thread);
194
195 return true;
196 }
197
198 static void joywiz_exit_joystick(void)
199 {
200 al_join_thread(wiz_joystick_thread, NULL);
201 al_destroy_thread(wiz_joystick_thread);
202 _al_event_source_free(&joy.es);
203 }
204
205 static int joywiz_get_num_joysticks(void)
206 {
207 return 1;
208 }
209
210 static ALLEGRO_JOYSTICK *joywiz_get_joystick(int num)
211 {
212 (void)num; /* Only 1 supported now */
213 return &joy;
214 }
215
216 static void joywiz_release_joystick(ALLEGRO_JOYSTICK *joy)
217 {
218 (void)joy;
219 }
220
221 static void joywiz_get_joystick_state(ALLEGRO_JOYSTICK *joy, ALLEGRO_JOYSTICK_STATE *ret_state)
222 {
223 _al_event_source_lock(&joy->es);
224 {
225 *ret_state = joystate;
226 }
227 _al_event_source_unlock(&joy->es);
228 }
229
230
231
232 /* the driver vtable */
233 ALLEGRO_JOYSTICK_DRIVER _al_joydrv_gp2xwiz =
234 {
235 AL_JOY_TYPE_GP2XWIZ,
236 "",
237 "",
238 "GP2X Wiz joystick",
239 joywiz_init_joystick,
240 joywiz_exit_joystick,
241 joywiz_get_num_joysticks,
242 joywiz_get_joystick,
243 joywiz_release_joystick,
244 joywiz_get_joystick_state
245 };
246
247