joystick support
[btb/d2x.git] / input / linux_joystick.c
1 #include <conf.h>
2
3 #ifdef __ENV_LINUX__
4 #include <stdlib.h>
5 #include <stdio.h>
6 #include "joystick.h"
7 #include <sys/ioctl.h>
8 #include <fcntl.h>
9 #include <unistd.h>
10
11 #include "timer.h"
12 #include "pstypes.h"
13 #include "mono.h"
14 #include "joy.h"
15
16 char joy_installed = 0;
17 char joy_present = 0;
18
19 joystick_device j_joystick[4];
20 joystick_axis j_axis[MAX_AXES];
21 joystick_button j_button[MAX_BUTTONS];
22
23 int j_num_axes = 0, j_num_buttons = 0;
24 int timer_rate;
25
26 int j_axes_in_sticks[4];        /* number of axes in the first [x] sticks */
27 int j_buttons_in_sticks[4];     /* number of buttons in the first [x] sticks */
28
29 int joy_deadzone = 0;
30
31 int j_Get_joydev_axis_number (int all_axis_number) {
32         int i, joy_axis_number = all_axis_number;
33
34         for (i = 0; i < j_axis[all_axis_number].joydev; i++) {
35                 joy_axis_number -= j_joystick[i].num_axes;
36         }               
37
38         return joy_axis_number;
39 }
40
41
42 int j_Get_joydev_button_number (int all_button_number) {
43         int i, joy_button_number = all_button_number;
44
45         for (i = 0; i < j_button[all_button_number].joydev; i++) {
46                 joy_button_number -= j_joystick[i].num_buttons;
47         }               
48
49         return joy_button_number;
50 }
51
52
53 int j_Update_state () {
54         int num_processed = 0, i;
55         struct js_event current_event;
56         struct JS_DATA_TYPE joy_data;
57
58         for (i = 0; i < j_num_buttons; i++) {
59                 //changed 6/24/1999 to finally squish the timedown bug - Owen Evans 
60                 if (j_button[i].state != j_button[i].last_state) {
61                         if (j_button[i].state) {
62                                 j_button[i].downcount++;
63                                 j_button[i].timedown = timer_get_fixed_seconds();
64                         }
65                 }
66                 //end changed - OE
67                 j_button[i].last_state = j_button[i].state;
68         }
69
70         for (i = 0; i < 4; i++) {
71                 if (j_joystick[i].buffer >= 0) {
72                         if (j_joystick[i].version) {
73                                 while (read (j_joystick[i].buffer, &current_event, sizeof (struct js_event)) > 0) {
74                                         num_processed++;
75                                         switch (current_event.type & ~JS_EVENT_INIT) {
76                                                 case JS_EVENT_AXIS:
77                                                         j_axis[j_axes_in_sticks[i] + current_event.number].value = current_event.value;
78                                                         break;
79                                                 case JS_EVENT_BUTTON:
80                                                         j_button[j_buttons_in_sticks[i] + current_event.number].state = current_event.value;
81                                                         break;
82                                         }
83                                 }
84                         } else {
85                                 read (j_joystick[i].buffer, &joy_data, JS_RETURN);
86                                 j_axis[j_axes_in_sticks[i] + 0].value = joy_data.x;
87                                 j_axis[j_axes_in_sticks[i] + 1].value = joy_data.y;
88                                 j_button[j_buttons_in_sticks[i] + 0].state = (joy_data.buttons & 0x01);
89                                 j_button[j_buttons_in_sticks[i] + 1].state = (joy_data.buttons & 0x02) >> 1;
90                         }
91                 }
92         }
93
94         return num_processed;
95 }
96
97
98 void joy_set_cal_vals(int *axis_min, int *axis_center, int *axis_max) {
99         int i;
100
101         for (i = 0; i < 4; i++) {
102                 j_axis[i].center_val = axis_center[i];
103                 j_axis[i].min_val = axis_min[i];
104                 j_axis[i].max_val = axis_max[i];
105         }
106 }
107
108
109 void joy_get_cal_vals(int *axis_min, int *axis_center, int *axis_max) {
110         int i;
111
112         //edited 05/18/99 Matt Mueller - we should return all axes instead of j_num_axes, since they are all given to us in joy_set_cal_vals ( and because checker complains :)
113         for (i = 0; i < 4; i++) {
114         //end edit -MM
115                 axis_center[i] = j_axis[i].center_val;
116                 axis_min[i] = j_axis[i].min_val;
117                 axis_max[i] = j_axis[i].max_val;
118         }
119 }
120
121
122 void joy_set_min (int axis_number, int value) {
123         j_axis[axis_number].min_val = value;
124 }
125
126
127 void joy_set_center (int axis_number, int value) {
128         j_axis[axis_number].center_val = value;
129 }
130
131
132 void joy_set_max (int axis_number, int value) {
133         j_axis[axis_number].max_val = value;
134 }
135
136
137 ubyte joy_get_present_mask () {
138         return 1;
139 }
140
141
142 void joy_set_timer_rate (int max_value) {
143         timer_rate = max_value;
144 }
145
146
147 int joy_get_timer_rate () {
148         return timer_rate;
149 }
150
151
152 void joy_flush () {
153         int i;
154
155         if (!joy_installed) return;
156
157         for (i = 0; i < j_num_buttons; i++) {
158                 j_button[i].timedown = 0;       
159                 j_button[i].downcount = 0;      
160         }
161         
162 }
163
164
165 ubyte joystick_read_raw_axis (ubyte mask, int *axes) {
166         int i;
167         
168         j_Update_state();
169
170         for (i = 0; i < j_num_axes; i++) {
171                 axes[i] = j_axis[i].value;
172         }
173
174         return 0;
175 }
176
177
178 /* joy_init () is pretty huge, a bit klunky, and by no means pretty.  But who cares?  It does the job and it's only run once. */
179
180
181 int joy_init () {
182         int i, j;
183
184         if (joy_installed) return 0;
185         joy_flush ();
186
187         if (!joy_installed)     {
188
189                 printf ("Initializing joystick... ");
190
191                 j_joystick[0].buffer = open ("/dev/js0", O_NONBLOCK);
192                 j_joystick[1].buffer = open ("/dev/js1", O_NONBLOCK);
193                 j_joystick[2].buffer = open ("/dev/js2", O_NONBLOCK);
194                 j_joystick[3].buffer = open ("/dev/js3", O_NONBLOCK);
195                 
196                 if (j_joystick[0].buffer >= 0 || j_joystick[1].buffer >= 0 || j_joystick[2].buffer >= 0 || j_joystick[3].buffer >= 0) {
197                         printf ("found: ");
198
199                         for (i = 0; i < 4; i++) {
200                                 if (j_joystick[i].buffer >= 0) {
201                                         ioctl (j_joystick[i].buffer, JSIOCGAXES, &j_joystick[i].num_axes);
202                                         ioctl (j_joystick[i].buffer, JSIOCGBUTTONS, &j_joystick[i].num_buttons);
203                                         ioctl (j_joystick[i].buffer, JSIOCGVERSION, &j_joystick[i].version);
204                                         if (!j_joystick[i].version) {
205                                                 j_joystick[i].num_axes = 2;
206                                                 j_joystick[i].num_buttons = 2;
207                                                 printf ("js%d (v0.x)  " , i);
208                                         } else {
209                                                 printf ("js%d (v%d.%d.%d)  ",
210                                                         i, 
211                                                         (j_joystick[i].version & 0xff0000) >> 16,
212                                                         (j_joystick[i].version & 0xff00) >> 8,
213                                                         j_joystick[i].version & 0xff);
214                                         }                                               
215
216                                         for (j = j_num_axes; j < (j_num_axes + j_joystick[i].num_axes); j++) {
217                                                 j_axis[j].joydev = i;
218                                                 if (j_joystick[i].version) {
219                                                         j_axis[j].center_val = 0;
220                                                         j_axis[j].max_val = 32767;
221                                                         j_axis[j].min_val = -32767;
222                                                 }
223                                         }
224                                         for (j = j_num_buttons; j < (j_num_buttons + j_joystick[i].num_buttons); j++) {
225                                                 j_button[j].joydev = i;
226                                         }
227
228                                         j_num_axes += j_joystick[i].num_axes;
229                                         j_num_buttons += j_joystick[i].num_buttons;
230                                         
231                                 } else {
232                                         j_joystick[i].num_buttons = 0;
233                                         j_joystick[i].num_axes = 0;
234                                 }       
235
236                                 for (j = 0; j < i; j++) {
237                                         j_axes_in_sticks[i] += j_joystick[j].num_axes;
238                                         j_buttons_in_sticks[i] += j_joystick[j].num_buttons;
239                                 }
240                         }
241                 } else {
242                         printf ("no joysticks found\n");
243                         return 0;
244                 }               
245
246                 printf ("\n");
247
248                 if (j_num_axes > MAX_AXES)
249                         j_num_axes = MAX_AXES;
250                 if (j_num_buttons > MAX_BUTTONS)
251                         j_num_buttons = MAX_BUTTONS;
252
253                 joy_present = 1;
254                 joy_installed = 1;
255                 return 1;
256         }
257
258         return 1;
259 }
260
261
262 void joy_close() {
263         int i;
264
265         if (!joy_installed) return;
266
267         for (i = 0; i < 4; i++) {
268                 if (j_joystick[i].buffer>=0) {
269                         printf ("closing js%d\n", i);
270                         close (j_joystick[i].buffer);
271                 }
272                 j_joystick[i].buffer=-1;
273         }
274
275         joy_present=0;
276         joy_installed=0;
277 }
278
279
280 void joy_set_cen() {
281 }
282
283
284 int joy_get_scaled_reading(int raw, int axis_num)
285 {
286  int d, x;
287
288   raw -= j_axis[axis_num].center_val;
289
290    if (raw < 0)
291     d = j_axis[axis_num].center_val - j_axis[axis_num].min_val;
292    else if (raw > 0)
293     d = j_axis[axis_num].max_val - j_axis[axis_num].center_val;
294    else
295     d = 0;
296
297    if (d)
298     x = ((raw << 7) / d);
299    else
300     x = 0;
301
302    if ( x < -128 )
303     x = -128;
304    if ( x > 127 )
305     x = 127;
306
307 //added on 4/13/99 by Victor Rachels to add deadzone control
308   d =  (joy_deadzone) * 6;
309    if ((x > (-1*d)) && (x < d))
310     x = 0;
311 //end this section addition -VR
312
313   return x;
314 }
315
316
317 void joy_get_pos(int *x, int *y) {
318         int axis[MAX_AXES];
319
320         if ((!joy_installed)||(!joy_present)) { *x=*y=0; return; }
321
322         joystick_read_raw_axis (JOY_ALL_AXIS, axis);
323
324         *x = joy_get_scaled_reading( axis[0], 0 );
325         *y = joy_get_scaled_reading( axis[1], 1 );
326 }
327
328
329 int joy_get_btns () {
330         return 0;
331 }
332
333
334 int joy_get_button_state (int btn) {
335   if(btn >= j_num_buttons)
336    return 0;
337         j_Update_state ();
338
339         return j_button[btn].state;
340 }
341
342
343 int joy_get_button_down_cnt (int btn) {
344         int downcount;
345
346         j_Update_state ();
347
348         downcount = j_button[btn].downcount;
349         j_button[btn].downcount = 0;
350
351         return downcount;
352 }
353
354
355 //changed 6/24/99 to finally squish the timedown bug - Owen Evans
356 fix joy_get_button_down_time(int btn)  {
357         fix downtime;
358         j_Update_state ();
359
360         if (j_button[btn].state) {
361                 downtime = timer_get_fixed_seconds() - j_button[btn].timedown;
362                 j_button[btn].timedown = timer_get_fixed_seconds();
363         } else {
364                 downtime = 0;
365         }
366
367         return downtime;
368 }
369 //end changed - OE
370
371 void joy_poll() {
372
373 }
374
375
376 void joy_set_slow_reading(int flag) {
377
378 }
379
380 #endif // __ENV_LINUX__