]>
Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
deb8ee43 | 2 | * X-Box gamepad - v0.0.6 |
1da177e4 LT |
3 | * |
4 | * Copyright (c) 2002 Marko Friedemann <mfr@bmx-chemnitz.de> | |
d518b2b4 DC |
5 | * 2004 Oliver Schwartz <Oliver.Schwartz@gmx.de>, |
6 | * Steven Toth <steve@toth.demon.co.uk>, | |
7 | * Franz Lehner <franz@caos.at>, | |
8 | * Ivan Hawkes <blackhawk@ivanhawkes.com> | |
deb8ee43 DC |
9 | * 2005 Dominic Cerquetti <binary1230@yahoo.com> |
10 | * 2006 Adam Buchbinder <adam.buchbinder@gmail.com> | |
c7d9f7eb | 11 | * 2007 Jan Kratochvil <honza@jikos.cz> |
1da177e4 LT |
12 | * |
13 | * This program is free software; you can redistribute it and/or | |
14 | * modify it under the terms of the GNU General Public License as | |
15 | * published by the Free Software Foundation; either version 2 of | |
16 | * the License, or (at your option) any later version. | |
17 | * | |
18 | * This program is distributed in the hope that it will be useful, | |
19 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
20 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
21 | * GNU General Public License for more details. | |
22 | * | |
23 | * You should have received a copy of the GNU General Public License | |
24 | * along with this program; if not, write to the Free Software | |
25 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
26 | * | |
27 | * | |
28 | * This driver is based on: | |
29 | * - information from http://euc.jp/periphs/xbox-controller.ja.html | |
30 | * - the iForce driver drivers/char/joystick/iforce.c | |
31 | * - the skeleton-driver drivers/usb/usb-skeleton.c | |
c7d9f7eb | 32 | * - Xbox 360 information http://www.free60.org/wiki/Gamepad |
1da177e4 LT |
33 | * |
34 | * Thanks to: | |
35 | * - ITO Takayuki for providing essential xpad information on his website | |
36 | * - Vojtech Pavlik - iforce driver / input subsystem | |
37 | * - Greg Kroah-Hartman - usb-skeleton driver | |
d518b2b4 | 38 | * - XBOX Linux project - extra USB id's |
1da177e4 LT |
39 | * |
40 | * TODO: | |
deb8ee43 | 41 | * - fine tune axes (especially trigger axes) |
1da177e4 LT |
42 | * - fix "analog" buttons (reported as digital now) |
43 | * - get rumble working | |
deb8ee43 | 44 | * - need USB IDs for other dance pads |
1da177e4 LT |
45 | * |
46 | * History: | |
47 | * | |
48 | * 2002-06-27 - 0.0.1 : first version, just said "XBOX HID controller" | |
49 | * | |
50 | * 2002-07-02 - 0.0.2 : basic working version | |
51 | * - all axes and 9 of the 10 buttons work (german InterAct device) | |
52 | * - the black button does not work | |
53 | * | |
54 | * 2002-07-14 - 0.0.3 : rework by Vojtech Pavlik | |
55 | * - indentation fixes | |
56 | * - usb + input init sequence fixes | |
57 | * | |
58 | * 2002-07-16 - 0.0.4 : minor changes, merge with Vojtech's v0.0.3 | |
59 | * - verified the lack of HID and report descriptors | |
60 | * - verified that ALL buttons WORK | |
61 | * - fixed d-pad to axes mapping | |
62 | * | |
63 | * 2002-07-17 - 0.0.5 : simplified d-pad handling | |
d518b2b4 DC |
64 | * |
65 | * 2004-10-02 - 0.0.6 : DDR pad support | |
66 | * - borrowed from the XBOX linux kernel | |
67 | * - USB id's for commonly used dance pads are present | |
68 | * - dance pads will map D-PAD to buttons, not axes | |
69 | * - pass the module paramater 'dpad_to_buttons' to force | |
70 | * the D-PAD to map to buttons if your pad is not detected | |
1da177e4 LT |
71 | */ |
72 | ||
1da177e4 | 73 | #include <linux/kernel.h> |
1da177e4 LT |
74 | #include <linux/init.h> |
75 | #include <linux/slab.h> | |
deb8ee43 | 76 | #include <linux/stat.h> |
1da177e4 | 77 | #include <linux/module.h> |
deb8ee43 | 78 | #include <linux/moduleparam.h> |
ae0dadcf | 79 | #include <linux/usb/input.h> |
1da177e4 | 80 | |
deb8ee43 | 81 | #define DRIVER_VERSION "v0.0.6" |
1da177e4 LT |
82 | #define DRIVER_AUTHOR "Marko Friedemann <mfr@bmx-chemnitz.de>" |
83 | #define DRIVER_DESC "X-Box pad driver" | |
84 | ||
85 | #define XPAD_PKT_LEN 32 | |
86 | ||
deb8ee43 DC |
87 | /* xbox d-pads should map to buttons, as is required for DDR pads |
88 | but we map them to axes when possible to simplify things */ | |
89 | #define MAP_DPAD_TO_BUTTONS 0 | |
90 | #define MAP_DPAD_TO_AXES 1 | |
91 | #define MAP_DPAD_UNKNOWN -1 | |
92 | ||
c7d9f7eb JK |
93 | #define XTYPE_XBOX 0 |
94 | #define XTYPE_XBOX360 1 | |
95 | ||
deb8ee43 DC |
96 | static int dpad_to_buttons; |
97 | module_param(dpad_to_buttons, bool, S_IRUGO); | |
98 | MODULE_PARM_DESC(dpad_to_buttons, "Map D-PAD to buttons rather than axes for unknown pads"); | |
99 | ||
4c4c9432 | 100 | static const struct xpad_device { |
1da177e4 LT |
101 | u16 idVendor; |
102 | u16 idProduct; | |
103 | char *name; | |
deb8ee43 | 104 | u8 dpad_mapping; |
c7d9f7eb | 105 | u8 xtype; |
1da177e4 | 106 | } xpad_device[] = { |
c7d9f7eb JK |
107 | { 0x045e, 0x0202, "Microsoft X-Box pad v1 (US)", MAP_DPAD_TO_AXES, XTYPE_XBOX }, |
108 | { 0x045e, 0x0289, "Microsoft X-Box pad v2 (US)", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
109 | { 0x045e, 0x0285, "Microsoft X-Box pad (Japan)", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
110 | { 0x045e, 0x0287, "Microsoft Xbox Controller S", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
111 | { 0x0c12, 0x8809, "RedOctane Xbox Dance Pad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX }, | |
112 | { 0x044f, 0x0f07, "Thrustmaster, Inc. Controller", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
113 | { 0x046d, 0xca84, "Logitech Xbox Cordless Controller", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
114 | { 0x046d, 0xca88, "Logitech Compact Controller for Xbox", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
115 | { 0x05fd, 0x1007, "Mad Catz Controller (unverified)", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
116 | { 0x05fd, 0x107a, "InterAct 'PowerPad Pro' X-Box pad (Germany)", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
117 | { 0x0738, 0x4516, "Mad Catz Control Pad", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
118 | { 0x0738, 0x4522, "Mad Catz LumiCON", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
119 | { 0x0738, 0x4526, "Mad Catz Control Pad Pro", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
120 | { 0x0738, 0x4536, "Mad Catz MicroCON", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
121 | { 0x0738, 0x4540, "Mad Catz Beat Pad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX }, | |
122 | { 0x0738, 0x4556, "Mad Catz Lynx Wireless Controller", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
123 | { 0x0738, 0x6040, "Mad Catz Beat Pad Pro", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX }, | |
124 | { 0x0c12, 0x8802, "Zeroplus Xbox Controller", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
125 | { 0x0c12, 0x8810, "Zeroplus Xbox Controller", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
126 | { 0x0c12, 0x9902, "HAMA VibraX - *FAULTY HARDWARE*", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
127 | { 0x0e4c, 0x1097, "Radica Gamester Controller", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
128 | { 0x0e4c, 0x2390, "Radica Games Jtech Controller", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
129 | { 0x0e6f, 0x0003, "Logic3 Freebird wireless Controller", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
130 | { 0x0e6f, 0x0005, "Eclipse wireless Controller", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
131 | { 0x0e6f, 0x0006, "Edge wireless Controller", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
132 | { 0x0e8f, 0x0201, "SmartJoy Frag Xpad/PS2 adaptor", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
133 | { 0x0f30, 0x0202, "Joytech Advanced Controller", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
134 | { 0x0f30, 0x8888, "BigBen XBMiniPad Controller", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
135 | { 0x102c, 0xff0c, "Joytech Wireless Advanced Controller", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
136 | { 0x12ab, 0x8809, "Xbox DDR dancepad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX }, | |
137 | { 0x1430, 0x8888, "TX6500+ Dance Pad (first generation)", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX }, | |
138 | { 0x045e, 0x028e, "Microsoft X-Box 360 pad", MAP_DPAD_TO_AXES, XTYPE_XBOX360 }, | |
139 | { 0xffff, 0xffff, "Chinese-made Xbox Controller", MAP_DPAD_TO_AXES, XTYPE_XBOX }, | |
140 | { 0x0000, 0x0000, "Generic X-Box pad", MAP_DPAD_UNKNOWN, XTYPE_XBOX } | |
1da177e4 LT |
141 | }; |
142 | ||
4c4c9432 | 143 | static const signed short xpad_btn[] = { |
1da177e4 LT |
144 | BTN_A, BTN_B, BTN_C, BTN_X, BTN_Y, BTN_Z, /* "analog" buttons */ |
145 | BTN_START, BTN_BACK, BTN_THUMBL, BTN_THUMBR, /* start/back/sticks */ | |
146 | -1 /* terminating entry */ | |
147 | }; | |
148 | ||
deb8ee43 DC |
149 | /* only used if MAP_DPAD_TO_BUTTONS */ |
150 | static const signed short xpad_btn_pad[] = { | |
151 | BTN_LEFT, BTN_RIGHT, /* d-pad left, right */ | |
152 | BTN_0, BTN_1, /* d-pad up, down (XXX names??) */ | |
153 | -1 /* terminating entry */ | |
154 | }; | |
155 | ||
c7d9f7eb JK |
156 | static const signed short xpad360_btn[] = { /* buttons for x360 controller */ |
157 | BTN_TL, BTN_TR, /* Button LB/RB */ | |
158 | BTN_MODE, /* The big X button */ | |
159 | -1 | |
160 | }; | |
161 | ||
4c4c9432 | 162 | static const signed short xpad_abs[] = { |
1da177e4 LT |
163 | ABS_X, ABS_Y, /* left stick */ |
164 | ABS_RX, ABS_RY, /* right stick */ | |
165 | ABS_Z, ABS_RZ, /* triggers left/right */ | |
deb8ee43 DC |
166 | -1 /* terminating entry */ |
167 | }; | |
168 | ||
169 | /* only used if MAP_DPAD_TO_AXES */ | |
170 | static const signed short xpad_abs_pad[] = { | |
171 | ABS_HAT0X, ABS_HAT0Y, /* d-pad axes */ | |
1da177e4 LT |
172 | -1 /* terminating entry */ |
173 | }; | |
174 | ||
c7d9f7eb JK |
175 | /* Xbox 360 has a vendor-specific (sub)class, so we cannot match it with only |
176 | * USB_INTERFACE_INFO, more to that this device has 4 InterfaceProtocols, | |
177 | * but we need only one of them. */ | |
1da177e4 LT |
178 | static struct usb_device_id xpad_table [] = { |
179 | { USB_INTERFACE_INFO('X', 'B', 0) }, /* X-Box USB-IF not approved class */ | |
c7d9f7eb | 180 | { USB_DEVICE_INTERFACE_PROTOCOL(0x045e, 0x028e, 1) }, /* X-Box 360 controller */ |
1da177e4 LT |
181 | { } |
182 | }; | |
183 | ||
184 | MODULE_DEVICE_TABLE (usb, xpad_table); | |
185 | ||
186 | struct usb_xpad { | |
deb8ee43 DC |
187 | struct input_dev *dev; /* input device interface */ |
188 | struct usb_device *udev; /* usb device */ | |
05f091ab | 189 | |
deb8ee43 DC |
190 | struct urb *irq_in; /* urb for interrupt in report */ |
191 | unsigned char *idata; /* input data */ | |
1da177e4 | 192 | dma_addr_t idata_dma; |
05f091ab | 193 | |
4994cd8d | 194 | #if defined(CONFIG_JOYSTICK_XPAD_FF) || defined(CONFIG_JOYSTICK_XPAD_LEDS) |
e01a06e8 JK |
195 | struct urb *irq_out; /* urb for interrupt out report */ |
196 | unsigned char *odata; /* output data */ | |
197 | dma_addr_t odata_dma; | |
4994cd8d JK |
198 | struct mutex odata_mutex; |
199 | #endif | |
200 | ||
201 | #if defined(CONFIG_JOYSTICK_XPAD_LEDS) | |
202 | struct xpad_led *led; | |
e01a06e8 JK |
203 | #endif |
204 | ||
4994cd8d | 205 | char phys[64]; /* physical device path */ |
deb8ee43 DC |
206 | |
207 | int dpad_mapping; /* map d-pad to buttons or to axes */ | |
c7d9f7eb | 208 | int xtype; /* type of xbox device */ |
1da177e4 LT |
209 | }; |
210 | ||
211 | /* | |
212 | * xpad_process_packet | |
213 | * | |
214 | * Completes a request by converting the data into events for the | |
215 | * input subsystem. | |
216 | * | |
217 | * The used report descriptor was taken from ITO Takayukis website: | |
218 | * http://euc.jp/periphs/xbox-controller.ja.html | |
219 | */ | |
220 | ||
7d12e780 | 221 | static void xpad_process_packet(struct usb_xpad *xpad, u16 cmd, unsigned char *data) |
1da177e4 | 222 | { |
c5b7c7c3 | 223 | struct input_dev *dev = xpad->dev; |
1da177e4 | 224 | |
1da177e4 LT |
225 | /* left stick */ |
226 | input_report_abs(dev, ABS_X, (__s16) (((__s16)data[13] << 8) | data[12])); | |
227 | input_report_abs(dev, ABS_Y, (__s16) (((__s16)data[15] << 8) | data[14])); | |
05f091ab | 228 | |
1da177e4 LT |
229 | /* right stick */ |
230 | input_report_abs(dev, ABS_RX, (__s16) (((__s16)data[17] << 8) | data[16])); | |
231 | input_report_abs(dev, ABS_RY, (__s16) (((__s16)data[19] << 8) | data[18])); | |
05f091ab | 232 | |
1da177e4 LT |
233 | /* triggers left/right */ |
234 | input_report_abs(dev, ABS_Z, data[10]); | |
235 | input_report_abs(dev, ABS_RZ, data[11]); | |
05f091ab | 236 | |
1da177e4 | 237 | /* digital pad */ |
deb8ee43 DC |
238 | if (xpad->dpad_mapping == MAP_DPAD_TO_AXES) { |
239 | input_report_abs(dev, ABS_HAT0X, !!(data[2] & 0x08) - !!(data[2] & 0x04)); | |
240 | input_report_abs(dev, ABS_HAT0Y, !!(data[2] & 0x02) - !!(data[2] & 0x01)); | |
241 | } else /* xpad->dpad_mapping == MAP_DPAD_TO_BUTTONS */ { | |
242 | input_report_key(dev, BTN_LEFT, data[2] & 0x04); | |
243 | input_report_key(dev, BTN_RIGHT, data[2] & 0x08); | |
ae91d10a DT |
244 | input_report_key(dev, BTN_0, data[2] & 0x01); /* up */ |
245 | input_report_key(dev, BTN_1, data[2] & 0x02); /* down */ | |
deb8ee43 | 246 | } |
05f091ab | 247 | |
1da177e4 | 248 | /* start/back buttons and stick press left/right */ |
deb8ee43 DC |
249 | input_report_key(dev, BTN_START, data[2] & 0x10); |
250 | input_report_key(dev, BTN_BACK, data[2] & 0x20); | |
251 | input_report_key(dev, BTN_THUMBL, data[2] & 0x40); | |
252 | input_report_key(dev, BTN_THUMBR, data[2] & 0x80); | |
05f091ab | 253 | |
1da177e4 LT |
254 | /* "analog" buttons A, B, X, Y */ |
255 | input_report_key(dev, BTN_A, data[4]); | |
256 | input_report_key(dev, BTN_B, data[5]); | |
257 | input_report_key(dev, BTN_X, data[6]); | |
258 | input_report_key(dev, BTN_Y, data[7]); | |
05f091ab | 259 | |
1da177e4 LT |
260 | /* "analog" buttons black, white */ |
261 | input_report_key(dev, BTN_C, data[8]); | |
262 | input_report_key(dev, BTN_Z, data[9]); | |
263 | ||
264 | input_sync(dev); | |
265 | } | |
266 | ||
c7d9f7eb JK |
267 | /* |
268 | * xpad360_process_packet | |
269 | * | |
270 | * Completes a request by converting the data into events for the | |
271 | * input subsystem. It is version for xbox 360 controller | |
272 | * | |
273 | * The used report descriptor was taken from: | |
274 | * http://www.free60.org/wiki/Gamepad | |
275 | */ | |
276 | ||
277 | static void xpad360_process_packet(struct usb_xpad *xpad, u16 cmd, unsigned char *data) | |
278 | { | |
279 | struct input_dev *dev = xpad->dev; | |
280 | ||
281 | /* digital pad */ | |
282 | if (xpad->dpad_mapping == MAP_DPAD_TO_AXES) { | |
ae91d10a DT |
283 | input_report_abs(dev, ABS_HAT0X, !!(data[2] & 0x08) - !!(data[2] & 0x04)); |
284 | input_report_abs(dev, ABS_HAT0Y, !!(data[2] & 0x02) - !!(data[2] & 0x01)); | |
285 | } else if (xpad->dpad_mapping == MAP_DPAD_TO_BUTTONS) { | |
c7d9f7eb | 286 | /* dpad as buttons (right, left, down, up) */ |
ae91d10a DT |
287 | input_report_key(dev, BTN_LEFT, data[2] & 0x04); |
288 | input_report_key(dev, BTN_RIGHT, data[2] & 0x08); | |
289 | input_report_key(dev, BTN_0, data[2] & 0x01); /* up */ | |
290 | input_report_key(dev, BTN_1, data[2] & 0x02); /* down */ | |
c7d9f7eb JK |
291 | } |
292 | ||
293 | /* start/back buttons */ | |
ae91d10a DT |
294 | input_report_key(dev, BTN_START, data[2] & 0x10); |
295 | input_report_key(dev, BTN_BACK, data[2] & 0x20); | |
c7d9f7eb JK |
296 | |
297 | /* stick press left/right */ | |
298 | input_report_key(dev, BTN_THUMBL, data[2] & 0x40); | |
299 | input_report_key(dev, BTN_THUMBR, data[2] & 0x80); | |
300 | ||
301 | /* buttons A,B,X,Y,TL,TR and MODE */ | |
ae91d10a DT |
302 | input_report_key(dev, BTN_A, data[3] & 0x10); |
303 | input_report_key(dev, BTN_B, data[3] & 0x20); | |
304 | input_report_key(dev, BTN_X, data[3] & 0x40); | |
305 | input_report_key(dev, BTN_Y, data[3] & 0x80); | |
306 | input_report_key(dev, BTN_TL, data[3] & 0x01); | |
307 | input_report_key(dev, BTN_TR, data[3] & 0x02); | |
308 | input_report_key(dev, BTN_MODE, data[3] & 0x04); | |
c7d9f7eb JK |
309 | |
310 | /* left stick */ | |
311 | input_report_abs(dev, ABS_X, (__s16) (((__s16)data[7] << 8) | (__s16)data[6])); | |
ae91d10a | 312 | input_report_abs(dev, ABS_Y, (__s16) (((__s16)data[9] << 8) | (__s16)data[8])); |
c7d9f7eb JK |
313 | |
314 | /* right stick */ | |
c7d9f7eb | 315 | input_report_abs(dev, ABS_RX, (__s16) (((__s16)data[11] << 8) | (__s16)data[10])); |
ae91d10a | 316 | input_report_abs(dev, ABS_RY, (__s16) (((__s16)data[13] << 8) | (__s16)data[12])); |
c7d9f7eb JK |
317 | |
318 | /* triggers left/right */ | |
319 | input_report_abs(dev, ABS_Z, data[4]); | |
320 | input_report_abs(dev, ABS_RZ, data[5]); | |
321 | ||
322 | input_sync(dev); | |
323 | } | |
324 | ||
7d12e780 | 325 | static void xpad_irq_in(struct urb *urb) |
1da177e4 LT |
326 | { |
327 | struct usb_xpad *xpad = urb->context; | |
328 | int retval; | |
05f091ab | 329 | |
1da177e4 LT |
330 | switch (urb->status) { |
331 | case 0: | |
332 | /* success */ | |
333 | break; | |
334 | case -ECONNRESET: | |
335 | case -ENOENT: | |
336 | case -ESHUTDOWN: | |
337 | /* this urb is terminated, clean up */ | |
338 | dbg("%s - urb shutting down with status: %d", __FUNCTION__, urb->status); | |
339 | return; | |
340 | default: | |
341 | dbg("%s - nonzero urb status received: %d", __FUNCTION__, urb->status); | |
342 | goto exit; | |
343 | } | |
05f091ab | 344 | |
c7d9f7eb JK |
345 | if (xpad->xtype == XTYPE_XBOX360) |
346 | xpad360_process_packet(xpad, 0, xpad->idata); | |
347 | else | |
348 | xpad_process_packet(xpad, 0, xpad->idata); | |
1da177e4 LT |
349 | |
350 | exit: | |
351 | retval = usb_submit_urb (urb, GFP_ATOMIC); | |
352 | if (retval) | |
353 | err ("%s - usb_submit_urb failed with result %d", | |
354 | __FUNCTION__, retval); | |
355 | } | |
356 | ||
4994cd8d | 357 | #if defined(CONFIG_JOYSTICK_XPAD_FF) || defined(CONFIG_JOYSTICK_XPAD_LEDS) |
e01a06e8 JK |
358 | static void xpad_irq_out(struct urb *urb) |
359 | { | |
360 | int retval; | |
361 | ||
362 | switch (urb->status) { | |
363 | case 0: | |
364 | /* success */ | |
365 | break; | |
366 | case -ECONNRESET: | |
367 | case -ENOENT: | |
368 | case -ESHUTDOWN: | |
369 | /* this urb is terminated, clean up */ | |
370 | dbg("%s - urb shutting down with status: %d", __FUNCTION__, urb->status); | |
371 | return; | |
372 | default: | |
373 | dbg("%s - nonzero urb status received: %d", __FUNCTION__, urb->status); | |
374 | goto exit; | |
375 | } | |
376 | ||
377 | exit: | |
378 | retval = usb_submit_urb(urb, GFP_ATOMIC); | |
379 | if (retval) | |
380 | err("%s - usb_submit_urb failed with result %d", | |
381 | __FUNCTION__, retval); | |
382 | } | |
383 | ||
4994cd8d | 384 | static int xpad_init_output(struct usb_interface *intf, struct usb_xpad *xpad) |
e01a06e8 JK |
385 | { |
386 | struct usb_endpoint_descriptor *ep_irq_out; | |
387 | int error = -ENOMEM; | |
388 | ||
389 | if (xpad->xtype != XTYPE_XBOX360) | |
390 | return 0; | |
391 | ||
392 | xpad->odata = usb_buffer_alloc(xpad->udev, XPAD_PKT_LEN, | |
393 | GFP_ATOMIC, &xpad->odata_dma ); | |
2e8335a6 | 394 | if (!xpad->odata) |
e01a06e8 JK |
395 | goto fail1; |
396 | ||
4994cd8d JK |
397 | mutex_init(&xpad->odata_mutex); |
398 | ||
e01a06e8 JK |
399 | xpad->irq_out = usb_alloc_urb(0, GFP_KERNEL); |
400 | if (!xpad->irq_out) | |
401 | goto fail2; | |
402 | ||
403 | ep_irq_out = &intf->cur_altsetting->endpoint[1].desc; | |
404 | usb_fill_int_urb(xpad->irq_out, xpad->udev, | |
405 | usb_sndintpipe(xpad->udev, ep_irq_out->bEndpointAddress), | |
406 | xpad->odata, XPAD_PKT_LEN, | |
407 | xpad_irq_out, xpad, ep_irq_out->bInterval); | |
408 | xpad->irq_out->transfer_dma = xpad->odata_dma; | |
409 | xpad->irq_out->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | |
410 | ||
e01a06e8 JK |
411 | return 0; |
412 | ||
413 | fail2: usb_buffer_free(xpad->udev, XPAD_PKT_LEN, xpad->odata, xpad->odata_dma); | |
414 | fail1: return error; | |
415 | } | |
416 | ||
4994cd8d | 417 | static void xpad_stop_output(struct usb_xpad *xpad) |
e01a06e8 JK |
418 | { |
419 | if (xpad->xtype == XTYPE_XBOX360) | |
420 | usb_kill_urb(xpad->irq_out); | |
421 | } | |
422 | ||
4994cd8d | 423 | static void xpad_deinit_output(struct usb_xpad *xpad) |
e01a06e8 JK |
424 | { |
425 | if (xpad->xtype == XTYPE_XBOX360) { | |
426 | usb_free_urb(xpad->irq_out); | |
427 | usb_buffer_free(xpad->udev, XPAD_PKT_LEN, | |
428 | xpad->odata, xpad->odata_dma); | |
429 | } | |
430 | } | |
4994cd8d JK |
431 | #else |
432 | static int xpad_init_output(struct usb_interface *intf, struct usb_xpad *xpad) { return 0; } | |
433 | static void xpad_deinit_output(struct usb_xpad *xpad) {} | |
434 | static void xpad_stop_output(struct usb_xpad *xpad) {} | |
435 | #endif | |
436 | ||
437 | #ifdef CONFIG_JOYSTICK_XPAD_FF | |
438 | static int xpad_play_effect(struct input_dev *dev, void *data, | |
439 | struct ff_effect *effect) | |
440 | { | |
441 | struct usb_xpad *xpad = input_get_drvdata(dev); | |
e01a06e8 | 442 | |
4994cd8d JK |
443 | if (effect->type == FF_RUMBLE) { |
444 | __u16 strong = effect->u.rumble.strong_magnitude; | |
445 | __u16 weak = effect->u.rumble.weak_magnitude; | |
446 | xpad->odata[0] = 0x00; | |
447 | xpad->odata[1] = 0x08; | |
448 | xpad->odata[2] = 0x00; | |
449 | xpad->odata[3] = strong / 256; | |
450 | xpad->odata[4] = weak / 256; | |
451 | xpad->odata[5] = 0x00; | |
452 | xpad->odata[6] = 0x00; | |
453 | xpad->odata[7] = 0x00; | |
454 | usb_submit_urb(xpad->irq_out, GFP_KERNEL); | |
455 | } | |
456 | ||
457 | return 0; | |
458 | } | |
459 | ||
460 | static int xpad_init_ff(struct usb_xpad *xpad) | |
461 | { | |
462 | input_set_capability(xpad->dev, EV_FF, FF_RUMBLE); | |
463 | ||
464 | return input_ff_create_memless(xpad->dev, NULL, xpad_play_effect); | |
465 | } | |
466 | ||
467 | #else | |
468 | static int xpad_init_ff(struct usb_xpad *xpad) { return 0; } | |
469 | #endif | |
470 | ||
471 | #if defined(CONFIG_JOYSTICK_XPAD_LEDS) | |
472 | #include <linux/leds.h> | |
473 | ||
474 | struct xpad_led { | |
475 | char name[16]; | |
476 | struct led_classdev led_cdev; | |
477 | struct usb_xpad *xpad; | |
478 | }; | |
479 | ||
480 | static void xpad_send_led_command(struct usb_xpad *xpad, int command) | |
481 | { | |
482 | if (command >= 0 && command < 14) { | |
483 | mutex_lock(&xpad->odata_mutex); | |
484 | xpad->odata[0] = 0x01; | |
485 | xpad->odata[1] = 0x03; | |
486 | xpad->odata[2] = command; | |
487 | usb_submit_urb(xpad->irq_out, GFP_KERNEL); | |
488 | mutex_unlock(&xpad->odata_mutex); | |
489 | } | |
490 | } | |
491 | ||
492 | static void xpad_led_set(struct led_classdev *led_cdev, | |
493 | enum led_brightness value) | |
494 | { | |
495 | struct xpad_led *xpad_led = container_of(led_cdev, | |
496 | struct xpad_led, led_cdev); | |
497 | ||
498 | xpad_send_led_command(xpad_led->xpad, value); | |
499 | } | |
500 | ||
501 | static int xpad_led_probe(struct usb_xpad *xpad) | |
502 | { | |
503 | static atomic_t led_seq = ATOMIC_INIT(0); | |
504 | long led_no; | |
505 | struct xpad_led *led; | |
506 | struct led_classdev *led_cdev; | |
507 | int error; | |
508 | ||
509 | if (xpad->xtype != XTYPE_XBOX360) | |
510 | return 0; | |
511 | ||
512 | xpad->led = led = kzalloc(sizeof(struct xpad_led), GFP_KERNEL); | |
513 | if (!led) | |
514 | return -ENOMEM; | |
515 | ||
516 | led_no = (long)atomic_inc_return(&led_seq) - 1; | |
517 | ||
518 | snprintf(led->name, sizeof(led->name), "xpad%ld", led_no); | |
519 | led->xpad = xpad; | |
520 | ||
521 | led_cdev = &led->led_cdev; | |
522 | led_cdev->name = led->name; | |
523 | led_cdev->brightness_set = xpad_led_set; | |
524 | ||
525 | error = led_classdev_register(&xpad->udev->dev, led_cdev); | |
526 | if (error) { | |
527 | kfree(led); | |
528 | xpad->led = NULL; | |
529 | return error; | |
530 | } | |
531 | ||
532 | /* | |
533 | * Light up the segment corresponding to controller number | |
534 | */ | |
535 | xpad_send_led_command(xpad, (led_no % 4) + 2); | |
536 | ||
537 | return 0; | |
538 | } | |
539 | ||
540 | static void xpad_led_disconnect(struct usb_xpad *xpad) | |
541 | { | |
542 | struct xpad_led *xpad_led = xpad->led; | |
543 | ||
544 | if (xpad_led) { | |
545 | led_classdev_unregister(&xpad_led->led_cdev); | |
546 | kfree(xpad_led->name); | |
547 | } | |
548 | } | |
e01a06e8 | 549 | #else |
4994cd8d JK |
550 | static int xpad_led_probe(struct usb_xpad *xpad) { return 0; } |
551 | static void xpad_led_disconnect(struct usb_xpad *xpad) { } | |
e01a06e8 JK |
552 | #endif |
553 | ||
4994cd8d | 554 | |
e01a06e8 | 555 | static int xpad_open(struct input_dev *dev) |
1da177e4 | 556 | { |
7791bdae | 557 | struct usb_xpad *xpad = input_get_drvdata(dev); |
05f091ab | 558 | |
1da177e4 | 559 | xpad->irq_in->dev = xpad->udev; |
65cde54b | 560 | if (usb_submit_urb(xpad->irq_in, GFP_KERNEL)) |
1da177e4 | 561 | return -EIO; |
05f091ab | 562 | |
1da177e4 LT |
563 | return 0; |
564 | } | |
565 | ||
e01a06e8 | 566 | static void xpad_close(struct input_dev *dev) |
1da177e4 | 567 | { |
7791bdae | 568 | struct usb_xpad *xpad = input_get_drvdata(dev); |
05f091ab | 569 | |
65cde54b | 570 | usb_kill_urb(xpad->irq_in); |
4994cd8d | 571 | xpad_stop_output(xpad); |
1da177e4 LT |
572 | } |
573 | ||
deb8ee43 DC |
574 | static void xpad_set_up_abs(struct input_dev *input_dev, signed short abs) |
575 | { | |
576 | set_bit(abs, input_dev->absbit); | |
577 | ||
578 | switch (abs) { | |
579 | case ABS_X: | |
580 | case ABS_Y: | |
581 | case ABS_RX: | |
582 | case ABS_RY: /* the two sticks */ | |
583 | input_set_abs_params(input_dev, abs, -32768, 32767, 16, 128); | |
584 | break; | |
585 | case ABS_Z: | |
586 | case ABS_RZ: /* the triggers */ | |
587 | input_set_abs_params(input_dev, abs, 0, 255, 0, 0); | |
588 | break; | |
589 | case ABS_HAT0X: | |
590 | case ABS_HAT0Y: /* the d-pad (only if MAP_DPAD_TO_AXES) */ | |
591 | input_set_abs_params(input_dev, abs, -1, 1, 0, 0); | |
592 | break; | |
593 | } | |
594 | } | |
595 | ||
1da177e4 LT |
596 | static int xpad_probe(struct usb_interface *intf, const struct usb_device_id *id) |
597 | { | |
598 | struct usb_device *udev = interface_to_usbdev (intf); | |
c5b7c7c3 DT |
599 | struct usb_xpad *xpad; |
600 | struct input_dev *input_dev; | |
1da177e4 | 601 | struct usb_endpoint_descriptor *ep_irq_in; |
1da177e4 | 602 | int i; |
5014186d | 603 | int error = -ENOMEM; |
05f091ab | 604 | |
1da177e4 LT |
605 | for (i = 0; xpad_device[i].idVendor; i++) { |
606 | if ((le16_to_cpu(udev->descriptor.idVendor) == xpad_device[i].idVendor) && | |
607 | (le16_to_cpu(udev->descriptor.idProduct) == xpad_device[i].idProduct)) | |
608 | break; | |
609 | } | |
05f091ab | 610 | |
c5b7c7c3 DT |
611 | xpad = kzalloc(sizeof(struct usb_xpad), GFP_KERNEL); |
612 | input_dev = input_allocate_device(); | |
613 | if (!xpad || !input_dev) | |
614 | goto fail1; | |
05f091ab | 615 | |
1da177e4 | 616 | xpad->idata = usb_buffer_alloc(udev, XPAD_PKT_LEN, |
54e6ecb2 | 617 | GFP_ATOMIC, &xpad->idata_dma); |
c5b7c7c3 DT |
618 | if (!xpad->idata) |
619 | goto fail1; | |
1da177e4 LT |
620 | |
621 | xpad->irq_in = usb_alloc_urb(0, GFP_KERNEL); | |
c5b7c7c3 DT |
622 | if (!xpad->irq_in) |
623 | goto fail2; | |
05f091ab | 624 | |
1da177e4 | 625 | xpad->udev = udev; |
deb8ee43 | 626 | xpad->dpad_mapping = xpad_device[i].dpad_mapping; |
c7d9f7eb | 627 | xpad->xtype = xpad_device[i].xtype; |
deb8ee43 DC |
628 | if (xpad->dpad_mapping == MAP_DPAD_UNKNOWN) |
629 | xpad->dpad_mapping = dpad_to_buttons; | |
c5b7c7c3 DT |
630 | xpad->dev = input_dev; |
631 | usb_make_path(udev, xpad->phys, sizeof(xpad->phys)); | |
632 | strlcat(xpad->phys, "/input0", sizeof(xpad->phys)); | |
05f091ab | 633 | |
c5b7c7c3 DT |
634 | input_dev->name = xpad_device[i].name; |
635 | input_dev->phys = xpad->phys; | |
636 | usb_to_input_id(udev, &input_dev->id); | |
c0f82d57 | 637 | input_dev->dev.parent = &intf->dev; |
7791bdae DT |
638 | |
639 | input_set_drvdata(input_dev, xpad); | |
640 | ||
c5b7c7c3 DT |
641 | input_dev->open = xpad_open; |
642 | input_dev->close = xpad_close; | |
05f091ab | 643 | |
c5b7c7c3 | 644 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
05f091ab | 645 | |
deb8ee43 | 646 | /* set up buttons */ |
1da177e4 | 647 | for (i = 0; xpad_btn[i] >= 0; i++) |
c5b7c7c3 | 648 | set_bit(xpad_btn[i], input_dev->keybit); |
c7d9f7eb JK |
649 | if (xpad->xtype == XTYPE_XBOX360) |
650 | for (i = 0; xpad360_btn[i] >= 0; i++) | |
651 | set_bit(xpad360_btn[i], input_dev->keybit); | |
deb8ee43 DC |
652 | if (xpad->dpad_mapping == MAP_DPAD_TO_BUTTONS) |
653 | for (i = 0; xpad_btn_pad[i] >= 0; i++) | |
654 | set_bit(xpad_btn_pad[i], input_dev->keybit); | |
05f091ab | 655 | |
deb8ee43 DC |
656 | /* set up axes */ |
657 | for (i = 0; xpad_abs[i] >= 0; i++) | |
658 | xpad_set_up_abs(input_dev, xpad_abs[i]); | |
659 | if (xpad->dpad_mapping == MAP_DPAD_TO_AXES) | |
660 | for (i = 0; xpad_abs_pad[i] >= 0; i++) | |
661 | xpad_set_up_abs(input_dev, xpad_abs_pad[i]); | |
05f091ab | 662 | |
4994cd8d | 663 | error = xpad_init_output(intf, xpad); |
e01a06e8 JK |
664 | if (error) |
665 | goto fail2; | |
666 | ||
4994cd8d JK |
667 | error = xpad_init_ff(xpad); |
668 | if (error) | |
669 | goto fail3; | |
670 | ||
671 | error = xpad_led_probe(xpad); | |
672 | if (error) | |
673 | goto fail3; | |
674 | ||
c5b7c7c3 DT |
675 | ep_irq_in = &intf->cur_altsetting->endpoint[0].desc; |
676 | usb_fill_int_urb(xpad->irq_in, udev, | |
677 | usb_rcvintpipe(udev, ep_irq_in->bEndpointAddress), | |
678 | xpad->idata, XPAD_PKT_LEN, xpad_irq_in, | |
679 | xpad, ep_irq_in->bInterval); | |
680 | xpad->irq_in->transfer_dma = xpad->idata_dma; | |
681 | xpad->irq_in->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | |
05f091ab | 682 | |
5014186d DT |
683 | error = input_register_device(xpad->dev); |
684 | if (error) | |
4994cd8d | 685 | goto fail4; |
05f091ab | 686 | |
1da177e4 LT |
687 | usb_set_intfdata(intf, xpad); |
688 | return 0; | |
c5b7c7c3 | 689 | |
4994cd8d JK |
690 | fail4: usb_free_urb(xpad->irq_in); |
691 | fail3: xpad_deinit_output(xpad); | |
5014186d DT |
692 | fail2: usb_buffer_free(udev, XPAD_PKT_LEN, xpad->idata, xpad->idata_dma); |
693 | fail1: input_free_device(input_dev); | |
c5b7c7c3 | 694 | kfree(xpad); |
5014186d | 695 | return error; |
c5b7c7c3 | 696 | |
1da177e4 LT |
697 | } |
698 | ||
699 | static void xpad_disconnect(struct usb_interface *intf) | |
700 | { | |
701 | struct usb_xpad *xpad = usb_get_intfdata (intf); | |
05f091ab | 702 | |
1da177e4 LT |
703 | usb_set_intfdata(intf, NULL); |
704 | if (xpad) { | |
4994cd8d | 705 | xpad_led_disconnect(xpad); |
c5b7c7c3 | 706 | input_unregister_device(xpad->dev); |
4994cd8d | 707 | xpad_deinit_output(xpad); |
1da177e4 | 708 | usb_free_urb(xpad->irq_in); |
e01a06e8 | 709 | usb_buffer_free(xpad->udev, XPAD_PKT_LEN, |
deb8ee43 | 710 | xpad->idata, xpad->idata_dma); |
1da177e4 LT |
711 | kfree(xpad); |
712 | } | |
713 | } | |
714 | ||
715 | static struct usb_driver xpad_driver = { | |
1da177e4 LT |
716 | .name = "xpad", |
717 | .probe = xpad_probe, | |
718 | .disconnect = xpad_disconnect, | |
719 | .id_table = xpad_table, | |
720 | }; | |
721 | ||
722 | static int __init usb_xpad_init(void) | |
723 | { | |
724 | int result = usb_register(&xpad_driver); | |
725 | if (result == 0) | |
726 | info(DRIVER_DESC ":" DRIVER_VERSION); | |
727 | return result; | |
728 | } | |
729 | ||
730 | static void __exit usb_xpad_exit(void) | |
731 | { | |
732 | usb_deregister(&xpad_driver); | |
733 | } | |
734 | ||
735 | module_init(usb_xpad_init); | |
736 | module_exit(usb_xpad_exit); | |
737 | ||
738 | MODULE_AUTHOR(DRIVER_AUTHOR); | |
739 | MODULE_DESCRIPTION(DRIVER_DESC); | |
740 | MODULE_LICENSE("GPL"); |