1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76#include <linux/kernel.h>
77#include <linux/init.h>
78#include <linux/slab.h>
79#include <linux/stat.h>
80#include <linux/module.h>
81#include <linux/usb/input.h>
82
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
88
89
90#define MAP_DPAD_TO_BUTTONS (1 << 0)
91#define MAP_TRIGGERS_TO_BUTTONS (1 << 1)
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)
95
96#define XTYPE_XBOX 0
97#define XTYPE_XBOX360 1
98#define XTYPE_XBOX360W 2
99#define XTYPE_UNKNOWN 3
100
101static int dpad_to_buttons;
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
105static int triggers_to_buttons;
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
109static int sticks_to_null;
110module_param(sticks_to_null, bool, S_IRUGO);
111MODULE_PARM_DESC(sticks_to_null, "Do not map sticks at all for unknown pads");
112
113static const struct xpad_device {
114 u16 idVendor;
115 u16 idProduct;
116 char *name;
117 u8 mapping;
118 u8 xtype;
119} xpad_device[] = {
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 },
124 { 0x045e, 0x0719, "Xbox 360 Wireless Receiver", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX360W },
125 { 0x0c12, 0x8809, "RedOctane Xbox Dance Pad", DANCEPAD_MAP_CONFIG, XTYPE_XBOX },
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 },
136 { 0x0738, 0x4540, "Mad Catz Beat Pad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
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 },
140 { 0x0738, 0x6040, "Mad Catz Beat Pad Pro", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
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 },
145 { 0x0e4c, 0x1097, "Radica Gamester Controller", 0, XTYPE_XBOX },
146 { 0x0e4c, 0x2390, "Radica Games Jtech Controller", 0, XTYPE_XBOX },
147 { 0x0e6f, 0x0003, "Logic3 Freebird wireless Controller", 0, XTYPE_XBOX },
148 { 0x0e6f, 0x0005, "Eclipse wireless Controller", 0, XTYPE_XBOX },
149 { 0x0e6f, 0x0006, "Edge wireless Controller", 0, XTYPE_XBOX },
150 { 0x0e6f, 0x0006, "Pelican 'TSZ' Wired Xbox 360 Controller", 0, XTYPE_XBOX360 },
151 { 0x0e6f, 0x0201, "Pelican PL-3601 'TSZ' Wired Xbox 360 Controller", 0, XTYPE_XBOX360 },
152 { 0x0e8f, 0x0201, "SmartJoy Frag Xpad/PS2 adaptor", 0, XTYPE_XBOX },
153 { 0x0f30, 0x0202, "Joytech Advanced Controller", 0, XTYPE_XBOX },
154 { 0x0f30, 0x8888, "BigBen XBMiniPad Controller", 0, XTYPE_XBOX },
155 { 0x102c, 0xff0c, "Joytech Wireless Advanced Controller", 0, XTYPE_XBOX },
156 { 0x12ab, 0x8809, "Xbox DDR dancepad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
157 { 0x1430, 0x4748, "RedOctane Guitar Hero X-plorer", 0, XTYPE_XBOX360 },
158 { 0x1430, 0x8888, "TX6500+ Dance Pad (first generation)", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
159 { 0x146b, 0x0601, "BigBen Interactive XBOX 360 Controller", 0, XTYPE_XBOX360 },
160 { 0x045e, 0x028e, "Microsoft X-Box 360 pad", 0, XTYPE_XBOX360 },
161 { 0x1bad, 0x0003, "Harmonix Rock Band Drumkit", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX360 },
162 { 0x0f0d, 0x0016, "Hori Real Arcade Pro.EX", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
163 { 0x0f0d, 0x000d, "Hori Fighting Stick EX2", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
164 { 0xffff, 0xffff, "Chinese-made Xbox Controller", 0, XTYPE_XBOX },
165 { 0x0000, 0x0000, "Generic X-Box pad", 0, XTYPE_UNKNOWN }
166};
167
168
169static const signed short xpad_common_btn[] = {
170 BTN_A, BTN_B, BTN_X, BTN_Y,
171 BTN_START, BTN_SELECT, BTN_THUMBL, BTN_THUMBR,
172 -1
173};
174
175
176static const signed short xpad_btn[] = {
177 BTN_C, BTN_Z,
178 -1
179};
180
181
182static const signed short xpad_btn_pad[] = {
183 BTN_TRIGGER_HAPPY1, BTN_TRIGGER_HAPPY2,
184 BTN_TRIGGER_HAPPY3, BTN_TRIGGER_HAPPY4,
185 -1
186};
187
188
189static const signed short xpad_btn_triggers[] = {
190 BTN_TL2, BTN_TR2,
191 -1
192};
193
194
195static const signed short xpad360_btn[] = {
196 BTN_TL, BTN_TR,
197 BTN_MODE,
198 -1
199};
200
201static const signed short xpad_abs[] = {
202 ABS_X, ABS_Y,
203 ABS_RX, ABS_RY,
204 -1
205};
206
207
208static const signed short xpad_abs_pad[] = {
209 ABS_HAT0X, ABS_HAT0Y,
210 -1
211};
212
213
214static const signed short xpad_abs_triggers[] = {
215 ABS_Z, ABS_RZ,
216 -1
217};
218
219
220
221
222
223#define XPAD_XBOX360_VENDOR_PROTOCOL(vend,pr) \
224 .match_flags = USB_DEVICE_ID_MATCH_VENDOR | USB_DEVICE_ID_MATCH_INT_INFO, \
225 .idVendor = (vend), \
226 .bInterfaceClass = USB_CLASS_VENDOR_SPEC, \
227 .bInterfaceSubClass = 93, \
228 .bInterfaceProtocol = (pr)
229#define XPAD_XBOX360_VENDOR(vend) \
230 { XPAD_XBOX360_VENDOR_PROTOCOL(vend,1) }, \
231 { XPAD_XBOX360_VENDOR_PROTOCOL(vend,129) }
232
233static struct usb_device_id xpad_table [] = {
234 { USB_INTERFACE_INFO('X', 'B', 0) },
235 XPAD_XBOX360_VENDOR(0x045e),
236 XPAD_XBOX360_VENDOR(0x046d),
237 XPAD_XBOX360_VENDOR(0x0738),
238 XPAD_XBOX360_VENDOR(0x0e6f),
239 XPAD_XBOX360_VENDOR(0x1430),
240 XPAD_XBOX360_VENDOR(0x146b),
241 XPAD_XBOX360_VENDOR(0x1bad),
242 XPAD_XBOX360_VENDOR(0x0f0d),
243 { }
244};
245
246MODULE_DEVICE_TABLE (usb, xpad_table);
247
248struct usb_xpad {
249 struct input_dev *dev;
250 struct usb_device *udev;
251
252 int pad_present;
253
254 struct urb *irq_in;
255 unsigned char *idata;
256 dma_addr_t idata_dma;
257
258 struct urb *bulk_out;
259 unsigned char *bdata;
260
261#if defined(CONFIG_JOYSTICK_XPAD_FF) || defined(CONFIG_JOYSTICK_XPAD_LEDS)
262 struct urb *irq_out;
263 unsigned char *odata;
264 dma_addr_t odata_dma;
265 struct mutex odata_mutex;
266#endif
267
268#if defined(CONFIG_JOYSTICK_XPAD_LEDS)
269 struct xpad_led *led;
270#endif
271
272 char phys[64];
273
274 int mapping;
275 int xtype;
276};
277
278
279
280
281
282
283
284
285
286
287
288static void xpad_process_packet(struct usb_xpad *xpad, u16 cmd, unsigned char *data)
289{
290 struct input_dev *dev = xpad->dev;
291
292 if (!(xpad->mapping & MAP_STICKS_TO_NULL)) {
293
294 input_report_abs(dev, ABS_X,
295 (__s16) le16_to_cpup((__le16 *)(data + 12)));
296 input_report_abs(dev, ABS_Y,
297 ~(__s16) le16_to_cpup((__le16 *)(data + 14)));
298
299
300 input_report_abs(dev, ABS_RX,
301 (__s16) le16_to_cpup((__le16 *)(data + 16)));
302 input_report_abs(dev, ABS_RY,
303 ~(__s16) le16_to_cpup((__le16 *)(data + 18)));
304 }
305
306
307 if (xpad->mapping & MAP_TRIGGERS_TO_BUTTONS) {
308 input_report_key(dev, BTN_TL2, data[10]);
309 input_report_key(dev, BTN_TR2, data[11]);
310 } else {
311 input_report_abs(dev, ABS_Z, data[10]);
312 input_report_abs(dev, ABS_RZ, data[11]);
313 }
314
315
316 if (xpad->mapping & MAP_DPAD_TO_BUTTONS) {
317
318 input_report_key(dev, BTN_TRIGGER_HAPPY1, data[2] & 0x04);
319 input_report_key(dev, BTN_TRIGGER_HAPPY2, data[2] & 0x08);
320 input_report_key(dev, BTN_TRIGGER_HAPPY3, data[2] & 0x01);
321 input_report_key(dev, BTN_TRIGGER_HAPPY4, data[2] & 0x02);
322 } else {
323 input_report_abs(dev, ABS_HAT0X,
324 !!(data[2] & 0x08) - !!(data[2] & 0x04));
325 input_report_abs(dev, ABS_HAT0Y,
326 !!(data[2] & 0x02) - !!(data[2] & 0x01));
327 }
328
329
330 input_report_key(dev, BTN_START, data[2] & 0x10);
331 input_report_key(dev, BTN_SELECT, data[2] & 0x20);
332 input_report_key(dev, BTN_THUMBL, data[2] & 0x40);
333 input_report_key(dev, BTN_THUMBR, data[2] & 0x80);
334
335
336 input_report_key(dev, BTN_A, data[4]);
337 input_report_key(dev, BTN_B, data[5]);
338 input_report_key(dev, BTN_X, data[6]);
339 input_report_key(dev, BTN_Y, data[7]);
340
341
342 input_report_key(dev, BTN_C, data[8]);
343 input_report_key(dev, BTN_Z, data[9]);
344
345 input_sync(dev);
346}
347
348
349
350
351
352
353
354
355
356
357
358static void xpad360_process_packet(struct usb_xpad *xpad,
359 u16 cmd, unsigned char *data)
360{
361 struct input_dev *dev = xpad->dev;
362
363
364 if (xpad->mapping & MAP_DPAD_TO_BUTTONS) {
365
366 input_report_key(dev, BTN_TRIGGER_HAPPY1, data[2] & 0x04);
367 input_report_key(dev, BTN_TRIGGER_HAPPY2, data[2] & 0x08);
368 input_report_key(dev, BTN_TRIGGER_HAPPY3, data[2] & 0x01);
369 input_report_key(dev, BTN_TRIGGER_HAPPY4, data[2] & 0x02);
370 } else {
371 input_report_abs(dev, ABS_HAT0X,
372 !!(data[2] & 0x08) - !!(data[2] & 0x04));
373 input_report_abs(dev, ABS_HAT0Y,
374 !!(data[2] & 0x02) - !!(data[2] & 0x01));
375 }
376
377
378 input_report_key(dev, BTN_START, data[2] & 0x10);
379 input_report_key(dev, BTN_SELECT, data[2] & 0x20);
380
381
382 input_report_key(dev, BTN_THUMBL, data[2] & 0x40);
383 input_report_key(dev, BTN_THUMBR, data[2] & 0x80);
384
385
386 input_report_key(dev, BTN_A, data[3] & 0x10);
387 input_report_key(dev, BTN_B, data[3] & 0x20);
388 input_report_key(dev, BTN_X, data[3] & 0x40);
389 input_report_key(dev, BTN_Y, data[3] & 0x80);
390 input_report_key(dev, BTN_TL, data[3] & 0x01);
391 input_report_key(dev, BTN_TR, data[3] & 0x02);
392 input_report_key(dev, BTN_MODE, data[3] & 0x04);
393
394 if (!(xpad->mapping & MAP_STICKS_TO_NULL)) {
395
396 input_report_abs(dev, ABS_X,
397 (__s16) le16_to_cpup((__le16 *)(data + 6)));
398 input_report_abs(dev, ABS_Y,
399 ~(__s16) le16_to_cpup((__le16 *)(data + 8)));
400
401
402 input_report_abs(dev, ABS_RX,
403 (__s16) le16_to_cpup((__le16 *)(data + 10)));
404 input_report_abs(dev, ABS_RY,
405 ~(__s16) le16_to_cpup((__le16 *)(data + 12)));
406 }
407
408
409 if (xpad->mapping & MAP_TRIGGERS_TO_BUTTONS) {
410 input_report_key(dev, BTN_TL2, data[4]);
411 input_report_key(dev, BTN_TR2, data[5]);
412 } else {
413 input_report_abs(dev, ABS_Z, data[4]);
414 input_report_abs(dev, ABS_RZ, data[5]);
415 }
416
417 input_sync(dev);
418}
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435static void xpad360w_process_packet(struct usb_xpad *xpad, u16 cmd, unsigned char *data)
436{
437
438 if (data[0] & 0x08) {
439 if (data[1] & 0x80) {
440 xpad->pad_present = 1;
441 usb_submit_urb(xpad->bulk_out, GFP_ATOMIC);
442 } else
443 xpad->pad_present = 0;
444 }
445
446
447 if (!(data[1] & 0x1))
448 return;
449
450 xpad360_process_packet(xpad, cmd, &data[4]);
451}
452
453static void xpad_irq_in(struct urb *urb)
454{
455 struct usb_xpad *xpad = urb->context;
456 int retval, status;
457
458 status = urb->status;
459
460 switch (status) {
461 case 0:
462
463 break;
464 case -ECONNRESET:
465 case -ENOENT:
466 case -ESHUTDOWN:
467
468 dbg("%s - urb shutting down with status: %d",
469 __func__, status);
470 return;
471 default:
472 dbg("%s - nonzero urb status received: %d",
473 __func__, status);
474 goto exit;
475 }
476
477 switch (xpad->xtype) {
478 case XTYPE_XBOX360:
479 xpad360_process_packet(xpad, 0, xpad->idata);
480 break;
481 case XTYPE_XBOX360W:
482 xpad360w_process_packet(xpad, 0, xpad->idata);
483 break;
484 default:
485 xpad_process_packet(xpad, 0, xpad->idata);
486 }
487
488exit:
489 retval = usb_submit_urb(urb, GFP_ATOMIC);
490 if (retval)
491 err ("%s - usb_submit_urb failed with result %d",
492 __func__, retval);
493}
494
495static void xpad_bulk_out(struct urb *urb)
496{
497 switch (urb->status) {
498 case 0:
499
500 break;
501 case -ECONNRESET:
502 case -ENOENT:
503 case -ESHUTDOWN:
504
505 dbg("%s - urb shutting down with status: %d", __func__, urb->status);
506 break;
507 default:
508 dbg("%s - nonzero urb status received: %d", __func__, urb->status);
509 }
510}
511
512#if defined(CONFIG_JOYSTICK_XPAD_FF) || defined(CONFIG_JOYSTICK_XPAD_LEDS)
513static void xpad_irq_out(struct urb *urb)
514{
515 int retval, status;
516
517 status = urb->status;
518
519 switch (status) {
520 case 0:
521
522 return;
523
524 case -ECONNRESET:
525 case -ENOENT:
526 case -ESHUTDOWN:
527
528 dbg("%s - urb shutting down with status: %d", __func__, status);
529 return;
530
531 default:
532 dbg("%s - nonzero urb status received: %d", __func__, status);
533 goto exit;
534 }
535
536exit:
537 retval = usb_submit_urb(urb, GFP_ATOMIC);
538 if (retval)
539 err("%s - usb_submit_urb failed with result %d",
540 __func__, retval);
541}
542
543static int xpad_init_output(struct usb_interface *intf, struct usb_xpad *xpad)
544{
545 struct usb_endpoint_descriptor *ep_irq_out;
546 int error;
547
548 if (xpad->xtype != XTYPE_XBOX360 && xpad->xtype != XTYPE_XBOX)
549 return 0;
550
551 xpad->odata = usb_alloc_coherent(xpad->udev, XPAD_PKT_LEN,
552 GFP_KERNEL, &xpad->odata_dma);
553 if (!xpad->odata) {
554 error = -ENOMEM;
555 goto fail1;
556 }
557
558 mutex_init(&xpad->odata_mutex);
559
560 xpad->irq_out = usb_alloc_urb(0, GFP_KERNEL);
561 if (!xpad->irq_out) {
562 error = -ENOMEM;
563 goto fail2;
564 }
565
566 ep_irq_out = &intf->cur_altsetting->endpoint[1].desc;
567 usb_fill_int_urb(xpad->irq_out, xpad->udev,
568 usb_sndintpipe(xpad->udev, ep_irq_out->bEndpointAddress),
569 xpad->odata, XPAD_PKT_LEN,
570 xpad_irq_out, xpad, ep_irq_out->bInterval);
571 xpad->irq_out->transfer_dma = xpad->odata_dma;
572 xpad->irq_out->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
573
574 return 0;
575
576 fail2: usb_free_coherent(xpad->udev, XPAD_PKT_LEN, xpad->odata, xpad->odata_dma);
577 fail1: return error;
578}
579
580static void xpad_stop_output(struct usb_xpad *xpad)
581{
582 if (xpad->xtype == XTYPE_XBOX360 || xpad->xtype == XTYPE_XBOX)
583 usb_kill_urb(xpad->irq_out);
584}
585
586static void xpad_deinit_output(struct usb_xpad *xpad)
587{
588 if (xpad->xtype == XTYPE_XBOX360 || xpad->xtype == XTYPE_XBOX) {
589 usb_free_urb(xpad->irq_out);
590 usb_free_coherent(xpad->udev, XPAD_PKT_LEN,
591 xpad->odata, xpad->odata_dma);
592 }
593}
594#else
595static int xpad_init_output(struct usb_interface *intf, struct usb_xpad *xpad) { return 0; }
596static void xpad_deinit_output(struct usb_xpad *xpad) {}
597static void xpad_stop_output(struct usb_xpad *xpad) {}
598#endif
599
600#ifdef CONFIG_JOYSTICK_XPAD_FF
601static int xpad_play_effect(struct input_dev *dev, void *data, struct ff_effect *effect)
602{
603 struct usb_xpad *xpad = input_get_drvdata(dev);
604
605 if (effect->type == FF_RUMBLE) {
606 __u16 strong = effect->u.rumble.strong_magnitude;
607 __u16 weak = effect->u.rumble.weak_magnitude;
608
609 switch (xpad->xtype) {
610
611 case XTYPE_XBOX:
612 xpad->odata[0] = 0x00;
613 xpad->odata[1] = 0x06;
614 xpad->odata[2] = 0x00;
615 xpad->odata[3] = strong / 256;
616 xpad->odata[4] = 0x00;
617 xpad->odata[5] = weak / 256;
618 xpad->irq_out->transfer_buffer_length = 6;
619
620 return usb_submit_urb(xpad->irq_out, GFP_ATOMIC);
621
622 case XTYPE_XBOX360:
623 xpad->odata[0] = 0x00;
624 xpad->odata[1] = 0x08;
625 xpad->odata[2] = 0x00;
626 xpad->odata[3] = strong / 256;
627 xpad->odata[4] = weak / 256;
628 xpad->odata[5] = 0x00;
629 xpad->odata[6] = 0x00;
630 xpad->odata[7] = 0x00;
631 xpad->irq_out->transfer_buffer_length = 8;
632
633 return usb_submit_urb(xpad->irq_out, GFP_ATOMIC);
634
635 default:
636 dbg("%s - rumble command sent to unsupported xpad type: %d",
637 __func__, xpad->xtype);
638 return -1;
639 }
640 }
641
642 return 0;
643}
644
645static int xpad_init_ff(struct usb_xpad *xpad)
646{
647 if (xpad->xtype != XTYPE_XBOX360 && xpad->xtype != XTYPE_XBOX)
648 return 0;
649
650 input_set_capability(xpad->dev, EV_FF, FF_RUMBLE);
651
652 return input_ff_create_memless(xpad->dev, NULL, xpad_play_effect);
653}
654
655#else
656static int xpad_init_ff(struct usb_xpad *xpad) { return 0; }
657#endif
658
659#if defined(CONFIG_JOYSTICK_XPAD_LEDS)
660#include <linux/leds.h>
661
662struct xpad_led {
663 char name[16];
664 struct led_classdev led_cdev;
665 struct usb_xpad *xpad;
666};
667
668static void xpad_send_led_command(struct usb_xpad *xpad, int command)
669{
670 if (command >= 0 && command < 14) {
671 mutex_lock(&xpad->odata_mutex);
672 xpad->odata[0] = 0x01;
673 xpad->odata[1] = 0x03;
674 xpad->odata[2] = command;
675 xpad->irq_out->transfer_buffer_length = 3;
676 usb_submit_urb(xpad->irq_out, GFP_KERNEL);
677 mutex_unlock(&xpad->odata_mutex);
678 }
679}
680
681static void xpad_led_set(struct led_classdev *led_cdev,
682 enum led_brightness value)
683{
684 struct xpad_led *xpad_led = container_of(led_cdev,
685 struct xpad_led, led_cdev);
686
687 xpad_send_led_command(xpad_led->xpad, value);
688}
689
690static int xpad_led_probe(struct usb_xpad *xpad)
691{
692 static atomic_t led_seq = ATOMIC_INIT(0);
693 long led_no;
694 struct xpad_led *led;
695 struct led_classdev *led_cdev;
696 int error;
697
698 if (xpad->xtype != XTYPE_XBOX360)
699 return 0;
700
701 xpad->led = led = kzalloc(sizeof(struct xpad_led), GFP_KERNEL);
702 if (!led)
703 return -ENOMEM;
704
705 led_no = (long)atomic_inc_return(&led_seq) - 1;
706
707 snprintf(led->name, sizeof(led->name), "xpad%ld", led_no);
708 led->xpad = xpad;
709
710 led_cdev = &led->led_cdev;
711 led_cdev->name = led->name;
712 led_cdev->brightness_set = xpad_led_set;
713
714 error = led_classdev_register(&xpad->udev->dev, led_cdev);
715 if (error) {
716 kfree(led);
717 xpad->led = NULL;
718 return error;
719 }
720
721
722
723
724 xpad_send_led_command(xpad, (led_no % 4) + 2);
725
726 return 0;
727}
728
729static void xpad_led_disconnect(struct usb_xpad *xpad)
730{
731 struct xpad_led *xpad_led = xpad->led;
732
733 if (xpad_led) {
734 led_classdev_unregister(&xpad_led->led_cdev);
735 kfree(xpad_led);
736 }
737}
738#else
739static int xpad_led_probe(struct usb_xpad *xpad) { return 0; }
740static void xpad_led_disconnect(struct usb_xpad *xpad) { }
741#endif
742
743
744static int xpad_open(struct input_dev *dev)
745{
746 struct usb_xpad *xpad = input_get_drvdata(dev);
747
748
749 if(xpad->xtype == XTYPE_XBOX360W)
750 return 0;
751
752 xpad->irq_in->dev = xpad->udev;
753 if (usb_submit_urb(xpad->irq_in, GFP_KERNEL))
754 return -EIO;
755
756 return 0;
757}
758
759static void xpad_close(struct input_dev *dev)
760{
761 struct usb_xpad *xpad = input_get_drvdata(dev);
762
763 if (xpad->xtype != XTYPE_XBOX360W)
764 usb_kill_urb(xpad->irq_in);
765
766 xpad_stop_output(xpad);
767}
768
769static void xpad_set_up_abs(struct input_dev *input_dev, signed short abs)
770{
771 set_bit(abs, input_dev->absbit);
772
773 switch (abs) {
774 case ABS_X:
775 case ABS_Y:
776 case ABS_RX:
777 case ABS_RY:
778 input_set_abs_params(input_dev, abs, -32768, 32767, 16, 128);
779 break;
780 case ABS_Z:
781 case ABS_RZ:
782 input_set_abs_params(input_dev, abs, 0, 255, 0, 0);
783 break;
784 case ABS_HAT0X:
785 case ABS_HAT0Y:
786 input_set_abs_params(input_dev, abs, -1, 1, 0, 0);
787 break;
788 }
789}
790
791static int xpad_probe(struct usb_interface *intf, const struct usb_device_id *id)
792{
793 struct usb_device *udev = interface_to_usbdev(intf);
794 struct usb_xpad *xpad;
795 struct input_dev *input_dev;
796 struct usb_endpoint_descriptor *ep_irq_in;
797 int i, error;
798
799 for (i = 0; xpad_device[i].idVendor; i++) {
800 if ((le16_to_cpu(udev->descriptor.idVendor) == xpad_device[i].idVendor) &&
801 (le16_to_cpu(udev->descriptor.idProduct) == xpad_device[i].idProduct))
802 break;
803 }
804
805 xpad = kzalloc(sizeof(struct usb_xpad), GFP_KERNEL);
806 input_dev = input_allocate_device();
807 if (!xpad || !input_dev) {
808 error = -ENOMEM;
809 goto fail1;
810 }
811
812 xpad->idata = usb_alloc_coherent(udev, XPAD_PKT_LEN,
813 GFP_KERNEL, &xpad->idata_dma);
814 if (!xpad->idata) {
815 error = -ENOMEM;
816 goto fail1;
817 }
818
819 xpad->irq_in = usb_alloc_urb(0, GFP_KERNEL);
820 if (!xpad->irq_in) {
821 error = -ENOMEM;
822 goto fail2;
823 }
824
825 xpad->udev = udev;
826 xpad->mapping = xpad_device[i].mapping;
827 xpad->xtype = xpad_device[i].xtype;
828
829 if (xpad->xtype == XTYPE_UNKNOWN) {
830 if (intf->cur_altsetting->desc.bInterfaceClass == USB_CLASS_VENDOR_SPEC) {
831 if (intf->cur_altsetting->desc.bInterfaceProtocol == 129)
832 xpad->xtype = XTYPE_XBOX360W;
833 else
834 xpad->xtype = XTYPE_XBOX360;
835 } else
836 xpad->xtype = XTYPE_XBOX;
837
838 if (dpad_to_buttons)
839 xpad->mapping |= MAP_DPAD_TO_BUTTONS;
840 if (triggers_to_buttons)
841 xpad->mapping |= MAP_TRIGGERS_TO_BUTTONS;
842 if (sticks_to_null)
843 xpad->mapping |= MAP_STICKS_TO_NULL;
844 }
845
846 xpad->dev = input_dev;
847 usb_make_path(udev, xpad->phys, sizeof(xpad->phys));
848 strlcat(xpad->phys, "/input0", sizeof(xpad->phys));
849
850 input_dev->name = xpad_device[i].name;
851 input_dev->phys = xpad->phys;
852 usb_to_input_id(udev, &input_dev->id);
853 input_dev->dev.parent = &intf->dev;
854
855 input_set_drvdata(input_dev, xpad);
856
857 input_dev->open = xpad_open;
858 input_dev->close = xpad_close;
859
860 input_dev->evbit[0] = BIT_MASK(EV_KEY);
861
862 if (!(xpad->mapping & MAP_STICKS_TO_NULL)) {
863 input_dev->evbit[0] |= BIT_MASK(EV_ABS);
864
865 for (i = 0; xpad_abs[i] >= 0; i++)
866 xpad_set_up_abs(input_dev, xpad_abs[i]);
867 }
868
869
870 for (i = 0; xpad_common_btn[i] >= 0; i++)
871 __set_bit(xpad_common_btn[i], input_dev->keybit);
872
873
874 if (xpad->xtype == XTYPE_XBOX360 || xpad->xtype == XTYPE_XBOX360W) {
875 for (i = 0; xpad360_btn[i] >= 0; i++)
876 __set_bit(xpad360_btn[i], input_dev->keybit);
877 } else {
878 for (i = 0; xpad_btn[i] >= 0; i++)
879 __set_bit(xpad_btn[i], input_dev->keybit);
880 }
881
882 if (xpad->mapping & MAP_DPAD_TO_BUTTONS) {
883 for (i = 0; xpad_btn_pad[i] >= 0; i++)
884 __set_bit(xpad_btn_pad[i], input_dev->keybit);
885 } else {
886 for (i = 0; xpad_abs_pad[i] >= 0; i++)
887 xpad_set_up_abs(input_dev, xpad_abs_pad[i]);
888 }
889
890 if (xpad->mapping & MAP_TRIGGERS_TO_BUTTONS) {
891 for (i = 0; xpad_btn_triggers[i] >= 0; i++)
892 __set_bit(xpad_btn_triggers[i], input_dev->keybit);
893 } else {
894 for (i = 0; xpad_abs_triggers[i] >= 0; i++)
895 xpad_set_up_abs(input_dev, xpad_abs_triggers[i]);
896 }
897
898 error = xpad_init_output(intf, xpad);
899 if (error)
900 goto fail3;
901
902 error = xpad_init_ff(xpad);
903 if (error)
904 goto fail4;
905
906 error = xpad_led_probe(xpad);
907 if (error)
908 goto fail5;
909
910 ep_irq_in = &intf->cur_altsetting->endpoint[0].desc;
911 usb_fill_int_urb(xpad->irq_in, udev,
912 usb_rcvintpipe(udev, ep_irq_in->bEndpointAddress),
913 xpad->idata, XPAD_PKT_LEN, xpad_irq_in,
914 xpad, ep_irq_in->bInterval);
915 xpad->irq_in->transfer_dma = xpad->idata_dma;
916 xpad->irq_in->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
917
918 error = input_register_device(xpad->dev);
919 if (error)
920 goto fail6;
921
922 usb_set_intfdata(intf, xpad);
923
924 if (xpad->xtype == XTYPE_XBOX360W) {
925
926
927
928
929 xpad->bulk_out = usb_alloc_urb(0, GFP_KERNEL);
930 if (!xpad->bulk_out) {
931 error = -ENOMEM;
932 goto fail7;
933 }
934
935 xpad->bdata = kzalloc(XPAD_PKT_LEN, GFP_KERNEL);
936 if (!xpad->bdata) {
937 error = -ENOMEM;
938 goto fail8;
939 }
940
941 xpad->bdata[2] = 0x08;
942 switch (intf->cur_altsetting->desc.bInterfaceNumber) {
943 case 0:
944 xpad->bdata[3] = 0x42;
945 break;
946 case 2:
947 xpad->bdata[3] = 0x43;
948 break;
949 case 4:
950 xpad->bdata[3] = 0x44;
951 break;
952 case 6:
953 xpad->bdata[3] = 0x45;
954 }
955
956 ep_irq_in = &intf->cur_altsetting->endpoint[1].desc;
957 usb_fill_bulk_urb(xpad->bulk_out, udev,
958 usb_sndbulkpipe(udev, ep_irq_in->bEndpointAddress),
959 xpad->bdata, XPAD_PKT_LEN, xpad_bulk_out, xpad);
960
961
962
963
964
965
966
967
968 xpad->irq_in->dev = xpad->udev;
969 error = usb_submit_urb(xpad->irq_in, GFP_KERNEL);
970 if (error)
971 goto fail9;
972 }
973
974 return 0;
975
976 fail9: kfree(xpad->bdata);
977 fail8: usb_free_urb(xpad->bulk_out);
978 fail7: input_unregister_device(input_dev);
979 input_dev = NULL;
980 fail6: xpad_led_disconnect(xpad);
981 fail5: if (input_dev)
982 input_ff_destroy(input_dev);
983 fail4: xpad_deinit_output(xpad);
984 fail3: usb_free_urb(xpad->irq_in);
985 fail2: usb_free_coherent(udev, XPAD_PKT_LEN, xpad->idata, xpad->idata_dma);
986 fail1: input_free_device(input_dev);
987 kfree(xpad);
988 return error;
989
990}
991
992static void xpad_disconnect(struct usb_interface *intf)
993{
994 struct usb_xpad *xpad = usb_get_intfdata (intf);
995
996 xpad_led_disconnect(xpad);
997 input_unregister_device(xpad->dev);
998 xpad_deinit_output(xpad);
999
1000 if (xpad->xtype == XTYPE_XBOX360W) {
1001 usb_kill_urb(xpad->bulk_out);
1002 usb_free_urb(xpad->bulk_out);
1003 usb_kill_urb(xpad->irq_in);
1004 }
1005
1006 usb_free_urb(xpad->irq_in);
1007 usb_free_coherent(xpad->udev, XPAD_PKT_LEN,
1008 xpad->idata, xpad->idata_dma);
1009
1010 kfree(xpad->bdata);
1011 kfree(xpad);
1012
1013 usb_set_intfdata(intf, NULL);
1014}
1015
1016static struct usb_driver xpad_driver = {
1017 .name = "xpad",
1018 .probe = xpad_probe,
1019 .disconnect = xpad_disconnect,
1020 .id_table = xpad_table,
1021};
1022
1023static int __init usb_xpad_init(void)
1024{
1025 return usb_register(&xpad_driver);
1026}
1027
1028static void __exit usb_xpad_exit(void)
1029{
1030 usb_deregister(&xpad_driver);
1031}
1032
1033module_init(usb_xpad_init);
1034module_exit(usb_xpad_exit);
1035
1036MODULE_AUTHOR(DRIVER_AUTHOR);
1037MODULE_DESCRIPTION(DRIVER_DESC);
1038MODULE_LICENSE("GPL");
1039