projects / linux-2.6-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Input: xpad - add Andamiro Pump It Up pad
[linux-2.6-block.git] / drivers / input / joystick / xpad.c
CommitLineData
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>
7beae702 12 * 2010 Christoph Fritz <chf.fritz@googlemail.com>
1da177e4
LT		 13 *
14 * This program is free software; you can redistribute it and/or
15 * modify it under the terms of the GNU General Public License as
16 * published by the Free Software Foundation; either version 2 of
17 * the License, or (at your option) any later version.
18 *
19 * This program is distributed in the hope that it will be useful,
20 * but WITHOUT ANY WARRANTY; without even the implied warranty of
21 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
22 * GNU General Public License for more details.
23 *
24 * You should have received a copy of the GNU General Public License
25 * along with this program; if not, write to the Free Software
26 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
27 *
28 *
29 * This driver is based on:
30 * - information from http://euc.jp/periphs/xbox-controller.ja.html
31 * - the iForce driver drivers/char/joystick/iforce.c
32 * - the skeleton-driver drivers/usb/usb-skeleton.c
c7d9f7eb 33 * - Xbox 360 information http://www.free60.org/wiki/Gamepad
1da177e4
LT		 34 *
35 * Thanks to:
36 * - ITO Takayuki for providing essential xpad information on his website
37 * - Vojtech Pavlik - iforce driver / input subsystem
38 * - Greg Kroah-Hartman - usb-skeleton driver
d518b2b4 39 * - XBOX Linux project - extra USB id's
1da177e4
LT		 40 *
41 * TODO:
deb8ee43 42 * - fine tune axes (especially trigger axes)
1da177e4
LT		 43 * - fix "analog" buttons (reported as digital now)
44 * - get rumble working
deb8ee43 45 * - need USB IDs for other dance pads
1da177e4
LT		 46 *
47 * History:
48 *
49 * 2002-06-27 - 0.0.1 : first version, just said "XBOX HID controller"
50 *
51 * 2002-07-02 - 0.0.2 : basic working version
52 * - all axes and 9 of the 10 buttons work (german InterAct device)
53 * - the black button does not work
54 *
55 * 2002-07-14 - 0.0.3 : rework by Vojtech Pavlik
56 * - indentation fixes
57 * - usb + input init sequence fixes
58 *
59 * 2002-07-16 - 0.0.4 : minor changes, merge with Vojtech's v0.0.3
60 * - verified the lack of HID and report descriptors
61 * - verified that ALL buttons WORK
62 * - fixed d-pad to axes mapping
63 *
64 * 2002-07-17 - 0.0.5 : simplified d-pad handling
d518b2b4
DC		 65 *
66 * 2004-10-02 - 0.0.6 : DDR pad support
67 * - borrowed from the XBOX linux kernel
68 * - USB id's for commonly used dance pads are present
69 * - dance pads will map D-PAD to buttons, not axes
70 * - pass the module paramater 'dpad_to_buttons' to force
71 * the D-PAD to map to buttons if your pad is not detected
bf8cb314
AH		 72 *
73 * Later changes can be tracked in SCM.
1da177e4
LT		 74 */
75
1da177e4 76#include <linux/kernel.h>
1da177e4
LT		 77#include <linux/init.h>
78#include <linux/slab.h>
deb8ee43 79#include <linux/stat.h>
1da177e4 80#include <linux/module.h>
ae0dadcf 81#include <linux/usb/input.h>
1da177e4 82
1da177e4
LT		 83#define DRIVER_AUTHOR "Marko Friedemann <mfr@bmx-chemnitz.de>"
84#define DRIVER_DESC "X-Box pad driver"
85
86#define XPAD_PKT_LEN 32
87
deb8ee43
DC		 88/* xbox d-pads should map to buttons, as is required for DDR pads
89 but we map them to axes when possible to simplify things */
b45d44e7
NL		 90#define MAP_DPAD_TO_BUTTONS (1 << 0)
91#define MAP_TRIGGERS_TO_BUTTONS (1 << 1)
7beae702
CF		 92#define MAP_STICKS_TO_NULL (1 << 2)
93#define DANCEPAD_MAP_CONFIG (MAP_DPAD_TO_BUTTONS | \
94 MAP_TRIGGERS_TO_BUTTONS | MAP_STICKS_TO_NULL)
deb8ee43 95
c7d9f7eb
JK		 96#define XTYPE_XBOX 0
97#define XTYPE_XBOX360 1
99de0912
BM		 98#define XTYPE_XBOX360W 2
99#define XTYPE_UNKNOWN 3
c7d9f7eb 100
90ab5ee9 101static bool dpad_to_buttons;
deb8ee43
DC		 102module_param(dpad_to_buttons, bool, S_IRUGO);
103MODULE_PARM_DESC(dpad_to_buttons, "Map D-PAD to buttons rather than axes for unknown pads");
104
90ab5ee9 105static bool triggers_to_buttons;
b45d44e7
NL		 106module_param(triggers_to_buttons, bool, S_IRUGO);
107MODULE_PARM_DESC(triggers_to_buttons, "Map triggers to buttons rather than axes for unknown pads");
108
90ab5ee9 109static bool sticks_to_null;
7beae702
CF		 110module_param(sticks_to_null, bool, S_IRUGO);
111MODULE_PARM_DESC(sticks_to_null, "Do not map sticks at all for unknown pads");
112
4c4c9432 113static const struct xpad_device {
1da177e4
LT		 114 u16 idVendor;
115 u16 idProduct;
116 char *name;
b45d44e7 117 u8 mapping;
c7d9f7eb 118 u8 xtype;
1da177e4 119} xpad_device[] = {
b45d44e7
NL		 120 { 0x045e, 0x0202, "Microsoft X-Box pad v1 (US)", 0, XTYPE_XBOX },
121 { 0x045e, 0x0289, "Microsoft X-Box pad v2 (US)", 0, XTYPE_XBOX },
122 { 0x045e, 0x0285, "Microsoft X-Box pad (Japan)", 0, XTYPE_XBOX },
123 { 0x045e, 0x0287, "Microsoft Xbox Controller S", 0, XTYPE_XBOX },
99de0912 124 { 0x045e, 0x0719, "Xbox 360 Wireless Receiver", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX360W },
7beae702 125 { 0x0c12, 0x8809, "RedOctane Xbox Dance Pad", DANCEPAD_MAP_CONFIG, XTYPE_XBOX },
b45d44e7
NL		 126 { 0x044f, 0x0f07, "Thrustmaster, Inc. Controller", 0, XTYPE_XBOX },
127 { 0x046d, 0xc242, "Logitech Chillstream Controller", 0, XTYPE_XBOX360 },
128 { 0x046d, 0xca84, "Logitech Xbox Cordless Controller", 0, XTYPE_XBOX },
129 { 0x046d, 0xca88, "Logitech Compact Controller for Xbox", 0, XTYPE_XBOX },
130 { 0x05fd, 0x1007, "Mad Catz Controller (unverified)", 0, XTYPE_XBOX },
131 { 0x05fd, 0x107a, "InterAct 'PowerPad Pro' X-Box pad (Germany)", 0, XTYPE_XBOX },
132 { 0x0738, 0x4516, "Mad Catz Control Pad", 0, XTYPE_XBOX },
133 { 0x0738, 0x4522, "Mad Catz LumiCON", 0, XTYPE_XBOX },
134 { 0x0738, 0x4526, "Mad Catz Control Pad Pro", 0, XTYPE_XBOX },
135 { 0x0738, 0x4536, "Mad Catz MicroCON", 0, XTYPE_XBOX },
c7d9f7eb 136 { 0x0738, 0x4540, "Mad Catz Beat Pad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
b45d44e7
NL		 137 { 0x0738, 0x4556, "Mad Catz Lynx Wireless Controller", 0, XTYPE_XBOX },
138 { 0x0738, 0x4716, "Mad Catz Wired Xbox 360 Controller", 0, XTYPE_XBOX360 },
139 { 0x0738, 0x4738, "Mad Catz Wired Xbox 360 Controller (SFIV)", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
c7d9f7eb 140 { 0x0738, 0x6040, "Mad Catz Beat Pad Pro", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
b45d44e7
NL		 141 { 0x0c12, 0x8802, "Zeroplus Xbox Controller", 0, XTYPE_XBOX },
142 { 0x0c12, 0x880a, "Pelican Eclipse PL-2023", 0, XTYPE_XBOX },
143 { 0x0c12, 0x8810, "Zeroplus Xbox Controller", 0, XTYPE_XBOX },
144 { 0x0c12, 0x9902, "HAMA VibraX - *FAULTY HARDWARE*", 0, XTYPE_XBOX },
e76b8ee2 145 { 0x0d2f, 0x0002, "Andamiro Pump It Up pad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
b45d44e7
NL		 146 { 0x0e4c, 0x1097, "Radica Gamester Controller", 0, XTYPE_XBOX },
147 { 0x0e4c, 0x2390, "Radica Games Jtech Controller", 0, XTYPE_XBOX },
148 { 0x0e6f, 0x0003, "Logic3 Freebird wireless Controller", 0, XTYPE_XBOX },
149 { 0x0e6f, 0x0005, "Eclipse wireless Controller", 0, XTYPE_XBOX },
150 { 0x0e6f, 0x0006, "Edge wireless Controller", 0, XTYPE_XBOX },
151 { 0x0e6f, 0x0006, "Pelican 'TSZ' Wired Xbox 360 Controller", 0, XTYPE_XBOX360 },
6ac8a99b 152 { 0x0e6f, 0x0201, "Pelican PL-3601 'TSZ' Wired Xbox 360 Controller", 0, XTYPE_XBOX360 },
b45d44e7
NL		 153 { 0x0e8f, 0x0201, "SmartJoy Frag Xpad/PS2 adaptor", 0, XTYPE_XBOX },
154 { 0x0f30, 0x0202, "Joytech Advanced Controller", 0, XTYPE_XBOX },
155 { 0x0f30, 0x8888, "BigBen XBMiniPad Controller", 0, XTYPE_XBOX },
156 { 0x102c, 0xff0c, "Joytech Wireless Advanced Controller", 0, XTYPE_XBOX },
c7d9f7eb 157 { 0x12ab, 0x8809, "Xbox DDR dancepad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
fabadbc7
MH		 158 { 0x12ab, 0x0004, "Honey Bee Xbox360 dancepad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX360 },
159 { 0x0e6f, 0x0105, "HSM3 Xbox360 dancepad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX360 },
b45d44e7 160 { 0x1430, 0x4748, "RedOctane Guitar Hero X-plorer", 0, XTYPE_XBOX360 },
c7d9f7eb 161 { 0x1430, 0x8888, "TX6500+ Dance Pad (first generation)", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
b45d44e7
NL		 162 { 0x146b, 0x0601, "BigBen Interactive XBOX 360 Controller", 0, XTYPE_XBOX360 },
163 { 0x045e, 0x028e, "Microsoft X-Box 360 pad", 0, XTYPE_XBOX360 },
fabadbc7 164 { 0x1bad, 0x0002, "Harmonix Rock Band Guitar", 0, XTYPE_XBOX360 },
805423e8 165 { 0x1bad, 0x0003, "Harmonix Rock Band Drumkit", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX360 },
b45d44e7 166 { 0x0f0d, 0x0016, "Hori Real Arcade Pro.EX", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
b326b853 167 { 0x0f0d, 0x000d, "Hori Fighting Stick EX2", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
cc71a7e8 168 { 0x1689, 0xfd00, "Razer Onza Tournament Edition", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX360 },
b45d44e7
NL		 169 { 0xffff, 0xffff, "Chinese-made Xbox Controller", 0, XTYPE_XBOX },
170 { 0x0000, 0x0000, "Generic X-Box pad", 0, XTYPE_UNKNOWN }
1da177e4
LT		 171};
172
fc55e952
AH		 173/* buttons shared with xbox and xbox360 */
174static const signed short xpad_common_btn[] = {
175 BTN_A, BTN_B, BTN_X, BTN_Y, /* "analog" buttons */
7beae702 176 BTN_START, BTN_SELECT, BTN_THUMBL, BTN_THUMBR, /* start/back/sticks */
1da177e4
LT		 177 -1 /* terminating entry */
178};
179
fc55e952
AH		 180/* original xbox controllers only */
181static const signed short xpad_btn[] = {
182 BTN_C, BTN_Z, /* "analog" buttons */
183 -1 /* terminating entry */
184};
185
7beae702 186/* used when dpad is mapped to buttons */
deb8ee43 187static const signed short xpad_btn_pad[] = {
7beae702
CF		 188 BTN_TRIGGER_HAPPY1, BTN_TRIGGER_HAPPY2, /* d-pad left, right */
189 BTN_TRIGGER_HAPPY3, BTN_TRIGGER_HAPPY4, /* d-pad up, down */
deb8ee43
DC		 190 -1 /* terminating entry */
191};
192
b45d44e7
NL		 193/* used when triggers are mapped to buttons */
194static const signed short xpad_btn_triggers[] = {
195 BTN_TL2, BTN_TR2, /* triggers left/right */
196 -1
197};
198
199
c7d9f7eb
JK		 200static const signed short xpad360_btn[] = { /* buttons for x360 controller */
201 BTN_TL, BTN_TR, /* Button LB/RB */
202 BTN_MODE, /* The big X button */
203 -1
204};
205
4c4c9432 206static const signed short xpad_abs[] = {
1da177e4
LT		 207 ABS_X, ABS_Y, /* left stick */
208 ABS_RX, ABS_RY, /* right stick */
deb8ee43
DC		 209 -1 /* terminating entry */
210};
211
b45d44e7 212/* used when dpad is mapped to axes */
deb8ee43
DC		 213static const signed short xpad_abs_pad[] = {
214 ABS_HAT0X, ABS_HAT0Y, /* d-pad axes */
1da177e4
LT		 215 -1 /* terminating entry */
216};
217
b45d44e7
NL		 218/* used when triggers are mapped to axes */
219static const signed short xpad_abs_triggers[] = {
220 ABS_Z, ABS_RZ, /* triggers left/right */
221 -1
222};
223
8a0f83ea
AH		 224/* Xbox 360 has a vendor-specific class, so we cannot match it with only
225 * USB_INTERFACE_INFO (also specifically refused by USB subsystem), so we
99de0912
BM		 226 * match against vendor id as well. Wired Xbox 360 devices have protocol 1,
227 * wireless controllers have protocol 129. */
228#define XPAD_XBOX360_VENDOR_PROTOCOL(vend,pr) \
8a0f83ea
AH		 229 .match_flags = USB_DEVICE_ID_MATCH_VENDOR | USB_DEVICE_ID_MATCH_INT_INFO, \
230 .idVendor = (vend), \
231 .bInterfaceClass = USB_CLASS_VENDOR_SPEC, \
232 .bInterfaceSubClass = 93, \
99de0912
BM		 233 .bInterfaceProtocol = (pr)
234#define XPAD_XBOX360_VENDOR(vend) \
235 { XPAD_XBOX360_VENDOR_PROTOCOL(vend,1) }, \
236 { XPAD_XBOX360_VENDOR_PROTOCOL(vend,129) }
8a0f83ea 237
1da177e4
LT		 238static struct usb_device_id xpad_table [] = {
239 { USB_INTERFACE_INFO('X', 'B', 0) }, /* X-Box USB-IF not approved class */
99de0912
BM		 240 XPAD_XBOX360_VENDOR(0x045e), /* Microsoft X-Box 360 controllers */
241 XPAD_XBOX360_VENDOR(0x046d), /* Logitech X-Box 360 style controllers */
242 XPAD_XBOX360_VENDOR(0x0738), /* Mad Catz X-Box 360 controllers */
3ffb62cb 243 { USB_DEVICE(0x0738, 0x4540) }, /* Mad Catz Beat Pad */
99de0912 244 XPAD_XBOX360_VENDOR(0x0e6f), /* 0x0e6f X-Box 360 controllers */
fabadbc7 245 XPAD_XBOX360_VENDOR(0x12ab), /* X-Box 360 dance pads */
99de0912 246 XPAD_XBOX360_VENDOR(0x1430), /* RedOctane X-Box 360 controllers */
3ac91d36 247 XPAD_XBOX360_VENDOR(0x146b), /* BigBen Interactive Controllers */
fabadbc7 248 XPAD_XBOX360_VENDOR(0x1bad), /* Harminix Rock Band Guitar and Drums */
cc71a7e8
IK		 249 XPAD_XBOX360_VENDOR(0x0f0d), /* Hori Controllers */
250 XPAD_XBOX360_VENDOR(0x1689), /* Razer Onza */
1da177e4
LT		 251 { }
252};
253
254MODULE_DEVICE_TABLE (usb, xpad_table);
255
256struct usb_xpad {
deb8ee43
DC		 257 struct input_dev *dev; /* input device interface */
258 struct usb_device *udev; /* usb device */
05f091ab 259
99de0912
BM		 260 int pad_present;
261
deb8ee43
DC		 262 struct urb *irq_in; /* urb for interrupt in report */
263 unsigned char *idata; /* input data */
1da177e4 264 dma_addr_t idata_dma;
05f091ab 265
99de0912
BM		 266 struct urb *bulk_out;
267 unsigned char *bdata;
268
4994cd8d 269#if defined(CONFIG_JOYSTICK_XPAD_FF) || defined(CONFIG_JOYSTICK_XPAD_LEDS)
e01a06e8
JK		 270 struct urb *irq_out; /* urb for interrupt out report */
271 unsigned char *odata; /* output data */
272 dma_addr_t odata_dma;
4994cd8d
JK		 273 struct mutex odata_mutex;
274#endif
275
276#if defined(CONFIG_JOYSTICK_XPAD_LEDS)
277 struct xpad_led *led;
e01a06e8
JK		 278#endif
279
4994cd8d 280 char phys[64]; /* physical device path */
deb8ee43 281
b45d44e7 282 int mapping; /* map d-pad to buttons or to axes */
c7d9f7eb 283 int xtype; /* type of xbox device */
1da177e4
LT		 284};
285
286/*
287 * xpad_process_packet
288 *
289 * Completes a request by converting the data into events for the
290 * input subsystem.
291 *
292 * The used report descriptor was taken from ITO Takayukis website:
293 * http://euc.jp/periphs/xbox-controller.ja.html
294 */
295
7d12e780 296static void xpad_process_packet(struct usb_xpad *xpad, u16 cmd, unsigned char *data)
1da177e4 297{
c5b7c7c3 298 struct input_dev *dev = xpad->dev;
1da177e4 299
7beae702
CF		 300 if (!(xpad->mapping & MAP_STICKS_TO_NULL)) {
301 /* left stick */
302 input_report_abs(dev, ABS_X,
303 (__s16) le16_to_cpup((__le16 *)(data + 12)));
304 input_report_abs(dev, ABS_Y,
305 ~(__s16) le16_to_cpup((__le16 *)(data + 14)));
306
307 /* right stick */
308 input_report_abs(dev, ABS_RX,
309 (__s16) le16_to_cpup((__le16 *)(data + 16)));
310 input_report_abs(dev, ABS_RY,
311 ~(__s16) le16_to_cpup((__le16 *)(data + 18)));
312 }
05f091ab 313
1da177e4 314 /* triggers left/right */
b45d44e7
NL		 315 if (xpad->mapping & MAP_TRIGGERS_TO_BUTTONS) {
316 input_report_key(dev, BTN_TL2, data[10]);
317 input_report_key(dev, BTN_TR2, data[11]);
318 } else {
319 input_report_abs(dev, ABS_Z, data[10]);
320 input_report_abs(dev, ABS_RZ, data[11]);
321 }
05f091ab 322
1da177e4 323 /* digital pad */
b45d44e7 324 if (xpad->mapping & MAP_DPAD_TO_BUTTONS) {
7beae702
CF		 325 /* dpad as buttons (left, right, up, down) */
326 input_report_key(dev, BTN_TRIGGER_HAPPY1, data[2] & 0x04);
327 input_report_key(dev, BTN_TRIGGER_HAPPY2, data[2] & 0x08);
328 input_report_key(dev, BTN_TRIGGER_HAPPY3, data[2] & 0x01);
329 input_report_key(dev, BTN_TRIGGER_HAPPY4, data[2] & 0x02);
b45d44e7
NL		 330 } else {
331 input_report_abs(dev, ABS_HAT0X,
332 !!(data[2] & 0x08) - !!(data[2] & 0x04));
333 input_report_abs(dev, ABS_HAT0Y,
334 !!(data[2] & 0x02) - !!(data[2] & 0x01));
deb8ee43 335 }
05f091ab 336
1da177e4 337 /* start/back buttons and stick press left/right */
deb8ee43 338 input_report_key(dev, BTN_START, data[2] & 0x10);
7beae702 339 input_report_key(dev, BTN_SELECT, data[2] & 0x20);
deb8ee43
DC		 340 input_report_key(dev, BTN_THUMBL, data[2] & 0x40);
341 input_report_key(dev, BTN_THUMBR, data[2] & 0x80);
05f091ab 342
1da177e4
LT		 343 /* "analog" buttons A, B, X, Y */
344 input_report_key(dev, BTN_A, data[4]);
345 input_report_key(dev, BTN_B, data[5]);
346 input_report_key(dev, BTN_X, data[6]);
347 input_report_key(dev, BTN_Y, data[7]);
05f091ab 348
1da177e4
LT		 349 /* "analog" buttons black, white */
350 input_report_key(dev, BTN_C, data[8]);
351 input_report_key(dev, BTN_Z, data[9]);
352
353 input_sync(dev);
354}
355
c7d9f7eb
JK		 356/*
357 * xpad360_process_packet
358 *
359 * Completes a request by converting the data into events for the
360 * input subsystem. It is version for xbox 360 controller
361 *
362 * The used report descriptor was taken from:
363 * http://www.free60.org/wiki/Gamepad
364 */
365
20b3cdd6
DT		 366static void xpad360_process_packet(struct usb_xpad *xpad,
367 u16 cmd, unsigned char *data)
c7d9f7eb
JK		 368{
369 struct input_dev *dev = xpad->dev;
370
371 /* digital pad */
b45d44e7 372 if (xpad->mapping & MAP_DPAD_TO_BUTTONS) {
7beae702
CF		 373 /* dpad as buttons (left, right, up, down) */
374 input_report_key(dev, BTN_TRIGGER_HAPPY1, data[2] & 0x04);
375 input_report_key(dev, BTN_TRIGGER_HAPPY2, data[2] & 0x08);
376 input_report_key(dev, BTN_TRIGGER_HAPPY3, data[2] & 0x01);
377 input_report_key(dev, BTN_TRIGGER_HAPPY4, data[2] & 0x02);
b45d44e7
NL		 378 } else {
379 input_report_abs(dev, ABS_HAT0X,
380 !!(data[2] & 0x08) - !!(data[2] & 0x04));
381 input_report_abs(dev, ABS_HAT0Y,
382 !!(data[2] & 0x02) - !!(data[2] & 0x01));
c7d9f7eb
JK		 383 }
384
385 /* start/back buttons */
ae91d10a 386 input_report_key(dev, BTN_START, data[2] & 0x10);
7beae702 387 input_report_key(dev, BTN_SELECT, data[2] & 0x20);
c7d9f7eb
JK		 388
389 /* stick press left/right */
390 input_report_key(dev, BTN_THUMBL, data[2] & 0x40);
391 input_report_key(dev, BTN_THUMBR, data[2] & 0x80);
392
393 /* buttons A,B,X,Y,TL,TR and MODE */
ae91d10a
DT		 394 input_report_key(dev, BTN_A, data[3] & 0x10);
395 input_report_key(dev, BTN_B, data[3] & 0x20);
396 input_report_key(dev, BTN_X, data[3] & 0x40);
397 input_report_key(dev, BTN_Y, data[3] & 0x80);
398 input_report_key(dev, BTN_TL, data[3] & 0x01);
399 input_report_key(dev, BTN_TR, data[3] & 0x02);
400 input_report_key(dev, BTN_MODE, data[3] & 0x04);
c7d9f7eb 401
7beae702
CF		 402 if (!(xpad->mapping & MAP_STICKS_TO_NULL)) {
403 /* left stick */
404 input_report_abs(dev, ABS_X,
405 (__s16) le16_to_cpup((__le16 *)(data + 6)));
406 input_report_abs(dev, ABS_Y,
407 ~(__s16) le16_to_cpup((__le16 *)(data + 8)));
408
409 /* right stick */
410 input_report_abs(dev, ABS_RX,
411 (__s16) le16_to_cpup((__le16 *)(data + 10)));
412 input_report_abs(dev, ABS_RY,
413 ~(__s16) le16_to_cpup((__le16 *)(data + 12)));
414 }
c7d9f7eb
JK		 415
416 /* triggers left/right */
b45d44e7
NL		 417 if (xpad->mapping & MAP_TRIGGERS_TO_BUTTONS) {
418 input_report_key(dev, BTN_TL2, data[4]);
419 input_report_key(dev, BTN_TR2, data[5]);
420 } else {
421 input_report_abs(dev, ABS_Z, data[4]);
422 input_report_abs(dev, ABS_RZ, data[5]);
423 }
c7d9f7eb
JK		 424
425 input_sync(dev);
426}
427
99de0912
BM		 428/*
429 * xpad360w_process_packet
430 *
431 * Completes a request by converting the data into events for the
432 * input subsystem. It is version for xbox 360 wireless controller.
433 *
434 * Byte.Bit
435 * 00.1 - Status change: The controller or headset has connected/disconnected
436 * Bits 01.7 and 01.6 are valid
437 * 01.7 - Controller present
438 * 01.6 - Headset present
439 * 01.1 - Pad state (Bytes 4+) valid
440 *
441 */
442
443static void xpad360w_process_packet(struct usb_xpad *xpad, u16 cmd, unsigned char *data)
444{
445 /* Presence change */
446 if (data[0] & 0x08) {
447 if (data[1] & 0x80) {
448 xpad->pad_present = 1;
449 usb_submit_urb(xpad->bulk_out, GFP_ATOMIC);
450 } else
451 xpad->pad_present = 0;
452 }
453
454 /* Valid pad data */
455 if (!(data[1] & 0x1))
456 return;
457
458 xpad360_process_packet(xpad, cmd, &data[4]);
459}
460
7d12e780 461static void xpad_irq_in(struct urb *urb)
1da177e4
LT		 462{
463 struct usb_xpad *xpad = urb->context;
6fc88f53 464 int retval, status;
05f091ab 465
6fc88f53
ON		 466 status = urb->status;
467
468 switch (status) {
1da177e4
LT		 469 case 0:
470 /* success */
471 break;
472 case -ECONNRESET:
473 case -ENOENT:
474 case -ESHUTDOWN:
475 /* this urb is terminated, clean up */
20b3cdd6 476 dbg("%s - urb shutting down with status: %d",
ea3e6c59 477 __func__, status);
1da177e4
LT		 478 return;
479 default:
20b3cdd6 480 dbg("%s - nonzero urb status received: %d",
ea3e6c59 481 __func__, status);
1da177e4
LT		 482 goto exit;
483 }
05f091ab 484
99de0912
BM		 485 switch (xpad->xtype) {
486 case XTYPE_XBOX360:
c7d9f7eb 487 xpad360_process_packet(xpad, 0, xpad->idata);
99de0912
BM		 488 break;
489 case XTYPE_XBOX360W:
490 xpad360w_process_packet(xpad, 0, xpad->idata);
491 break;
492 default:
c7d9f7eb 493 xpad_process_packet(xpad, 0, xpad->idata);
99de0912 494 }
1da177e4
LT		 495
496exit:
dd38d688 497 retval = usb_submit_urb(urb, GFP_ATOMIC);
1da177e4
LT		 498 if (retval)
499 err ("%s - usb_submit_urb failed with result %d",
ea3e6c59 500 __func__, retval);
1da177e4
LT		 501}
502
20430214
DT		 503static void xpad_bulk_out(struct urb *urb)
504{
505 switch (urb->status) {
506 case 0:
507 /* success */
508 break;
509 case -ECONNRESET:
510 case -ENOENT:
511 case -ESHUTDOWN:
512 /* this urb is terminated, clean up */
80a914dc 513 dbg("%s - urb shutting down with status: %d", __func__, urb->status);
20430214
DT		 514 break;
515 default:
80a914dc 516 dbg("%s - nonzero urb status received: %d", __func__, urb->status);
20430214
DT		 517 }
518}
519
4994cd8d 520#if defined(CONFIG_JOYSTICK_XPAD_FF) || defined(CONFIG_JOYSTICK_XPAD_LEDS)
e01a06e8
JK		 521static void xpad_irq_out(struct urb *urb)
522{
6fc88f53
ON		 523 int retval, status;
524
525 status = urb->status;
e01a06e8 526
6fc88f53 527 switch (status) {
70a6f2e6 528 case 0:
e01a06e8 529 /* success */
70a6f2e6
MG		 530 return;
531
532 case -ECONNRESET:
533 case -ENOENT:
534 case -ESHUTDOWN:
535 /* this urb is terminated, clean up */
536 dbg("%s - urb shutting down with status: %d", __func__, status);
537 return;
538
539 default:
540 dbg("%s - nonzero urb status received: %d", __func__, status);
541 goto exit;
e01a06e8
JK		 542 }
543
544exit:
545 retval = usb_submit_urb(urb, GFP_ATOMIC);
546 if (retval)
547 err("%s - usb_submit_urb failed with result %d",
ea3e6c59 548 __func__, retval);
e01a06e8
JK		 549}
550
4994cd8d 551static int xpad_init_output(struct usb_interface *intf, struct usb_xpad *xpad)
e01a06e8
JK		 552{
553 struct usb_endpoint_descriptor *ep_irq_out;
49cc69b6 554 int error;
e01a06e8 555
b514d4f7 556 if (xpad->xtype == XTYPE_UNKNOWN)
e01a06e8
JK		 557 return 0;
558
997ea58e
DM		 559 xpad->odata = usb_alloc_coherent(xpad->udev, XPAD_PKT_LEN,
560 GFP_KERNEL, &xpad->odata_dma);
49cc69b6
AL		 561 if (!xpad->odata) {
562 error = -ENOMEM;
e01a06e8 563 goto fail1;
49cc69b6 564 }
e01a06e8 565
4994cd8d
JK		 566 mutex_init(&xpad->odata_mutex);
567
e01a06e8 568 xpad->irq_out = usb_alloc_urb(0, GFP_KERNEL);
49cc69b6
AL		 569 if (!xpad->irq_out) {
570 error = -ENOMEM;
e01a06e8 571 goto fail2;
49cc69b6 572 }
e01a06e8
JK		 573
574 ep_irq_out = &intf->cur_altsetting->endpoint[1].desc;
575 usb_fill_int_urb(xpad->irq_out, xpad->udev,
576 usb_sndintpipe(xpad->udev, ep_irq_out->bEndpointAddress),
577 xpad->odata, XPAD_PKT_LEN,
578 xpad_irq_out, xpad, ep_irq_out->bInterval);
579 xpad->irq_out->transfer_dma = xpad->odata_dma;
580 xpad->irq_out->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
581
e01a06e8
JK		 582 return 0;
583
997ea58e 584 fail2: usb_free_coherent(xpad->udev, XPAD_PKT_LEN, xpad->odata, xpad->odata_dma);
e01a06e8
JK		 585 fail1: return error;
586}
587
4994cd8d 588static void xpad_stop_output(struct usb_xpad *xpad)
e01a06e8 589{
b514d4f7 590 if (xpad->xtype != XTYPE_UNKNOWN)
e01a06e8
JK		 591 usb_kill_urb(xpad->irq_out);
592}
593
4994cd8d 594static void xpad_deinit_output(struct usb_xpad *xpad)
e01a06e8 595{
b514d4f7 596 if (xpad->xtype != XTYPE_UNKNOWN) {
e01a06e8 597 usb_free_urb(xpad->irq_out);
997ea58e 598 usb_free_coherent(xpad->udev, XPAD_PKT_LEN,
e01a06e8
JK		 599 xpad->odata, xpad->odata_dma);
600 }
601}
4994cd8d
JK		 602#else
603static int xpad_init_output(struct usb_interface *intf, struct usb_xpad *xpad) { return 0; }
604static void xpad_deinit_output(struct usb_xpad *xpad) {}
605static void xpad_stop_output(struct usb_xpad *xpad) {}
606#endif
607
608#ifdef CONFIG_JOYSTICK_XPAD_FF
12187305 609static int xpad_play_effect(struct input_dev *dev, void *data, struct ff_effect *effect)
4994cd8d
JK		 610{
611 struct usb_xpad *xpad = input_get_drvdata(dev);
e01a06e8 612
4994cd8d
JK		 613 if (effect->type == FF_RUMBLE) {
614 __u16 strong = effect->u.rumble.strong_magnitude;
615 __u16 weak = effect->u.rumble.weak_magnitude;
12187305
BV		 616
617 switch (xpad->xtype) {
618
619 case XTYPE_XBOX:
620 xpad->odata[0] = 0x00;
621 xpad->odata[1] = 0x06;
622 xpad->odata[2] = 0x00;
623 xpad->odata[3] = strong / 256; /* left actuator */
624 xpad->odata[4] = 0x00;
625 xpad->odata[5] = weak / 256; /* right actuator */
626 xpad->irq_out->transfer_buffer_length = 6;
627
628 return usb_submit_urb(xpad->irq_out, GFP_ATOMIC);
629
630 case XTYPE_XBOX360:
631 xpad->odata[0] = 0x00;
632 xpad->odata[1] = 0x08;
633 xpad->odata[2] = 0x00;
634 xpad->odata[3] = strong / 256; /* left actuator? */
635 xpad->odata[4] = weak / 256; /* right actuator? */
636 xpad->odata[5] = 0x00;
637 xpad->odata[6] = 0x00;
638 xpad->odata[7] = 0x00;
639 xpad->irq_out->transfer_buffer_length = 8;
640
641 return usb_submit_urb(xpad->irq_out, GFP_ATOMIC);
642
b514d4f7
CM		 643 case XTYPE_XBOX360W:
644 xpad->odata[0] = 0x00;
645 xpad->odata[1] = 0x01;
646 xpad->odata[2] = 0x0F;
647 xpad->odata[3] = 0xC0;
648 xpad->odata[4] = 0x00;
649 xpad->odata[5] = strong / 256;
650 xpad->odata[6] = weak / 256;
651 xpad->odata[7] = 0x00;
652 xpad->odata[8] = 0x00;
653 xpad->odata[9] = 0x00;
654 xpad->odata[10] = 0x00;
655 xpad->odata[11] = 0x00;
656 xpad->irq_out->transfer_buffer_length = 12;
657
658 return usb_submit_urb(xpad->irq_out, GFP_ATOMIC);
659
12187305
BV		 660 default:
661 dbg("%s - rumble command sent to unsupported xpad type: %d",
662 __func__, xpad->xtype);
663 return -1;
664 }
4994cd8d
JK		 665 }
666
667 return 0;
668}
669
670static int xpad_init_ff(struct usb_xpad *xpad)
671{
b514d4f7 672 if (xpad->xtype == XTYPE_UNKNOWN)
cfbe2010
AH		 673 return 0;
674
4994cd8d
JK		 675 input_set_capability(xpad->dev, EV_FF, FF_RUMBLE);
676
677 return input_ff_create_memless(xpad->dev, NULL, xpad_play_effect);
678}
679
680#else
681static int xpad_init_ff(struct usb_xpad *xpad) { return 0; }
682#endif
683
684#if defined(CONFIG_JOYSTICK_XPAD_LEDS)
685#include <linux/leds.h>
686
687struct xpad_led {
688 char name[16];
689 struct led_classdev led_cdev;
690 struct usb_xpad *xpad;
691};
692
693static void xpad_send_led_command(struct usb_xpad *xpad, int command)
694{
695 if (command >= 0 && command < 14) {
696 mutex_lock(&xpad->odata_mutex);
697 xpad->odata[0] = 0x01;
698 xpad->odata[1] = 0x03;
699 xpad->odata[2] = command;
04021e4e 700 xpad->irq_out->transfer_buffer_length = 3;
4994cd8d
JK		 701 usb_submit_urb(xpad->irq_out, GFP_KERNEL);
702 mutex_unlock(&xpad->odata_mutex);
703 }
704}
705
706static void xpad_led_set(struct led_classdev *led_cdev,
707 enum led_brightness value)
708{
709 struct xpad_led *xpad_led = container_of(led_cdev,
710 struct xpad_led, led_cdev);
711
712 xpad_send_led_command(xpad_led->xpad, value);
713}
714
715static int xpad_led_probe(struct usb_xpad *xpad)
716{
717 static atomic_t led_seq = ATOMIC_INIT(0);
718 long led_no;
719 struct xpad_led *led;
720 struct led_classdev *led_cdev;
721 int error;
722
723 if (xpad->xtype != XTYPE_XBOX360)
724 return 0;
725
726 xpad->led = led = kzalloc(sizeof(struct xpad_led), GFP_KERNEL);
727 if (!led)
728 return -ENOMEM;
729
730 led_no = (long)atomic_inc_return(&led_seq) - 1;
731
732 snprintf(led->name, sizeof(led->name), "xpad%ld", led_no);
733 led->xpad = xpad;
734
735 led_cdev = &led->led_cdev;
736 led_cdev->name = led->name;
737 led_cdev->brightness_set = xpad_led_set;
738
739 error = led_classdev_register(&xpad->udev->dev, led_cdev);
740 if (error) {
741 kfree(led);
742 xpad->led = NULL;
743 return error;
744 }
745
746 /*
747 * Light up the segment corresponding to controller number
748 */
749 xpad_send_led_command(xpad, (led_no % 4) + 2);
750
751 return 0;
752}
753
754static void xpad_led_disconnect(struct usb_xpad *xpad)
755{
756 struct xpad_led *xpad_led = xpad->led;
757
758 if (xpad_led) {
759 led_classdev_unregister(&xpad_led->led_cdev);
6ff92a6d 760 kfree(xpad_led);
4994cd8d
JK		 761 }
762}
e01a06e8 763#else
4994cd8d
JK		 764static int xpad_led_probe(struct usb_xpad *xpad) { return 0; }
765static void xpad_led_disconnect(struct usb_xpad *xpad) { }
e01a06e8
JK		 766#endif
767
4994cd8d 768
e01a06e8 769static int xpad_open(struct input_dev *dev)
1da177e4 770{
7791bdae 771 struct usb_xpad *xpad = input_get_drvdata(dev);
05f091ab 772
99de0912
BM		 773 /* URB was submitted in probe */
774 if(xpad->xtype == XTYPE_XBOX360W)
775 return 0;
776
1da177e4 777 xpad->irq_in->dev = xpad->udev;
65cde54b 778 if (usb_submit_urb(xpad->irq_in, GFP_KERNEL))
1da177e4 779 return -EIO;
05f091ab 780
1da177e4
LT		 781 return 0;
782}
783
e01a06e8 784static void xpad_close(struct input_dev *dev)
1da177e4 785{
7791bdae 786 struct usb_xpad *xpad = input_get_drvdata(dev);
05f091ab 787
161feb24 788 if (xpad->xtype != XTYPE_XBOX360W)
99de0912 789 usb_kill_urb(xpad->irq_in);
161feb24 790
4994cd8d 791 xpad_stop_output(xpad);
1da177e4
LT		 792}
793
deb8ee43
DC		 794static void xpad_set_up_abs(struct input_dev *input_dev, signed short abs)
795{
796 set_bit(abs, input_dev->absbit);
797
798 switch (abs) {
799 case ABS_X:
800 case ABS_Y:
801 case ABS_RX:
802 case ABS_RY: /* the two sticks */
803 input_set_abs_params(input_dev, abs, -32768, 32767, 16, 128);
804 break;
805 case ABS_Z:
b45d44e7 806 case ABS_RZ: /* the triggers (if mapped to axes) */
deb8ee43
DC		 807 input_set_abs_params(input_dev, abs, 0, 255, 0, 0);
808 break;
809 case ABS_HAT0X:
b45d44e7 810 case ABS_HAT0Y: /* the d-pad (only if dpad is mapped to axes */
deb8ee43
DC		 811 input_set_abs_params(input_dev, abs, -1, 1, 0, 0);
812 break;
813 }
814}
815
1da177e4
LT		 816static int xpad_probe(struct usb_interface *intf, const struct usb_device_id *id)
817{
20b3cdd6 818 struct usb_device *udev = interface_to_usbdev(intf);
c5b7c7c3
DT		 819 struct usb_xpad *xpad;
820 struct input_dev *input_dev;
1da177e4 821 struct usb_endpoint_descriptor *ep_irq_in;
49cc69b6 822 int i, error;
05f091ab 823
1da177e4
LT		 824 for (i = 0; xpad_device[i].idVendor; i++) {
825 if ((le16_to_cpu(udev->descriptor.idVendor) == xpad_device[i].idVendor) &&
826 (le16_to_cpu(udev->descriptor.idProduct) == xpad_device[i].idProduct))
827 break;
828 }
05f091ab 829
c5b7c7c3
DT		 830 xpad = kzalloc(sizeof(struct usb_xpad), GFP_KERNEL);
831 input_dev = input_allocate_device();
49cc69b6
AL		 832 if (!xpad || !input_dev) {
833 error = -ENOMEM;
c5b7c7c3 834 goto fail1;
49cc69b6 835 }
05f091ab 836
997ea58e
DM		 837 xpad->idata = usb_alloc_coherent(udev, XPAD_PKT_LEN,
838 GFP_KERNEL, &xpad->idata_dma);
49cc69b6
AL		 839 if (!xpad->idata) {
840 error = -ENOMEM;
c5b7c7c3 841 goto fail1;
49cc69b6 842 }
1da177e4
LT		 843
844 xpad->irq_in = usb_alloc_urb(0, GFP_KERNEL);
49cc69b6
AL		 845 if (!xpad->irq_in) {
846 error = -ENOMEM;
c5b7c7c3 847 goto fail2;
49cc69b6 848 }
05f091ab 849
1da177e4 850 xpad->udev = udev;
b45d44e7 851 xpad->mapping = xpad_device[i].mapping;
c7d9f7eb 852 xpad->xtype = xpad_device[i].xtype;
b45d44e7 853
99de0912
BM		 854 if (xpad->xtype == XTYPE_UNKNOWN) {
855 if (intf->cur_altsetting->desc.bInterfaceClass == USB_CLASS_VENDOR_SPEC) {
856 if (intf->cur_altsetting->desc.bInterfaceProtocol == 129)
857 xpad->xtype = XTYPE_XBOX360W;
858 else
859 xpad->xtype = XTYPE_XBOX360;
860 } else
861 xpad->xtype = XTYPE_XBOX;
b45d44e7
NL		 862
863 if (dpad_to_buttons)
864 xpad->mapping |= MAP_DPAD_TO_BUTTONS;
865 if (triggers_to_buttons)
866 xpad->mapping |= MAP_TRIGGERS_TO_BUTTONS;
7beae702
CF		 867 if (sticks_to_null)
868 xpad->mapping |= MAP_STICKS_TO_NULL;
99de0912 869 }
b45d44e7 870
c5b7c7c3
DT		 871 xpad->dev = input_dev;
872 usb_make_path(udev, xpad->phys, sizeof(xpad->phys));
873 strlcat(xpad->phys, "/input0", sizeof(xpad->phys));
05f091ab 874
c5b7c7c3
DT		 875 input_dev->name = xpad_device[i].name;
876 input_dev->phys = xpad->phys;
877 usb_to_input_id(udev, &input_dev->id);
c0f82d57 878 input_dev->dev.parent = &intf->dev;
7791bdae
DT		 879
880 input_set_drvdata(input_dev, xpad);
881
c5b7c7c3
DT		 882 input_dev->open = xpad_open;
883 input_dev->close = xpad_close;
05f091ab 884
7beae702
CF		 885 input_dev->evbit[0] = BIT_MASK(EV_KEY);
886
887 if (!(xpad->mapping & MAP_STICKS_TO_NULL)) {
888 input_dev->evbit[0] |= BIT_MASK(EV_ABS);
889 /* set up axes */
890 for (i = 0; xpad_abs[i] >= 0; i++)
891 xpad_set_up_abs(input_dev, xpad_abs[i]);
892 }
05f091ab 893
7beae702 894 /* set up standard buttons */
fc55e952 895 for (i = 0; xpad_common_btn[i] >= 0; i++)
b45d44e7 896 __set_bit(xpad_common_btn[i], input_dev->keybit);
05f091ab 897
7beae702 898 /* set up model-specific ones */
b45d44e7
NL		 899 if (xpad->xtype == XTYPE_XBOX360 || xpad->xtype == XTYPE_XBOX360W) {
900 for (i = 0; xpad360_btn[i] >= 0; i++)
901 __set_bit(xpad360_btn[i], input_dev->keybit);
902 } else {
903 for (i = 0; xpad_btn[i] >= 0; i++)
904 __set_bit(xpad_btn[i], input_dev->keybit);
905 }
906
907 if (xpad->mapping & MAP_DPAD_TO_BUTTONS) {
908 for (i = 0; xpad_btn_pad[i] >= 0; i++)
909 __set_bit(xpad_btn_pad[i], input_dev->keybit);
910 } else {
deb8ee43
DC		 911 for (i = 0; xpad_abs_pad[i] >= 0; i++)
912 xpad_set_up_abs(input_dev, xpad_abs_pad[i]);
b45d44e7
NL		 913 }
914
915 if (xpad->mapping & MAP_TRIGGERS_TO_BUTTONS) {
916 for (i = 0; xpad_btn_triggers[i] >= 0; i++)
917 __set_bit(xpad_btn_triggers[i], input_dev->keybit);
918 } else {
919 for (i = 0; xpad_abs_triggers[i] >= 0; i++)
920 xpad_set_up_abs(input_dev, xpad_abs_triggers[i]);
921 }
05f091ab 922
4994cd8d 923 error = xpad_init_output(intf, xpad);
e01a06e8 924 if (error)
161feb24 925 goto fail3;
e01a06e8 926
4994cd8d
JK		 927 error = xpad_init_ff(xpad);
928 if (error)
161feb24 929 goto fail4;
4994cd8d
JK		 930
931 error = xpad_led_probe(xpad);
932 if (error)
161feb24 933 goto fail5;
4994cd8d 934
c5b7c7c3
DT		 935 ep_irq_in = &intf->cur_altsetting->endpoint[0].desc;
936 usb_fill_int_urb(xpad->irq_in, udev,
937 usb_rcvintpipe(udev, ep_irq_in->bEndpointAddress),
938 xpad->idata, XPAD_PKT_LEN, xpad_irq_in,
939 xpad, ep_irq_in->bInterval);
940 xpad->irq_in->transfer_dma = xpad->idata_dma;
941 xpad->irq_in->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
05f091ab 942
5014186d
DT		 943 error = input_register_device(xpad->dev);
944 if (error)
161feb24 945 goto fail6;
05f091ab 946
1da177e4 947 usb_set_intfdata(intf, xpad);
99de0912 948
99de0912 949 if (xpad->xtype == XTYPE_XBOX360W) {
99de0912
BM		 950 /*
951 * Setup the message to set the LEDs on the
952 * controller when it shows up
953 */
954 xpad->bulk_out = usb_alloc_urb(0, GFP_KERNEL);
49cc69b6
AL		 955 if (!xpad->bulk_out) {
956 error = -ENOMEM;
e3f0f0a6 957 goto fail7;
49cc69b6 958 }
99de0912
BM		 959
960 xpad->bdata = kzalloc(XPAD_PKT_LEN, GFP_KERNEL);
49cc69b6
AL		 961 if (!xpad->bdata) {
962 error = -ENOMEM;
e3f0f0a6 963 goto fail8;
49cc69b6 964 }
99de0912
BM		 965
966 xpad->bdata[2] = 0x08;
967 switch (intf->cur_altsetting->desc.bInterfaceNumber) {
968 case 0:
969 xpad->bdata[3] = 0x42;
970 break;
971 case 2:
972 xpad->bdata[3] = 0x43;
973 break;
974 case 4:
975 xpad->bdata[3] = 0x44;
976 break;
977 case 6:
978 xpad->bdata[3] = 0x45;
979 }
980
981 ep_irq_in = &intf->cur_altsetting->endpoint[1].desc;
982 usb_fill_bulk_urb(xpad->bulk_out, udev,
983 usb_sndbulkpipe(udev, ep_irq_in->bEndpointAddress),
984 xpad->bdata, XPAD_PKT_LEN, xpad_bulk_out, xpad);
e3f0f0a6
AL		 985
986 /*
987 * Submit the int URB immediately rather than waiting for open
988 * because we get status messages from the device whether
989 * or not any controllers are attached. In fact, it's
990 * exactly the message that a controller has arrived that
991 * we're waiting for.
992 */
993 xpad->irq_in->dev = xpad->udev;
994 error = usb_submit_urb(xpad->irq_in, GFP_KERNEL);
995 if (error)
996 goto fail9;
99de0912
BM		 997 }
998
1da177e4 999 return 0;
c5b7c7c3 1000
e3f0f0a6
AL		 1001 fail9: kfree(xpad->bdata);
1002 fail8: usb_free_urb(xpad->bulk_out);
161feb24
AL		 1003 fail7: input_unregister_device(input_dev);
1004 input_dev = NULL;
1005 fail6: xpad_led_disconnect(xpad);
1006 fail5: if (input_dev)
1007 input_ff_destroy(input_dev);
1008 fail4: xpad_deinit_output(xpad);
1009 fail3: usb_free_urb(xpad->irq_in);
997ea58e 1010 fail2: usb_free_coherent(udev, XPAD_PKT_LEN, xpad->idata, xpad->idata_dma);
5014186d 1011 fail1: input_free_device(input_dev);
c5b7c7c3 1012 kfree(xpad);
5014186d 1013 return error;
c5b7c7c3 1014
1da177e4
LT		 1015}
1016
1017static void xpad_disconnect(struct usb_interface *intf)
1018{
1019 struct usb_xpad *xpad = usb_get_intfdata (intf);
05f091ab 1020
2a059159
DT		 1021 xpad_led_disconnect(xpad);
1022 input_unregister_device(xpad->dev);
1023 xpad_deinit_output(xpad);
1024
1025 if (xpad->xtype == XTYPE_XBOX360W) {
1026 usb_kill_urb(xpad->bulk_out);
1027 usb_free_urb(xpad->bulk_out);
1028 usb_kill_urb(xpad->irq_in);
1da177e4 1029 }
2a059159
DT		 1030
1031 usb_free_urb(xpad->irq_in);
1032 usb_free_coherent(xpad->udev, XPAD_PKT_LEN,
1033 xpad->idata, xpad->idata_dma);
1034
1035 kfree(xpad->bdata);
1036 kfree(xpad);
1037
1038 usb_set_intfdata(intf, NULL);
1da177e4
LT		 1039}
1040
1041static struct usb_driver xpad_driver = {
1da177e4
LT		 1042 .name = "xpad",
1043 .probe = xpad_probe,
1044 .disconnect = xpad_disconnect,
1045 .id_table = xpad_table,
1046};
1047
08642e7c 1048module_usb_driver(xpad_driver);
1da177e4
LT		 1049
1050MODULE_AUTHOR(DRIVER_AUTHOR);
1051MODULE_DESCRIPTION(DRIVER_DESC);
1052MODULE_LICENSE("GPL");
Linux 6.x block layer and io_uring tree(s)