| 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 |
|