]>
Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
bf8cb314 | 2 | * X-Box gamepad driver |
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 | |
bf8cb314 AH |
71 | * |
72 | * Later changes can be tracked in SCM. | |
1da177e4 LT |
73 | */ |
74 | ||
1da177e4 | 75 | #include <linux/kernel.h> |
1da177e4 LT |
76 | #include <linux/init.h> |
77 | #include <linux/slab.h> | |
deb8ee43 | 78 | #include <linux/stat.h> |
1da177e4 | 79 | #include <linux/module.h> |
ae0dadcf | 80 | #include <linux/usb/input.h> |
1da177e4 | 81 | |
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 */ | |
b45d44e7 NL |
89 | #define MAP_DPAD_TO_BUTTONS (1 << 0) |
90 | #define MAP_TRIGGERS_TO_BUTTONS (1 << 1) | |
deb8ee43 | 91 | |
c7d9f7eb JK |
92 | #define XTYPE_XBOX 0 |
93 | #define XTYPE_XBOX360 1 | |
99de0912 BM |
94 | #define XTYPE_XBOX360W 2 |
95 | #define XTYPE_UNKNOWN 3 | |
c7d9f7eb | 96 | |
deb8ee43 DC |
97 | static int dpad_to_buttons; |
98 | module_param(dpad_to_buttons, bool, S_IRUGO); | |
99 | MODULE_PARM_DESC(dpad_to_buttons, "Map D-PAD to buttons rather than axes for unknown pads"); | |
100 | ||
b45d44e7 NL |
101 | static int triggers_to_buttons; |
102 | module_param(triggers_to_buttons, bool, S_IRUGO); | |
103 | MODULE_PARM_DESC(triggers_to_buttons, "Map triggers to buttons rather than axes for unknown pads"); | |
104 | ||
4c4c9432 | 105 | static const struct xpad_device { |
1da177e4 LT |
106 | u16 idVendor; |
107 | u16 idProduct; | |
108 | char *name; | |
b45d44e7 | 109 | u8 mapping; |
c7d9f7eb | 110 | u8 xtype; |
1da177e4 | 111 | } xpad_device[] = { |
b45d44e7 NL |
112 | { 0x045e, 0x0202, "Microsoft X-Box pad v1 (US)", 0, XTYPE_XBOX }, |
113 | { 0x045e, 0x0289, "Microsoft X-Box pad v2 (US)", 0, XTYPE_XBOX }, | |
114 | { 0x045e, 0x0285, "Microsoft X-Box pad (Japan)", 0, XTYPE_XBOX }, | |
115 | { 0x045e, 0x0287, "Microsoft Xbox Controller S", 0, XTYPE_XBOX }, | |
99de0912 | 116 | { 0x045e, 0x0719, "Xbox 360 Wireless Receiver", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX360W }, |
c7d9f7eb | 117 | { 0x0c12, 0x8809, "RedOctane Xbox Dance Pad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX }, |
b45d44e7 NL |
118 | { 0x044f, 0x0f07, "Thrustmaster, Inc. Controller", 0, XTYPE_XBOX }, |
119 | { 0x046d, 0xc242, "Logitech Chillstream Controller", 0, XTYPE_XBOX360 }, | |
120 | { 0x046d, 0xca84, "Logitech Xbox Cordless Controller", 0, XTYPE_XBOX }, | |
121 | { 0x046d, 0xca88, "Logitech Compact Controller for Xbox", 0, XTYPE_XBOX }, | |
122 | { 0x05fd, 0x1007, "Mad Catz Controller (unverified)", 0, XTYPE_XBOX }, | |
123 | { 0x05fd, 0x107a, "InterAct 'PowerPad Pro' X-Box pad (Germany)", 0, XTYPE_XBOX }, | |
124 | { 0x0738, 0x4516, "Mad Catz Control Pad", 0, XTYPE_XBOX }, | |
125 | { 0x0738, 0x4522, "Mad Catz LumiCON", 0, XTYPE_XBOX }, | |
126 | { 0x0738, 0x4526, "Mad Catz Control Pad Pro", 0, XTYPE_XBOX }, | |
127 | { 0x0738, 0x4536, "Mad Catz MicroCON", 0, XTYPE_XBOX }, | |
c7d9f7eb | 128 | { 0x0738, 0x4540, "Mad Catz Beat Pad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX }, |
b45d44e7 NL |
129 | { 0x0738, 0x4556, "Mad Catz Lynx Wireless Controller", 0, XTYPE_XBOX }, |
130 | { 0x0738, 0x4716, "Mad Catz Wired Xbox 360 Controller", 0, XTYPE_XBOX360 }, | |
131 | { 0x0738, 0x4738, "Mad Catz Wired Xbox 360 Controller (SFIV)", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 }, | |
c7d9f7eb | 132 | { 0x0738, 0x6040, "Mad Catz Beat Pad Pro", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX }, |
b45d44e7 NL |
133 | { 0x0c12, 0x8802, "Zeroplus Xbox Controller", 0, XTYPE_XBOX }, |
134 | { 0x0c12, 0x880a, "Pelican Eclipse PL-2023", 0, XTYPE_XBOX }, | |
135 | { 0x0c12, 0x8810, "Zeroplus Xbox Controller", 0, XTYPE_XBOX }, | |
136 | { 0x0c12, 0x9902, "HAMA VibraX - *FAULTY HARDWARE*", 0, XTYPE_XBOX }, | |
137 | { 0x0e4c, 0x1097, "Radica Gamester Controller", 0, XTYPE_XBOX }, | |
138 | { 0x0e4c, 0x2390, "Radica Games Jtech Controller", 0, XTYPE_XBOX }, | |
139 | { 0x0e6f, 0x0003, "Logic3 Freebird wireless Controller", 0, XTYPE_XBOX }, | |
140 | { 0x0e6f, 0x0005, "Eclipse wireless Controller", 0, XTYPE_XBOX }, | |
141 | { 0x0e6f, 0x0006, "Edge wireless Controller", 0, XTYPE_XBOX }, | |
142 | { 0x0e6f, 0x0006, "Pelican 'TSZ' Wired Xbox 360 Controller", 0, XTYPE_XBOX360 }, | |
143 | { 0x0e8f, 0x0201, "SmartJoy Frag Xpad/PS2 adaptor", 0, XTYPE_XBOX }, | |
144 | { 0x0f30, 0x0202, "Joytech Advanced Controller", 0, XTYPE_XBOX }, | |
145 | { 0x0f30, 0x8888, "BigBen XBMiniPad Controller", 0, XTYPE_XBOX }, | |
146 | { 0x102c, 0xff0c, "Joytech Wireless Advanced Controller", 0, XTYPE_XBOX }, | |
c7d9f7eb | 147 | { 0x12ab, 0x8809, "Xbox DDR dancepad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX }, |
b45d44e7 | 148 | { 0x1430, 0x4748, "RedOctane Guitar Hero X-plorer", 0, XTYPE_XBOX360 }, |
c7d9f7eb | 149 | { 0x1430, 0x8888, "TX6500+ Dance Pad (first generation)", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX }, |
b45d44e7 NL |
150 | { 0x146b, 0x0601, "BigBen Interactive XBOX 360 Controller", 0, XTYPE_XBOX360 }, |
151 | { 0x045e, 0x028e, "Microsoft X-Box 360 pad", 0, XTYPE_XBOX360 }, | |
805423e8 | 152 | { 0x1bad, 0x0003, "Harmonix Rock Band Drumkit", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX360 }, |
b45d44e7 NL |
153 | { 0x0f0d, 0x0016, "Hori Real Arcade Pro.EX", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 }, |
154 | { 0xffff, 0xffff, "Chinese-made Xbox Controller", 0, XTYPE_XBOX }, | |
155 | { 0x0000, 0x0000, "Generic X-Box pad", 0, XTYPE_UNKNOWN } | |
1da177e4 LT |
156 | }; |
157 | ||
fc55e952 AH |
158 | /* buttons shared with xbox and xbox360 */ |
159 | static const signed short xpad_common_btn[] = { | |
160 | BTN_A, BTN_B, BTN_X, BTN_Y, /* "analog" buttons */ | |
1da177e4 LT |
161 | BTN_START, BTN_BACK, BTN_THUMBL, BTN_THUMBR, /* start/back/sticks */ |
162 | -1 /* terminating entry */ | |
163 | }; | |
164 | ||
fc55e952 AH |
165 | /* original xbox controllers only */ |
166 | static const signed short xpad_btn[] = { | |
167 | BTN_C, BTN_Z, /* "analog" buttons */ | |
168 | -1 /* terminating entry */ | |
169 | }; | |
170 | ||
b45d44e7 | 171 | /* used when dpad is mapped to nuttons */ |
deb8ee43 DC |
172 | static const signed short xpad_btn_pad[] = { |
173 | BTN_LEFT, BTN_RIGHT, /* d-pad left, right */ | |
174 | BTN_0, BTN_1, /* d-pad up, down (XXX names??) */ | |
175 | -1 /* terminating entry */ | |
176 | }; | |
177 | ||
b45d44e7 NL |
178 | /* used when triggers are mapped to buttons */ |
179 | static const signed short xpad_btn_triggers[] = { | |
180 | BTN_TL2, BTN_TR2, /* triggers left/right */ | |
181 | -1 | |
182 | }; | |
183 | ||
184 | ||
c7d9f7eb JK |
185 | static const signed short xpad360_btn[] = { /* buttons for x360 controller */ |
186 | BTN_TL, BTN_TR, /* Button LB/RB */ | |
187 | BTN_MODE, /* The big X button */ | |
188 | -1 | |
189 | }; | |
190 | ||
4c4c9432 | 191 | static const signed short xpad_abs[] = { |
1da177e4 LT |
192 | ABS_X, ABS_Y, /* left stick */ |
193 | ABS_RX, ABS_RY, /* right stick */ | |
deb8ee43 DC |
194 | -1 /* terminating entry */ |
195 | }; | |
196 | ||
b45d44e7 | 197 | /* used when dpad is mapped to axes */ |
deb8ee43 DC |
198 | static const signed short xpad_abs_pad[] = { |
199 | ABS_HAT0X, ABS_HAT0Y, /* d-pad axes */ | |
1da177e4 LT |
200 | -1 /* terminating entry */ |
201 | }; | |
202 | ||
b45d44e7 NL |
203 | /* used when triggers are mapped to axes */ |
204 | static const signed short xpad_abs_triggers[] = { | |
205 | ABS_Z, ABS_RZ, /* triggers left/right */ | |
206 | -1 | |
207 | }; | |
208 | ||
8a0f83ea AH |
209 | /* Xbox 360 has a vendor-specific class, so we cannot match it with only |
210 | * USB_INTERFACE_INFO (also specifically refused by USB subsystem), so we | |
99de0912 BM |
211 | * match against vendor id as well. Wired Xbox 360 devices have protocol 1, |
212 | * wireless controllers have protocol 129. */ | |
213 | #define XPAD_XBOX360_VENDOR_PROTOCOL(vend,pr) \ | |
8a0f83ea AH |
214 | .match_flags = USB_DEVICE_ID_MATCH_VENDOR | USB_DEVICE_ID_MATCH_INT_INFO, \ |
215 | .idVendor = (vend), \ | |
216 | .bInterfaceClass = USB_CLASS_VENDOR_SPEC, \ | |
217 | .bInterfaceSubClass = 93, \ | |
99de0912 BM |
218 | .bInterfaceProtocol = (pr) |
219 | #define XPAD_XBOX360_VENDOR(vend) \ | |
220 | { XPAD_XBOX360_VENDOR_PROTOCOL(vend,1) }, \ | |
221 | { XPAD_XBOX360_VENDOR_PROTOCOL(vend,129) } | |
8a0f83ea | 222 | |
1da177e4 LT |
223 | static struct usb_device_id xpad_table [] = { |
224 | { USB_INTERFACE_INFO('X', 'B', 0) }, /* X-Box USB-IF not approved class */ | |
99de0912 BM |
225 | XPAD_XBOX360_VENDOR(0x045e), /* Microsoft X-Box 360 controllers */ |
226 | XPAD_XBOX360_VENDOR(0x046d), /* Logitech X-Box 360 style controllers */ | |
227 | XPAD_XBOX360_VENDOR(0x0738), /* Mad Catz X-Box 360 controllers */ | |
228 | XPAD_XBOX360_VENDOR(0x0e6f), /* 0x0e6f X-Box 360 controllers */ | |
229 | XPAD_XBOX360_VENDOR(0x1430), /* RedOctane X-Box 360 controllers */ | |
3ac91d36 | 230 | XPAD_XBOX360_VENDOR(0x146b), /* BigBen Interactive Controllers */ |
805423e8 | 231 | XPAD_XBOX360_VENDOR(0x1bad), /* Rock Band Drums */ |
dadaae37 | 232 | XPAD_XBOX360_VENDOR(0x0f0d), /* Hori Controllers */ |
1da177e4 LT |
233 | { } |
234 | }; | |
235 | ||
236 | MODULE_DEVICE_TABLE (usb, xpad_table); | |
237 | ||
238 | struct usb_xpad { | |
deb8ee43 DC |
239 | struct input_dev *dev; /* input device interface */ |
240 | struct usb_device *udev; /* usb device */ | |
05f091ab | 241 | |
99de0912 BM |
242 | int pad_present; |
243 | ||
deb8ee43 DC |
244 | struct urb *irq_in; /* urb for interrupt in report */ |
245 | unsigned char *idata; /* input data */ | |
1da177e4 | 246 | dma_addr_t idata_dma; |
05f091ab | 247 | |
99de0912 BM |
248 | struct urb *bulk_out; |
249 | unsigned char *bdata; | |
250 | ||
4994cd8d | 251 | #if defined(CONFIG_JOYSTICK_XPAD_FF) || defined(CONFIG_JOYSTICK_XPAD_LEDS) |
e01a06e8 JK |
252 | struct urb *irq_out; /* urb for interrupt out report */ |
253 | unsigned char *odata; /* output data */ | |
254 | dma_addr_t odata_dma; | |
4994cd8d JK |
255 | struct mutex odata_mutex; |
256 | #endif | |
257 | ||
258 | #if defined(CONFIG_JOYSTICK_XPAD_LEDS) | |
259 | struct xpad_led *led; | |
e01a06e8 JK |
260 | #endif |
261 | ||
4994cd8d | 262 | char phys[64]; /* physical device path */ |
deb8ee43 | 263 | |
b45d44e7 | 264 | int mapping; /* map d-pad to buttons or to axes */ |
c7d9f7eb | 265 | int xtype; /* type of xbox device */ |
1da177e4 LT |
266 | }; |
267 | ||
268 | /* | |
269 | * xpad_process_packet | |
270 | * | |
271 | * Completes a request by converting the data into events for the | |
272 | * input subsystem. | |
273 | * | |
274 | * The used report descriptor was taken from ITO Takayukis website: | |
275 | * http://euc.jp/periphs/xbox-controller.ja.html | |
276 | */ | |
277 | ||
7d12e780 | 278 | static void xpad_process_packet(struct usb_xpad *xpad, u16 cmd, unsigned char *data) |
1da177e4 | 279 | { |
c5b7c7c3 | 280 | struct input_dev *dev = xpad->dev; |
1da177e4 | 281 | |
1da177e4 | 282 | /* left stick */ |
20b3cdd6 DT |
283 | input_report_abs(dev, ABS_X, |
284 | (__s16) le16_to_cpup((__le16 *)(data + 12))); | |
285 | input_report_abs(dev, ABS_Y, | |
97f09cb5 | 286 | ~(__s16) le16_to_cpup((__le16 *)(data + 14))); |
05f091ab | 287 | |
1da177e4 | 288 | /* right stick */ |
20b3cdd6 DT |
289 | input_report_abs(dev, ABS_RX, |
290 | (__s16) le16_to_cpup((__le16 *)(data + 16))); | |
291 | input_report_abs(dev, ABS_RY, | |
97f09cb5 | 292 | ~(__s16) le16_to_cpup((__le16 *)(data + 18))); |
05f091ab | 293 | |
1da177e4 | 294 | /* triggers left/right */ |
b45d44e7 NL |
295 | if (xpad->mapping & MAP_TRIGGERS_TO_BUTTONS) { |
296 | input_report_key(dev, BTN_TL2, data[10]); | |
297 | input_report_key(dev, BTN_TR2, data[11]); | |
298 | } else { | |
299 | input_report_abs(dev, ABS_Z, data[10]); | |
300 | input_report_abs(dev, ABS_RZ, data[11]); | |
301 | } | |
05f091ab | 302 | |
1da177e4 | 303 | /* digital pad */ |
b45d44e7 | 304 | if (xpad->mapping & MAP_DPAD_TO_BUTTONS) { |
deb8ee43 DC |
305 | input_report_key(dev, BTN_LEFT, data[2] & 0x04); |
306 | input_report_key(dev, BTN_RIGHT, data[2] & 0x08); | |
ae91d10a DT |
307 | input_report_key(dev, BTN_0, data[2] & 0x01); /* up */ |
308 | input_report_key(dev, BTN_1, data[2] & 0x02); /* down */ | |
b45d44e7 NL |
309 | } else { |
310 | input_report_abs(dev, ABS_HAT0X, | |
311 | !!(data[2] & 0x08) - !!(data[2] & 0x04)); | |
312 | input_report_abs(dev, ABS_HAT0Y, | |
313 | !!(data[2] & 0x02) - !!(data[2] & 0x01)); | |
deb8ee43 | 314 | } |
05f091ab | 315 | |
1da177e4 | 316 | /* start/back buttons and stick press left/right */ |
deb8ee43 DC |
317 | input_report_key(dev, BTN_START, data[2] & 0x10); |
318 | input_report_key(dev, BTN_BACK, data[2] & 0x20); | |
319 | input_report_key(dev, BTN_THUMBL, data[2] & 0x40); | |
320 | input_report_key(dev, BTN_THUMBR, data[2] & 0x80); | |
05f091ab | 321 | |
1da177e4 LT |
322 | /* "analog" buttons A, B, X, Y */ |
323 | input_report_key(dev, BTN_A, data[4]); | |
324 | input_report_key(dev, BTN_B, data[5]); | |
325 | input_report_key(dev, BTN_X, data[6]); | |
326 | input_report_key(dev, BTN_Y, data[7]); | |
05f091ab | 327 | |
1da177e4 LT |
328 | /* "analog" buttons black, white */ |
329 | input_report_key(dev, BTN_C, data[8]); | |
330 | input_report_key(dev, BTN_Z, data[9]); | |
331 | ||
332 | input_sync(dev); | |
333 | } | |
334 | ||
c7d9f7eb JK |
335 | /* |
336 | * xpad360_process_packet | |
337 | * | |
338 | * Completes a request by converting the data into events for the | |
339 | * input subsystem. It is version for xbox 360 controller | |
340 | * | |
341 | * The used report descriptor was taken from: | |
342 | * http://www.free60.org/wiki/Gamepad | |
343 | */ | |
344 | ||
20b3cdd6 DT |
345 | static void xpad360_process_packet(struct usb_xpad *xpad, |
346 | u16 cmd, unsigned char *data) | |
c7d9f7eb JK |
347 | { |
348 | struct input_dev *dev = xpad->dev; | |
349 | ||
350 | /* digital pad */ | |
b45d44e7 | 351 | if (xpad->mapping & MAP_DPAD_TO_BUTTONS) { |
c7d9f7eb | 352 | /* dpad as buttons (right, left, down, up) */ |
ae91d10a DT |
353 | input_report_key(dev, BTN_LEFT, data[2] & 0x04); |
354 | input_report_key(dev, BTN_RIGHT, data[2] & 0x08); | |
355 | input_report_key(dev, BTN_0, data[2] & 0x01); /* up */ | |
356 | input_report_key(dev, BTN_1, data[2] & 0x02); /* down */ | |
b45d44e7 NL |
357 | } else { |
358 | input_report_abs(dev, ABS_HAT0X, | |
359 | !!(data[2] & 0x08) - !!(data[2] & 0x04)); | |
360 | input_report_abs(dev, ABS_HAT0Y, | |
361 | !!(data[2] & 0x02) - !!(data[2] & 0x01)); | |
c7d9f7eb JK |
362 | } |
363 | ||
364 | /* start/back buttons */ | |
ae91d10a DT |
365 | input_report_key(dev, BTN_START, data[2] & 0x10); |
366 | input_report_key(dev, BTN_BACK, data[2] & 0x20); | |
c7d9f7eb JK |
367 | |
368 | /* stick press left/right */ | |
369 | input_report_key(dev, BTN_THUMBL, data[2] & 0x40); | |
370 | input_report_key(dev, BTN_THUMBR, data[2] & 0x80); | |
371 | ||
372 | /* buttons A,B,X,Y,TL,TR and MODE */ | |
ae91d10a DT |
373 | input_report_key(dev, BTN_A, data[3] & 0x10); |
374 | input_report_key(dev, BTN_B, data[3] & 0x20); | |
375 | input_report_key(dev, BTN_X, data[3] & 0x40); | |
376 | input_report_key(dev, BTN_Y, data[3] & 0x80); | |
377 | input_report_key(dev, BTN_TL, data[3] & 0x01); | |
378 | input_report_key(dev, BTN_TR, data[3] & 0x02); | |
379 | input_report_key(dev, BTN_MODE, data[3] & 0x04); | |
c7d9f7eb JK |
380 | |
381 | /* left stick */ | |
20b3cdd6 DT |
382 | input_report_abs(dev, ABS_X, |
383 | (__s16) le16_to_cpup((__le16 *)(data + 6))); | |
384 | input_report_abs(dev, ABS_Y, | |
97f09cb5 | 385 | ~(__s16) le16_to_cpup((__le16 *)(data + 8))); |
c7d9f7eb JK |
386 | |
387 | /* right stick */ | |
20b3cdd6 DT |
388 | input_report_abs(dev, ABS_RX, |
389 | (__s16) le16_to_cpup((__le16 *)(data + 10))); | |
390 | input_report_abs(dev, ABS_RY, | |
97f09cb5 | 391 | ~(__s16) le16_to_cpup((__le16 *)(data + 12))); |
c7d9f7eb JK |
392 | |
393 | /* triggers left/right */ | |
b45d44e7 NL |
394 | if (xpad->mapping & MAP_TRIGGERS_TO_BUTTONS) { |
395 | input_report_key(dev, BTN_TL2, data[4]); | |
396 | input_report_key(dev, BTN_TR2, data[5]); | |
397 | } else { | |
398 | input_report_abs(dev, ABS_Z, data[4]); | |
399 | input_report_abs(dev, ABS_RZ, data[5]); | |
400 | } | |
c7d9f7eb JK |
401 | |
402 | input_sync(dev); | |
403 | } | |
404 | ||
99de0912 BM |
405 | /* |
406 | * xpad360w_process_packet | |
407 | * | |
408 | * Completes a request by converting the data into events for the | |
409 | * input subsystem. It is version for xbox 360 wireless controller. | |
410 | * | |
411 | * Byte.Bit | |
412 | * 00.1 - Status change: The controller or headset has connected/disconnected | |
413 | * Bits 01.7 and 01.6 are valid | |
414 | * 01.7 - Controller present | |
415 | * 01.6 - Headset present | |
416 | * 01.1 - Pad state (Bytes 4+) valid | |
417 | * | |
418 | */ | |
419 | ||
420 | static void xpad360w_process_packet(struct usb_xpad *xpad, u16 cmd, unsigned char *data) | |
421 | { | |
422 | /* Presence change */ | |
423 | if (data[0] & 0x08) { | |
424 | if (data[1] & 0x80) { | |
425 | xpad->pad_present = 1; | |
426 | usb_submit_urb(xpad->bulk_out, GFP_ATOMIC); | |
427 | } else | |
428 | xpad->pad_present = 0; | |
429 | } | |
430 | ||
431 | /* Valid pad data */ | |
432 | if (!(data[1] & 0x1)) | |
433 | return; | |
434 | ||
435 | xpad360_process_packet(xpad, cmd, &data[4]); | |
436 | } | |
437 | ||
7d12e780 | 438 | static void xpad_irq_in(struct urb *urb) |
1da177e4 LT |
439 | { |
440 | struct usb_xpad *xpad = urb->context; | |
6fc88f53 | 441 | int retval, status; |
05f091ab | 442 | |
6fc88f53 ON |
443 | status = urb->status; |
444 | ||
445 | switch (status) { | |
1da177e4 LT |
446 | case 0: |
447 | /* success */ | |
448 | break; | |
449 | case -ECONNRESET: | |
450 | case -ENOENT: | |
451 | case -ESHUTDOWN: | |
452 | /* this urb is terminated, clean up */ | |
20b3cdd6 | 453 | dbg("%s - urb shutting down with status: %d", |
ea3e6c59 | 454 | __func__, status); |
1da177e4 LT |
455 | return; |
456 | default: | |
20b3cdd6 | 457 | dbg("%s - nonzero urb status received: %d", |
ea3e6c59 | 458 | __func__, status); |
1da177e4 LT |
459 | goto exit; |
460 | } | |
05f091ab | 461 | |
99de0912 BM |
462 | switch (xpad->xtype) { |
463 | case XTYPE_XBOX360: | |
c7d9f7eb | 464 | xpad360_process_packet(xpad, 0, xpad->idata); |
99de0912 BM |
465 | break; |
466 | case XTYPE_XBOX360W: | |
467 | xpad360w_process_packet(xpad, 0, xpad->idata); | |
468 | break; | |
469 | default: | |
c7d9f7eb | 470 | xpad_process_packet(xpad, 0, xpad->idata); |
99de0912 | 471 | } |
1da177e4 LT |
472 | |
473 | exit: | |
dd38d688 | 474 | retval = usb_submit_urb(urb, GFP_ATOMIC); |
1da177e4 LT |
475 | if (retval) |
476 | err ("%s - usb_submit_urb failed with result %d", | |
ea3e6c59 | 477 | __func__, retval); |
1da177e4 LT |
478 | } |
479 | ||
20430214 DT |
480 | static void xpad_bulk_out(struct urb *urb) |
481 | { | |
482 | switch (urb->status) { | |
483 | case 0: | |
484 | /* success */ | |
485 | break; | |
486 | case -ECONNRESET: | |
487 | case -ENOENT: | |
488 | case -ESHUTDOWN: | |
489 | /* this urb is terminated, clean up */ | |
80a914dc | 490 | dbg("%s - urb shutting down with status: %d", __func__, urb->status); |
20430214 DT |
491 | break; |
492 | default: | |
80a914dc | 493 | dbg("%s - nonzero urb status received: %d", __func__, urb->status); |
20430214 DT |
494 | } |
495 | } | |
496 | ||
4994cd8d | 497 | #if defined(CONFIG_JOYSTICK_XPAD_FF) || defined(CONFIG_JOYSTICK_XPAD_LEDS) |
e01a06e8 JK |
498 | static void xpad_irq_out(struct urb *urb) |
499 | { | |
6fc88f53 ON |
500 | int retval, status; |
501 | ||
502 | status = urb->status; | |
e01a06e8 | 503 | |
6fc88f53 | 504 | switch (status) { |
70a6f2e6 | 505 | case 0: |
e01a06e8 | 506 | /* success */ |
70a6f2e6 MG |
507 | return; |
508 | ||
509 | case -ECONNRESET: | |
510 | case -ENOENT: | |
511 | case -ESHUTDOWN: | |
512 | /* this urb is terminated, clean up */ | |
513 | dbg("%s - urb shutting down with status: %d", __func__, status); | |
514 | return; | |
515 | ||
516 | default: | |
517 | dbg("%s - nonzero urb status received: %d", __func__, status); | |
518 | goto exit; | |
e01a06e8 JK |
519 | } |
520 | ||
521 | exit: | |
522 | retval = usb_submit_urb(urb, GFP_ATOMIC); | |
523 | if (retval) | |
524 | err("%s - usb_submit_urb failed with result %d", | |
ea3e6c59 | 525 | __func__, retval); |
e01a06e8 JK |
526 | } |
527 | ||
4994cd8d | 528 | static int xpad_init_output(struct usb_interface *intf, struct usb_xpad *xpad) |
e01a06e8 JK |
529 | { |
530 | struct usb_endpoint_descriptor *ep_irq_out; | |
531 | int error = -ENOMEM; | |
532 | ||
533 | if (xpad->xtype != XTYPE_XBOX360) | |
534 | return 0; | |
535 | ||
536 | xpad->odata = usb_buffer_alloc(xpad->udev, XPAD_PKT_LEN, | |
6eae9b0a | 537 | GFP_KERNEL, &xpad->odata_dma); |
2e8335a6 | 538 | if (!xpad->odata) |
e01a06e8 JK |
539 | goto fail1; |
540 | ||
4994cd8d JK |
541 | mutex_init(&xpad->odata_mutex); |
542 | ||
e01a06e8 JK |
543 | xpad->irq_out = usb_alloc_urb(0, GFP_KERNEL); |
544 | if (!xpad->irq_out) | |
545 | goto fail2; | |
546 | ||
547 | ep_irq_out = &intf->cur_altsetting->endpoint[1].desc; | |
548 | usb_fill_int_urb(xpad->irq_out, xpad->udev, | |
549 | usb_sndintpipe(xpad->udev, ep_irq_out->bEndpointAddress), | |
550 | xpad->odata, XPAD_PKT_LEN, | |
551 | xpad_irq_out, xpad, ep_irq_out->bInterval); | |
552 | xpad->irq_out->transfer_dma = xpad->odata_dma; | |
553 | xpad->irq_out->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | |
554 | ||
e01a06e8 JK |
555 | return 0; |
556 | ||
557 | fail2: usb_buffer_free(xpad->udev, XPAD_PKT_LEN, xpad->odata, xpad->odata_dma); | |
558 | fail1: return error; | |
559 | } | |
560 | ||
4994cd8d | 561 | static void xpad_stop_output(struct usb_xpad *xpad) |
e01a06e8 JK |
562 | { |
563 | if (xpad->xtype == XTYPE_XBOX360) | |
564 | usb_kill_urb(xpad->irq_out); | |
565 | } | |
566 | ||
4994cd8d | 567 | static void xpad_deinit_output(struct usb_xpad *xpad) |
e01a06e8 JK |
568 | { |
569 | if (xpad->xtype == XTYPE_XBOX360) { | |
570 | usb_free_urb(xpad->irq_out); | |
571 | usb_buffer_free(xpad->udev, XPAD_PKT_LEN, | |
572 | xpad->odata, xpad->odata_dma); | |
573 | } | |
574 | } | |
4994cd8d JK |
575 | #else |
576 | static int xpad_init_output(struct usb_interface *intf, struct usb_xpad *xpad) { return 0; } | |
577 | static void xpad_deinit_output(struct usb_xpad *xpad) {} | |
578 | static void xpad_stop_output(struct usb_xpad *xpad) {} | |
579 | #endif | |
580 | ||
581 | #ifdef CONFIG_JOYSTICK_XPAD_FF | |
582 | static int xpad_play_effect(struct input_dev *dev, void *data, | |
583 | struct ff_effect *effect) | |
584 | { | |
585 | struct usb_xpad *xpad = input_get_drvdata(dev); | |
e01a06e8 | 586 | |
4994cd8d JK |
587 | if (effect->type == FF_RUMBLE) { |
588 | __u16 strong = effect->u.rumble.strong_magnitude; | |
589 | __u16 weak = effect->u.rumble.weak_magnitude; | |
590 | xpad->odata[0] = 0x00; | |
591 | xpad->odata[1] = 0x08; | |
592 | xpad->odata[2] = 0x00; | |
593 | xpad->odata[3] = strong / 256; | |
594 | xpad->odata[4] = weak / 256; | |
595 | xpad->odata[5] = 0x00; | |
596 | xpad->odata[6] = 0x00; | |
597 | xpad->odata[7] = 0x00; | |
04021e4e | 598 | xpad->irq_out->transfer_buffer_length = 8; |
dd38d688 | 599 | usb_submit_urb(xpad->irq_out, GFP_ATOMIC); |
4994cd8d JK |
600 | } |
601 | ||
602 | return 0; | |
603 | } | |
604 | ||
605 | static int xpad_init_ff(struct usb_xpad *xpad) | |
606 | { | |
cfbe2010 AH |
607 | if (xpad->xtype != XTYPE_XBOX360) |
608 | return 0; | |
609 | ||
4994cd8d JK |
610 | input_set_capability(xpad->dev, EV_FF, FF_RUMBLE); |
611 | ||
612 | return input_ff_create_memless(xpad->dev, NULL, xpad_play_effect); | |
613 | } | |
614 | ||
615 | #else | |
616 | static int xpad_init_ff(struct usb_xpad *xpad) { return 0; } | |
617 | #endif | |
618 | ||
619 | #if defined(CONFIG_JOYSTICK_XPAD_LEDS) | |
620 | #include <linux/leds.h> | |
621 | ||
622 | struct xpad_led { | |
623 | char name[16]; | |
624 | struct led_classdev led_cdev; | |
625 | struct usb_xpad *xpad; | |
626 | }; | |
627 | ||
628 | static void xpad_send_led_command(struct usb_xpad *xpad, int command) | |
629 | { | |
630 | if (command >= 0 && command < 14) { | |
631 | mutex_lock(&xpad->odata_mutex); | |
632 | xpad->odata[0] = 0x01; | |
633 | xpad->odata[1] = 0x03; | |
634 | xpad->odata[2] = command; | |
04021e4e | 635 | xpad->irq_out->transfer_buffer_length = 3; |
4994cd8d JK |
636 | usb_submit_urb(xpad->irq_out, GFP_KERNEL); |
637 | mutex_unlock(&xpad->odata_mutex); | |
638 | } | |
639 | } | |
640 | ||
641 | static void xpad_led_set(struct led_classdev *led_cdev, | |
642 | enum led_brightness value) | |
643 | { | |
644 | struct xpad_led *xpad_led = container_of(led_cdev, | |
645 | struct xpad_led, led_cdev); | |
646 | ||
647 | xpad_send_led_command(xpad_led->xpad, value); | |
648 | } | |
649 | ||
650 | static int xpad_led_probe(struct usb_xpad *xpad) | |
651 | { | |
652 | static atomic_t led_seq = ATOMIC_INIT(0); | |
653 | long led_no; | |
654 | struct xpad_led *led; | |
655 | struct led_classdev *led_cdev; | |
656 | int error; | |
657 | ||
658 | if (xpad->xtype != XTYPE_XBOX360) | |
659 | return 0; | |
660 | ||
661 | xpad->led = led = kzalloc(sizeof(struct xpad_led), GFP_KERNEL); | |
662 | if (!led) | |
663 | return -ENOMEM; | |
664 | ||
665 | led_no = (long)atomic_inc_return(&led_seq) - 1; | |
666 | ||
667 | snprintf(led->name, sizeof(led->name), "xpad%ld", led_no); | |
668 | led->xpad = xpad; | |
669 | ||
670 | led_cdev = &led->led_cdev; | |
671 | led_cdev->name = led->name; | |
672 | led_cdev->brightness_set = xpad_led_set; | |
673 | ||
674 | error = led_classdev_register(&xpad->udev->dev, led_cdev); | |
675 | if (error) { | |
676 | kfree(led); | |
677 | xpad->led = NULL; | |
678 | return error; | |
679 | } | |
680 | ||
681 | /* | |
682 | * Light up the segment corresponding to controller number | |
683 | */ | |
684 | xpad_send_led_command(xpad, (led_no % 4) + 2); | |
685 | ||
686 | return 0; | |
687 | } | |
688 | ||
689 | static void xpad_led_disconnect(struct usb_xpad *xpad) | |
690 | { | |
691 | struct xpad_led *xpad_led = xpad->led; | |
692 | ||
693 | if (xpad_led) { | |
694 | led_classdev_unregister(&xpad_led->led_cdev); | |
695 | kfree(xpad_led->name); | |
696 | } | |
697 | } | |
e01a06e8 | 698 | #else |
4994cd8d JK |
699 | static int xpad_led_probe(struct usb_xpad *xpad) { return 0; } |
700 | static void xpad_led_disconnect(struct usb_xpad *xpad) { } | |
e01a06e8 JK |
701 | #endif |
702 | ||
4994cd8d | 703 | |
e01a06e8 | 704 | static int xpad_open(struct input_dev *dev) |
1da177e4 | 705 | { |
7791bdae | 706 | struct usb_xpad *xpad = input_get_drvdata(dev); |
05f091ab | 707 | |
99de0912 BM |
708 | /* URB was submitted in probe */ |
709 | if(xpad->xtype == XTYPE_XBOX360W) | |
710 | return 0; | |
711 | ||
1da177e4 | 712 | xpad->irq_in->dev = xpad->udev; |
65cde54b | 713 | if (usb_submit_urb(xpad->irq_in, GFP_KERNEL)) |
1da177e4 | 714 | return -EIO; |
05f091ab | 715 | |
1da177e4 LT |
716 | return 0; |
717 | } | |
718 | ||
e01a06e8 | 719 | static void xpad_close(struct input_dev *dev) |
1da177e4 | 720 | { |
7791bdae | 721 | struct usb_xpad *xpad = input_get_drvdata(dev); |
05f091ab | 722 | |
99de0912 BM |
723 | if(xpad->xtype != XTYPE_XBOX360W) |
724 | usb_kill_urb(xpad->irq_in); | |
4994cd8d | 725 | xpad_stop_output(xpad); |
1da177e4 LT |
726 | } |
727 | ||
deb8ee43 DC |
728 | static void xpad_set_up_abs(struct input_dev *input_dev, signed short abs) |
729 | { | |
730 | set_bit(abs, input_dev->absbit); | |
731 | ||
732 | switch (abs) { | |
733 | case ABS_X: | |
734 | case ABS_Y: | |
735 | case ABS_RX: | |
736 | case ABS_RY: /* the two sticks */ | |
737 | input_set_abs_params(input_dev, abs, -32768, 32767, 16, 128); | |
738 | break; | |
739 | case ABS_Z: | |
b45d44e7 | 740 | case ABS_RZ: /* the triggers (if mapped to axes) */ |
deb8ee43 DC |
741 | input_set_abs_params(input_dev, abs, 0, 255, 0, 0); |
742 | break; | |
743 | case ABS_HAT0X: | |
b45d44e7 | 744 | case ABS_HAT0Y: /* the d-pad (only if dpad is mapped to axes */ |
deb8ee43 DC |
745 | input_set_abs_params(input_dev, abs, -1, 1, 0, 0); |
746 | break; | |
747 | } | |
748 | } | |
749 | ||
1da177e4 LT |
750 | static int xpad_probe(struct usb_interface *intf, const struct usb_device_id *id) |
751 | { | |
20b3cdd6 | 752 | struct usb_device *udev = interface_to_usbdev(intf); |
c5b7c7c3 DT |
753 | struct usb_xpad *xpad; |
754 | struct input_dev *input_dev; | |
1da177e4 | 755 | struct usb_endpoint_descriptor *ep_irq_in; |
1da177e4 | 756 | int i; |
5014186d | 757 | int error = -ENOMEM; |
05f091ab | 758 | |
1da177e4 LT |
759 | for (i = 0; xpad_device[i].idVendor; i++) { |
760 | if ((le16_to_cpu(udev->descriptor.idVendor) == xpad_device[i].idVendor) && | |
761 | (le16_to_cpu(udev->descriptor.idProduct) == xpad_device[i].idProduct)) | |
762 | break; | |
763 | } | |
05f091ab | 764 | |
c5b7c7c3 DT |
765 | xpad = kzalloc(sizeof(struct usb_xpad), GFP_KERNEL); |
766 | input_dev = input_allocate_device(); | |
767 | if (!xpad || !input_dev) | |
768 | goto fail1; | |
05f091ab | 769 | |
1da177e4 | 770 | xpad->idata = usb_buffer_alloc(udev, XPAD_PKT_LEN, |
6eae9b0a | 771 | GFP_KERNEL, &xpad->idata_dma); |
c5b7c7c3 DT |
772 | if (!xpad->idata) |
773 | goto fail1; | |
1da177e4 LT |
774 | |
775 | xpad->irq_in = usb_alloc_urb(0, GFP_KERNEL); | |
c5b7c7c3 DT |
776 | if (!xpad->irq_in) |
777 | goto fail2; | |
05f091ab | 778 | |
1da177e4 | 779 | xpad->udev = udev; |
b45d44e7 | 780 | xpad->mapping = xpad_device[i].mapping; |
c7d9f7eb | 781 | xpad->xtype = xpad_device[i].xtype; |
b45d44e7 | 782 | |
99de0912 BM |
783 | if (xpad->xtype == XTYPE_UNKNOWN) { |
784 | if (intf->cur_altsetting->desc.bInterfaceClass == USB_CLASS_VENDOR_SPEC) { | |
785 | if (intf->cur_altsetting->desc.bInterfaceProtocol == 129) | |
786 | xpad->xtype = XTYPE_XBOX360W; | |
787 | else | |
788 | xpad->xtype = XTYPE_XBOX360; | |
789 | } else | |
790 | xpad->xtype = XTYPE_XBOX; | |
b45d44e7 NL |
791 | |
792 | if (dpad_to_buttons) | |
793 | xpad->mapping |= MAP_DPAD_TO_BUTTONS; | |
794 | if (triggers_to_buttons) | |
795 | xpad->mapping |= MAP_TRIGGERS_TO_BUTTONS; | |
99de0912 | 796 | } |
b45d44e7 | 797 | |
c5b7c7c3 DT |
798 | xpad->dev = input_dev; |
799 | usb_make_path(udev, xpad->phys, sizeof(xpad->phys)); | |
800 | strlcat(xpad->phys, "/input0", sizeof(xpad->phys)); | |
05f091ab | 801 | |
c5b7c7c3 DT |
802 | input_dev->name = xpad_device[i].name; |
803 | input_dev->phys = xpad->phys; | |
804 | usb_to_input_id(udev, &input_dev->id); | |
c0f82d57 | 805 | input_dev->dev.parent = &intf->dev; |
7791bdae DT |
806 | |
807 | input_set_drvdata(input_dev, xpad); | |
808 | ||
c5b7c7c3 DT |
809 | input_dev->open = xpad_open; |
810 | input_dev->close = xpad_close; | |
05f091ab | 811 | |
7b19ada2 | 812 | input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS); |
05f091ab | 813 | |
b45d44e7 | 814 | /* set up standard buttons and axes */ |
fc55e952 | 815 | for (i = 0; xpad_common_btn[i] >= 0; i++) |
b45d44e7 | 816 | __set_bit(xpad_common_btn[i], input_dev->keybit); |
05f091ab | 817 | |
deb8ee43 DC |
818 | for (i = 0; xpad_abs[i] >= 0; i++) |
819 | xpad_set_up_abs(input_dev, xpad_abs[i]); | |
b45d44e7 NL |
820 | |
821 | /* Now set up model-specific ones */ | |
822 | if (xpad->xtype == XTYPE_XBOX360 || xpad->xtype == XTYPE_XBOX360W) { | |
823 | for (i = 0; xpad360_btn[i] >= 0; i++) | |
824 | __set_bit(xpad360_btn[i], input_dev->keybit); | |
825 | } else { | |
826 | for (i = 0; xpad_btn[i] >= 0; i++) | |
827 | __set_bit(xpad_btn[i], input_dev->keybit); | |
828 | } | |
829 | ||
830 | if (xpad->mapping & MAP_DPAD_TO_BUTTONS) { | |
831 | for (i = 0; xpad_btn_pad[i] >= 0; i++) | |
832 | __set_bit(xpad_btn_pad[i], input_dev->keybit); | |
833 | } else { | |
deb8ee43 DC |
834 | for (i = 0; xpad_abs_pad[i] >= 0; i++) |
835 | xpad_set_up_abs(input_dev, xpad_abs_pad[i]); | |
b45d44e7 NL |
836 | } |
837 | ||
838 | if (xpad->mapping & MAP_TRIGGERS_TO_BUTTONS) { | |
839 | for (i = 0; xpad_btn_triggers[i] >= 0; i++) | |
840 | __set_bit(xpad_btn_triggers[i], input_dev->keybit); | |
841 | } else { | |
842 | for (i = 0; xpad_abs_triggers[i] >= 0; i++) | |
843 | xpad_set_up_abs(input_dev, xpad_abs_triggers[i]); | |
844 | } | |
05f091ab | 845 | |
4994cd8d | 846 | error = xpad_init_output(intf, xpad); |
e01a06e8 JK |
847 | if (error) |
848 | goto fail2; | |
849 | ||
4994cd8d JK |
850 | error = xpad_init_ff(xpad); |
851 | if (error) | |
852 | goto fail3; | |
853 | ||
854 | error = xpad_led_probe(xpad); | |
855 | if (error) | |
856 | goto fail3; | |
857 | ||
c5b7c7c3 DT |
858 | ep_irq_in = &intf->cur_altsetting->endpoint[0].desc; |
859 | usb_fill_int_urb(xpad->irq_in, udev, | |
860 | usb_rcvintpipe(udev, ep_irq_in->bEndpointAddress), | |
861 | xpad->idata, XPAD_PKT_LEN, xpad_irq_in, | |
862 | xpad, ep_irq_in->bInterval); | |
863 | xpad->irq_in->transfer_dma = xpad->idata_dma; | |
864 | xpad->irq_in->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; | |
05f091ab | 865 | |
5014186d DT |
866 | error = input_register_device(xpad->dev); |
867 | if (error) | |
4994cd8d | 868 | goto fail4; |
05f091ab | 869 | |
1da177e4 | 870 | usb_set_intfdata(intf, xpad); |
99de0912 BM |
871 | |
872 | /* | |
873 | * Submit the int URB immediatly rather than waiting for open | |
874 | * because we get status messages from the device whether | |
875 | * or not any controllers are attached. In fact, it's | |
876 | * exactly the message that a controller has arrived that | |
877 | * we're waiting for. | |
878 | */ | |
879 | if (xpad->xtype == XTYPE_XBOX360W) { | |
880 | xpad->irq_in->dev = xpad->udev; | |
881 | error = usb_submit_urb(xpad->irq_in, GFP_KERNEL); | |
882 | if (error) | |
883 | goto fail4; | |
884 | ||
885 | /* | |
886 | * Setup the message to set the LEDs on the | |
887 | * controller when it shows up | |
888 | */ | |
889 | xpad->bulk_out = usb_alloc_urb(0, GFP_KERNEL); | |
890 | if(!xpad->bulk_out) | |
891 | goto fail5; | |
892 | ||
893 | xpad->bdata = kzalloc(XPAD_PKT_LEN, GFP_KERNEL); | |
894 | if(!xpad->bdata) | |
895 | goto fail6; | |
896 | ||
897 | xpad->bdata[2] = 0x08; | |
898 | switch (intf->cur_altsetting->desc.bInterfaceNumber) { | |
899 | case 0: | |
900 | xpad->bdata[3] = 0x42; | |
901 | break; | |
902 | case 2: | |
903 | xpad->bdata[3] = 0x43; | |
904 | break; | |
905 | case 4: | |
906 | xpad->bdata[3] = 0x44; | |
907 | break; | |
908 | case 6: | |
909 | xpad->bdata[3] = 0x45; | |
910 | } | |
911 | ||
912 | ep_irq_in = &intf->cur_altsetting->endpoint[1].desc; | |
913 | usb_fill_bulk_urb(xpad->bulk_out, udev, | |
914 | usb_sndbulkpipe(udev, ep_irq_in->bEndpointAddress), | |
915 | xpad->bdata, XPAD_PKT_LEN, xpad_bulk_out, xpad); | |
916 | } | |
917 | ||
1da177e4 | 918 | return 0; |
c5b7c7c3 | 919 | |
99de0912 BM |
920 | fail6: usb_free_urb(xpad->bulk_out); |
921 | fail5: usb_kill_urb(xpad->irq_in); | |
4994cd8d JK |
922 | fail4: usb_free_urb(xpad->irq_in); |
923 | fail3: xpad_deinit_output(xpad); | |
5014186d DT |
924 | fail2: usb_buffer_free(udev, XPAD_PKT_LEN, xpad->idata, xpad->idata_dma); |
925 | fail1: input_free_device(input_dev); | |
c5b7c7c3 | 926 | kfree(xpad); |
5014186d | 927 | return error; |
c5b7c7c3 | 928 | |
1da177e4 LT |
929 | } |
930 | ||
931 | static void xpad_disconnect(struct usb_interface *intf) | |
932 | { | |
933 | struct usb_xpad *xpad = usb_get_intfdata (intf); | |
05f091ab | 934 | |
1da177e4 LT |
935 | usb_set_intfdata(intf, NULL); |
936 | if (xpad) { | |
4994cd8d | 937 | xpad_led_disconnect(xpad); |
c5b7c7c3 | 938 | input_unregister_device(xpad->dev); |
4994cd8d | 939 | xpad_deinit_output(xpad); |
99de0912 BM |
940 | if (xpad->xtype == XTYPE_XBOX360W) { |
941 | usb_kill_urb(xpad->bulk_out); | |
942 | usb_free_urb(xpad->bulk_out); | |
943 | usb_kill_urb(xpad->irq_in); | |
944 | } | |
1da177e4 | 945 | usb_free_urb(xpad->irq_in); |
e01a06e8 | 946 | usb_buffer_free(xpad->udev, XPAD_PKT_LEN, |
deb8ee43 | 947 | xpad->idata, xpad->idata_dma); |
1da177e4 LT |
948 | kfree(xpad); |
949 | } | |
950 | } | |
951 | ||
952 | static struct usb_driver xpad_driver = { | |
1da177e4 LT |
953 | .name = "xpad", |
954 | .probe = xpad_probe, | |
955 | .disconnect = xpad_disconnect, | |
956 | .id_table = xpad_table, | |
957 | }; | |
958 | ||
959 | static int __init usb_xpad_init(void) | |
960 | { | |
961 | int result = usb_register(&xpad_driver); | |
962 | if (result == 0) | |
899ef6e7 | 963 | printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_DESC "\n"); |
1da177e4 LT |
964 | return result; |
965 | } | |
966 | ||
967 | static void __exit usb_xpad_exit(void) | |
968 | { | |
969 | usb_deregister(&xpad_driver); | |
970 | } | |
971 | ||
972 | module_init(usb_xpad_init); | |
973 | module_exit(usb_xpad_exit); | |
974 | ||
975 | MODULE_AUTHOR(DRIVER_AUTHOR); | |
976 | MODULE_DESCRIPTION(DRIVER_DESC); | |
977 | MODULE_LICENSE("GPL"); |