Guest User

xpad.c

a guest
Jan 6th, 2022
75
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 68.79 KB | None | 0 0
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * X-Box gamepad driver
  4. *
  5. * Copyright (c) 2002 Marko Friedemann <[email protected]>
  6. * 2004 Oliver Schwartz <[email protected]>,
  7. * Steven Toth <[email protected]>,
  8. * Franz Lehner <[email protected]>,
  9. * Ivan Hawkes <[email protected]>
  10. * 2005 Dominic Cerquetti <[email protected]>
  11. * 2006 Adam Buchbinder <[email protected]>
  12. * 2007 Jan Kratochvil <[email protected]>
  13. * 2010 Christoph Fritz <[email protected]>
  14. *
  15. * This driver is based on:
  16. * - information from http://euc.jp/periphs/xbox-controller.ja.html
  17. * - the iForce driver drivers/char/joystick/iforce.c
  18. * - the skeleton-driver drivers/usb/usb-skeleton.c
  19. * - Xbox 360 information http://www.free60.org/wiki/Gamepad
  20. * - Xbox One information https://github.com/quantus/xbox-one-controller-protocol
  21. *
  22. * Thanks to:
  23. * - ITO Takayuki for providing essential xpad information on his website
  24. * - Vojtech Pavlik - iforce driver / input subsystem
  25. * - Greg Kroah-Hartman - usb-skeleton driver
  26. * - XBOX Linux project - extra USB id's
  27. * - Pekka Pöyry (quantus) - Xbox One controller reverse engineering
  28. *
  29. * TODO:
  30. * - fine tune axes (especially trigger axes)
  31. * - fix "analog" buttons (reported as digital now)
  32. * - get rumble working
  33. * - need USB IDs for other dance pads
  34. *
  35. * History:
  36. *
  37. * 2002-06-27 - 0.0.1 : first version, just said "XBOX HID controller"
  38. *
  39. * 2002-07-02 - 0.0.2 : basic working version
  40. * - all axes and 9 of the 10 buttons work (german InterAct device)
  41. * - the black button does not work
  42. *
  43. * 2002-07-14 - 0.0.3 : rework by Vojtech Pavlik
  44. * - indentation fixes
  45. * - usb + input init sequence fixes
  46. *
  47. * 2002-07-16 - 0.0.4 : minor changes, merge with Vojtech's v0.0.3
  48. * - verified the lack of HID and report descriptors
  49. * - verified that ALL buttons WORK
  50. * - fixed d-pad to axes mapping
  51. *
  52. * 2002-07-17 - 0.0.5 : simplified d-pad handling
  53. *
  54. * 2004-10-02 - 0.0.6 : DDR pad support
  55. * - borrowed from the XBOX linux kernel
  56. * - USB id's for commonly used dance pads are present
  57. * - dance pads will map D-PAD to buttons, not axes
  58. * - pass the module paramater 'dpad_to_buttons' to force
  59. * the D-PAD to map to buttons if your pad is not detected
  60. *
  61. * Later changes can be tracked in SCM.
  62. */
  63. // #define DEBUG
  64. #include <linux/kernel.h>
  65. #include <linux/input.h>
  66. #include <linux/rcupdate.h>
  67. #include <linux/slab.h>
  68. #include <linux/stat.h>
  69. #include <linux/module.h>
  70. #include <linux/usb/input.h>
  71. #include <linux/usb/quirks.h>
  72.  
  73. #define XPAD_PKT_LEN 64
  74.  
  75. /*
  76. * xbox d-pads should map to buttons, as is required for DDR pads
  77. * but we map them to axes when possible to simplify things
  78. */
  79. #define MAP_DPAD_TO_BUTTONS (1 << 0)
  80. #define MAP_TRIGGERS_TO_BUTTONS (1 << 1)
  81. #define MAP_STICKS_TO_NULL (1 << 2)
  82. #define MAP_SELECT_BUTTON (1 << 3)
  83. #define DANCEPAD_MAP_CONFIG (MAP_DPAD_TO_BUTTONS | \
  84. MAP_TRIGGERS_TO_BUTTONS | MAP_STICKS_TO_NULL)
  85.  
  86. #define XTYPE_XBOX 0
  87. #define XTYPE_XBOX360 1
  88. #define XTYPE_XBOX360W 2
  89. #define XTYPE_XBOXONE 3
  90. #define XTYPE_UNKNOWN 4
  91.  
  92. static bool dpad_to_buttons;
  93. module_param(dpad_to_buttons, bool, S_IRUGO);
  94. MODULE_PARM_DESC(dpad_to_buttons, "Map D-PAD to buttons rather than axes for unknown pads");
  95.  
  96. static bool triggers_to_buttons;
  97. module_param(triggers_to_buttons, bool, S_IRUGO);
  98. MODULE_PARM_DESC(triggers_to_buttons, "Map triggers to buttons rather than axes for unknown pads");
  99.  
  100. static bool sticks_to_null;
  101. module_param(sticks_to_null, bool, S_IRUGO);
  102. MODULE_PARM_DESC(sticks_to_null, "Do not map sticks at all for unknown pads");
  103.  
  104. static bool auto_poweroff = true;
  105. module_param(auto_poweroff, bool, S_IWUSR | S_IRUGO);
  106. MODULE_PARM_DESC(auto_poweroff, "Power off wireless controllers on suspend");
  107.  
  108. static const struct xpad_device {
  109. u16 idVendor;
  110. u16 idProduct;
  111. char *name;
  112. u8 mapping;
  113. u8 xtype;
  114. } xpad_device[] = {
  115. { 0x0079, 0x18d4, "GPD Win 2 X-Box Controller", 0, XTYPE_XBOX360 },
  116. { 0x044f, 0x0f00, "Thrustmaster Wheel", 0, XTYPE_XBOX },
  117. { 0x044f, 0x0f03, "Thrustmaster Wheel", 0, XTYPE_XBOX },
  118. { 0x044f, 0x0f07, "Thrustmaster, Inc. Controller", 0, XTYPE_XBOX },
  119. { 0x044f, 0x0f10, "Thrustmaster Modena GT Wheel", 0, XTYPE_XBOX },
  120. { 0x044f, 0xb326, "Thrustmaster Gamepad GP XID", 0, XTYPE_XBOX360 },
  121. { 0x045e, 0x0202, "Microsoft X-Box pad v1 (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, 0x0288, "Microsoft Xbox Controller S v2", 0, XTYPE_XBOX },
  125. { 0x045e, 0x0289, "Microsoft X-Box pad v2 (US)", 0, XTYPE_XBOX },
  126. { 0x045e, 0x028e, "Microsoft X-Box 360 pad", 0, XTYPE_XBOX360 },
  127. { 0x045e, 0x028f, "Microsoft X-Box 360 pad v2", 0, XTYPE_XBOX360 },
  128. { 0x045e, 0x0291, "Xbox 360 Wireless Receiver (XBOX)", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX360W },
  129. { 0x045e, 0x02d1, "Microsoft X-Box One pad", 0, XTYPE_XBOXONE },
  130. { 0x045e, 0x02dd, "Microsoft X-Box One pad (Firmware 2015)", 0, XTYPE_XBOXONE },
  131. { 0x045e, 0x02e3, "Microsoft X-Box One Elite pad", 0, XTYPE_XBOXONE },
  132. { 0x045e, 0x02ea, "Microsoft X-Box One S pad", 0, XTYPE_XBOXONE },
  133. { 0x045e, 0x0719, "Xbox 360 Wireless Receiver", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX360W },
  134. { 0x045e, 0x0b12, "Microsoft Xbox One X pad", MAP_SELECT_BUTTON, XTYPE_XBOXONE },
  135. { 0x046d, 0xc21d, "Logitech Gamepad F310", 0, XTYPE_XBOX360 },
  136. { 0x046d, 0xc21e, "Logitech Gamepad F510", 0, XTYPE_XBOX360 },
  137. { 0x046d, 0xc21f, "Logitech Gamepad F710", 0, XTYPE_XBOX360 },
  138. { 0x046d, 0xc242, "Logitech Chillstream Controller", 0, XTYPE_XBOX360 },
  139. { 0x046d, 0xca84, "Logitech Xbox Cordless Controller", 0, XTYPE_XBOX },
  140. { 0x046d, 0xca88, "Logitech Compact Controller for Xbox", 0, XTYPE_XBOX },
  141. { 0x046d, 0xca8a, "Logitech Precision Vibration Feedback Wheel", 0, XTYPE_XBOX },
  142. { 0x046d, 0xcaa3, "Logitech DriveFx Racing Wheel", 0, XTYPE_XBOX360 },
  143. { 0x056e, 0x2004, "Elecom JC-U3613M", 0, XTYPE_XBOX360 },
  144. { 0x05fd, 0x1007, "Mad Catz Controller (unverified)", 0, XTYPE_XBOX },
  145. { 0x05fd, 0x107a, "InterAct 'PowerPad Pro' X-Box pad (Germany)", 0, XTYPE_XBOX },
  146. { 0x05fe, 0x3030, "Chic Controller", 0, XTYPE_XBOX },
  147. { 0x05fe, 0x3031, "Chic Controller", 0, XTYPE_XBOX },
  148. { 0x062a, 0x0020, "Logic3 Xbox GamePad", 0, XTYPE_XBOX },
  149. { 0x062a, 0x0033, "Competition Pro Steering Wheel", 0, XTYPE_XBOX },
  150. { 0x06a3, 0x0200, "Saitek Racing Wheel", 0, XTYPE_XBOX },
  151. { 0x06a3, 0x0201, "Saitek Adrenalin", 0, XTYPE_XBOX },
  152. { 0x06a3, 0xf51a, "Saitek P3600", 0, XTYPE_XBOX360 },
  153. { 0x0738, 0x4506, "Mad Catz 4506 Wireless Controller", 0, XTYPE_XBOX },
  154. { 0x0738, 0x4516, "Mad Catz Control Pad", 0, XTYPE_XBOX },
  155. { 0x0738, 0x4520, "Mad Catz Control Pad Pro", 0, XTYPE_XBOX },
  156. { 0x0738, 0x4522, "Mad Catz LumiCON", 0, XTYPE_XBOX },
  157. { 0x0738, 0x4526, "Mad Catz Control Pad Pro", 0, XTYPE_XBOX },
  158. { 0x0738, 0x4530, "Mad Catz Universal MC2 Racing Wheel and Pedals", 0, XTYPE_XBOX },
  159. { 0x0738, 0x4536, "Mad Catz MicroCON", 0, XTYPE_XBOX },
  160. { 0x0738, 0x4540, "Mad Catz Beat Pad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
  161. { 0x0738, 0x4556, "Mad Catz Lynx Wireless Controller", 0, XTYPE_XBOX },
  162. { 0x0738, 0x4586, "Mad Catz MicroCon Wireless Controller", 0, XTYPE_XBOX },
  163. { 0x0738, 0x4588, "Mad Catz Blaster", 0, XTYPE_XBOX },
  164. { 0x0738, 0x45ff, "Mad Catz Beat Pad (w/ Handle)", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
  165. { 0x0738, 0x4716, "Mad Catz Wired Xbox 360 Controller", 0, XTYPE_XBOX360 },
  166. { 0x0738, 0x4718, "Mad Catz Street Fighter IV FightStick SE", 0, XTYPE_XBOX360 },
  167. { 0x0738, 0x4726, "Mad Catz Xbox 360 Controller", 0, XTYPE_XBOX360 },
  168. { 0x0738, 0x4728, "Mad Catz Street Fighter IV FightPad", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  169. { 0x0738, 0x4736, "Mad Catz MicroCon Gamepad", 0, XTYPE_XBOX360 },
  170. { 0x0738, 0x4738, "Mad Catz Wired Xbox 360 Controller (SFIV)", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  171. { 0x0738, 0x4740, "Mad Catz Beat Pad", 0, XTYPE_XBOX360 },
  172. { 0x0738, 0x4743, "Mad Catz Beat Pad Pro", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
  173. { 0x0738, 0x4758, "Mad Catz Arcade Game Stick", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  174. { 0x0738, 0x4a01, "Mad Catz FightStick TE 2", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOXONE },
  175. { 0x0738, 0x6040, "Mad Catz Beat Pad Pro", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
  176. { 0x0738, 0x9871, "Mad Catz Portable Drum", 0, XTYPE_XBOX360 },
  177. { 0x0738, 0xb726, "Mad Catz Xbox controller - MW2", 0, XTYPE_XBOX360 },
  178. { 0x0738, 0xb738, "Mad Catz MVC2TE Stick 2", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  179. { 0x0738, 0xbeef, "Mad Catz JOYTECH NEO SE Advanced GamePad", XTYPE_XBOX360 },
  180. { 0x0738, 0xcb02, "Saitek Cyborg Rumble Pad - PC/Xbox 360", 0, XTYPE_XBOX360 },
  181. { 0x0738, 0xcb03, "Saitek P3200 Rumble Pad - PC/Xbox 360", 0, XTYPE_XBOX360 },
  182. { 0x0738, 0xcb29, "Saitek Aviator Stick AV8R02", 0, XTYPE_XBOX360 },
  183. { 0x0738, 0xf738, "Super SFIV FightStick TE S", 0, XTYPE_XBOX360 },
  184. { 0x07ff, 0xffff, "Mad Catz GamePad", 0, XTYPE_XBOX360 },
  185. { 0x0c12, 0x0005, "Intec wireless", 0, XTYPE_XBOX },
  186. { 0x0c12, 0x8801, "Nyko Xbox Controller", 0, XTYPE_XBOX },
  187. { 0x0c12, 0x8802, "Zeroplus Xbox Controller", 0, XTYPE_XBOX },
  188. { 0x0c12, 0x8809, "RedOctane Xbox Dance Pad", DANCEPAD_MAP_CONFIG, XTYPE_XBOX },
  189. { 0x0c12, 0x880a, "Pelican Eclipse PL-2023", 0, XTYPE_XBOX },
  190. { 0x0c12, 0x8810, "Zeroplus Xbox Controller", 0, XTYPE_XBOX },
  191. { 0x0c12, 0x9902, "HAMA VibraX - *FAULTY HARDWARE*", 0, XTYPE_XBOX },
  192. { 0x0d2f, 0x0002, "Andamiro Pump It Up pad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
  193. { 0x0e4c, 0x1097, "Radica Gamester Controller", 0, XTYPE_XBOX },
  194. { 0x0e4c, 0x1103, "Radica Gamester Reflex", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX },
  195. { 0x0e4c, 0x2390, "Radica Games Jtech Controller", 0, XTYPE_XBOX },
  196. { 0x0e4c, 0x3510, "Radica Gamester", 0, XTYPE_XBOX },
  197. { 0x0e6f, 0x0003, "Logic3 Freebird wireless Controller", 0, XTYPE_XBOX },
  198. { 0x0e6f, 0x0005, "Eclipse wireless Controller", 0, XTYPE_XBOX },
  199. { 0x0e6f, 0x0006, "Edge wireless Controller", 0, XTYPE_XBOX },
  200. { 0x0e6f, 0x0008, "After Glow Pro Controller", 0, XTYPE_XBOX },
  201. { 0x0e6f, 0x0105, "HSM3 Xbox360 dancepad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX360 },
  202. { 0x0e6f, 0x0113, "Afterglow AX.1 Gamepad for Xbox 360", 0, XTYPE_XBOX360 },
  203. { 0x0e6f, 0x011f, "Rock Candy Gamepad Wired Controller", 0, XTYPE_XBOX360 },
  204. { 0x0e6f, 0x0131, "PDP EA Sports Controller", 0, XTYPE_XBOX360 },
  205. { 0x0e6f, 0x0133, "Xbox 360 Wired Controller", 0, XTYPE_XBOX360 },
  206. { 0x0e6f, 0x0139, "Afterglow Prismatic Wired Controller", 0, XTYPE_XBOXONE },
  207. { 0x0e6f, 0x013a, "PDP Xbox One Controller", 0, XTYPE_XBOXONE },
  208. { 0x0e6f, 0x0146, "Rock Candy Wired Controller for Xbox One", 0, XTYPE_XBOXONE },
  209. { 0x0e6f, 0x0147, "PDP Marvel Xbox One Controller", 0, XTYPE_XBOXONE },
  210. { 0x0e6f, 0x015c, "PDP Xbox One Arcade Stick", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOXONE },
  211. { 0x0e6f, 0x0161, "PDP Xbox One Controller", 0, XTYPE_XBOXONE },
  212. { 0x0e6f, 0x0162, "PDP Xbox One Controller", 0, XTYPE_XBOXONE },
  213. { 0x0e6f, 0x0163, "PDP Xbox One Controller", 0, XTYPE_XBOXONE },
  214. { 0x0e6f, 0x0164, "PDP Battlefield One", 0, XTYPE_XBOXONE },
  215. { 0x0e6f, 0x0165, "PDP Titanfall 2", 0, XTYPE_XBOXONE },
  216. { 0x0e6f, 0x0201, "Pelican PL-3601 'TSZ' Wired Xbox 360 Controller", 0, XTYPE_XBOX360 },
  217. { 0x0e6f, 0x0213, "Afterglow Gamepad for Xbox 360", 0, XTYPE_XBOX360 },
  218. { 0x0e6f, 0x021f, "Rock Candy Gamepad for Xbox 360", 0, XTYPE_XBOX360 },
  219. { 0x0e6f, 0x0246, "Rock Candy Gamepad for Xbox One 2015", 0, XTYPE_XBOXONE },
  220. { 0x0e6f, 0x02a0, "PDP Xbox One Controller", 0, XTYPE_XBOXONE },
  221. { 0x0e6f, 0x02a1, "PDP Xbox One Controller", 0, XTYPE_XBOXONE },
  222. { 0x0e6f, 0x02a2, "PDP Wired Controller for Xbox One - Crimson Red", 0, XTYPE_XBOXONE },
  223. { 0x0e6f, 0x02a4, "PDP Wired Controller for Xbox One - Stealth Series", 0, XTYPE_XBOXONE },
  224. { 0x0e6f, 0x02a6, "PDP Wired Controller for Xbox One - Camo Series", 0, XTYPE_XBOXONE },
  225. { 0x0e6f, 0x02a7, "PDP Xbox One Controller", 0, XTYPE_XBOXONE },
  226. { 0x0e6f, 0x02a8, "PDP Xbox One Controller", 0, XTYPE_XBOXONE },
  227. { 0x0e6f, 0x02ab, "PDP Controller for Xbox One", 0, XTYPE_XBOXONE },
  228. { 0x0e6f, 0x02ad, "PDP Wired Controller for Xbox One - Stealth Series", 0, XTYPE_XBOXONE },
  229. { 0x0e6f, 0x02b3, "Afterglow Prismatic Wired Controller", 0, XTYPE_XBOXONE },
  230. { 0x0e6f, 0x02b8, "Afterglow Prismatic Wired Controller", 0, XTYPE_XBOXONE },
  231. { 0x0e6f, 0x0301, "Logic3 Controller", 0, XTYPE_XBOX360 },
  232. { 0x0e6f, 0x0346, "Rock Candy Gamepad for Xbox One 2016", 0, XTYPE_XBOXONE },
  233. { 0x0e6f, 0x0401, "Logic3 Controller", 0, XTYPE_XBOX360 },
  234. { 0x0e6f, 0x0413, "Afterglow AX.1 Gamepad for Xbox 360", 0, XTYPE_XBOX360 },
  235. { 0x0e6f, 0x0501, "PDP Xbox 360 Controller", 0, XTYPE_XBOX360 },
  236. { 0x0e6f, 0xf900, "PDP Afterglow AX.1", 0, XTYPE_XBOX360 },
  237. { 0x0e8f, 0x0201, "SmartJoy Frag Xpad/PS2 adaptor", 0, XTYPE_XBOX },
  238. { 0x0e8f, 0x3008, "Generic xbox control (dealextreme)", 0, XTYPE_XBOX },
  239. { 0x0f0d, 0x000a, "Hori Co. DOA4 FightStick", 0, XTYPE_XBOX360 },
  240. { 0x0f0d, 0x000c, "Hori PadEX Turbo", 0, XTYPE_XBOX360 },
  241. { 0x0f0d, 0x000d, "Hori Fighting Stick EX2", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  242. { 0x0f0d, 0x0016, "Hori Real Arcade Pro.EX", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  243. { 0x0f0d, 0x001b, "Hori Real Arcade Pro VX", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  244. { 0x0f0d, 0x0063, "Hori Real Arcade Pro Hayabusa (USA) Xbox One", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOXONE },
  245. { 0x0f0d, 0x0067, "HORIPAD ONE", 0, XTYPE_XBOXONE },
  246. { 0x0f0d, 0x0078, "Hori Real Arcade Pro V Kai Xbox One", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOXONE },
  247. { 0x0f30, 0x010b, "Philips Recoil", 0, XTYPE_XBOX },
  248. { 0x0f30, 0x0202, "Joytech Advanced Controller", 0, XTYPE_XBOX },
  249. { 0x0f30, 0x8888, "BigBen XBMiniPad Controller", 0, XTYPE_XBOX },
  250. { 0x102c, 0xff0c, "Joytech Wireless Advanced Controller", 0, XTYPE_XBOX },
  251. { 0x1038, 0x1430, "SteelSeries Stratus Duo", 0, XTYPE_XBOX360 },
  252. { 0x1038, 0x1431, "SteelSeries Stratus Duo", 0, XTYPE_XBOX360 },
  253. { 0x11c9, 0x55f0, "Nacon GC-100XF", 0, XTYPE_XBOX360 },
  254. { 0x1209, 0x2882, "Ardwiino Controller", 0, XTYPE_XBOX360 },
  255. { 0x12ab, 0x0004, "Honey Bee Xbox360 dancepad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX360 },
  256. { 0x12ab, 0x0301, "PDP AFTERGLOW AX.1", 0, XTYPE_XBOX360 },
  257. { 0x12ab, 0x0303, "Mortal Kombat Klassic FightStick", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  258. { 0x12ab, 0x8809, "Xbox DDR dancepad", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
  259. { 0x1430, 0x4748, "RedOctane Guitar Hero X-plorer", 0, XTYPE_XBOX360 },
  260. { 0x1430, 0x8888, "TX6500+ Dance Pad (first generation)", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX },
  261. { 0x1430, 0xf801, "RedOctane Controller", 0, XTYPE_XBOX360 },
  262. { 0x146b, 0x0601, "BigBen Interactive XBOX 360 Controller", 0, XTYPE_XBOX360 },
  263. { 0x1532, 0x0037, "Razer Sabertooth", 0, XTYPE_XBOX360 },
  264. { 0x1532, 0x0a00, "Razer Atrox Arcade Stick", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOXONE },
  265. { 0x1532, 0x0a03, "Razer Wildcat", 0, XTYPE_XBOXONE },
  266. { 0x15e4, 0x3f00, "Power A Mini Pro Elite", 0, XTYPE_XBOX360 },
  267. { 0x15e4, 0x3f0a, "Xbox Airflo wired controller", 0, XTYPE_XBOX360 },
  268. { 0x15e4, 0x3f10, "Batarang Xbox 360 controller", 0, XTYPE_XBOX360 },
  269. { 0x162e, 0xbeef, "Joytech Neo-Se Take2", 0, XTYPE_XBOX360 },
  270. { 0x1689, 0xfd00, "Razer Onza Tournament Edition", 0, XTYPE_XBOX360 },
  271. { 0x1689, 0xfd01, "Razer Onza Classic Edition", 0, XTYPE_XBOX360 },
  272. { 0x1689, 0xfe00, "Razer Sabertooth", 0, XTYPE_XBOX360 },
  273. { 0x1949, 0x041a, "Amazon Game Controller", 0, XTYPE_XBOX360 },
  274. { 0x1bad, 0x0002, "Harmonix Rock Band Guitar", 0, XTYPE_XBOX360 },
  275. { 0x1bad, 0x0003, "Harmonix Rock Band Drumkit", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX360 },
  276. { 0x1bad, 0x0130, "Ion Drum Rocker", MAP_DPAD_TO_BUTTONS, XTYPE_XBOX360 },
  277. { 0x1bad, 0xf016, "Mad Catz Xbox 360 Controller", 0, XTYPE_XBOX360 },
  278. { 0x1bad, 0xf018, "Mad Catz Street Fighter IV SE Fighting Stick", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  279. { 0x1bad, 0xf019, "Mad Catz Brawlstick for Xbox 360", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  280. { 0x1bad, 0xf021, "Mad Cats Ghost Recon FS GamePad", 0, XTYPE_XBOX360 },
  281. { 0x1bad, 0xf023, "MLG Pro Circuit Controller (Xbox)", 0, XTYPE_XBOX360 },
  282. { 0x1bad, 0xf025, "Mad Catz Call Of Duty", 0, XTYPE_XBOX360 },
  283. { 0x1bad, 0xf027, "Mad Catz FPS Pro", 0, XTYPE_XBOX360 },
  284. { 0x1bad, 0xf028, "Street Fighter IV FightPad", 0, XTYPE_XBOX360 },
  285. { 0x1bad, 0xf02e, "Mad Catz Fightpad", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  286. { 0x1bad, 0xf030, "Mad Catz Xbox 360 MC2 MicroCon Racing Wheel", 0, XTYPE_XBOX360 },
  287. { 0x1bad, 0xf036, "Mad Catz MicroCon GamePad Pro", 0, XTYPE_XBOX360 },
  288. { 0x1bad, 0xf038, "Street Fighter IV FightStick TE", 0, XTYPE_XBOX360 },
  289. { 0x1bad, 0xf039, "Mad Catz MvC2 TE", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  290. { 0x1bad, 0xf03a, "Mad Catz SFxT Fightstick Pro", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  291. { 0x1bad, 0xf03d, "Street Fighter IV Arcade Stick TE - Chun Li", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  292. { 0x1bad, 0xf03e, "Mad Catz MLG FightStick TE", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  293. { 0x1bad, 0xf03f, "Mad Catz FightStick SoulCaliber", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  294. { 0x1bad, 0xf042, "Mad Catz FightStick TES+", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  295. { 0x1bad, 0xf080, "Mad Catz FightStick TE2", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  296. { 0x1bad, 0xf501, "HoriPad EX2 Turbo", 0, XTYPE_XBOX360 },
  297. { 0x1bad, 0xf502, "Hori Real Arcade Pro.VX SA", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  298. { 0x1bad, 0xf503, "Hori Fighting Stick VX", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  299. { 0x1bad, 0xf504, "Hori Real Arcade Pro. EX", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  300. { 0x1bad, 0xf505, "Hori Fighting Stick EX2B", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  301. { 0x1bad, 0xf506, "Hori Real Arcade Pro.EX Premium VLX", 0, XTYPE_XBOX360 },
  302. { 0x1bad, 0xf900, "Harmonix Xbox 360 Controller", 0, XTYPE_XBOX360 },
  303. { 0x1bad, 0xf901, "Gamestop Xbox 360 Controller", 0, XTYPE_XBOX360 },
  304. { 0x1bad, 0xf903, "Tron Xbox 360 controller", 0, XTYPE_XBOX360 },
  305. { 0x1bad, 0xf904, "PDP Versus Fighting Pad", 0, XTYPE_XBOX360 },
  306. { 0x1bad, 0xf906, "MortalKombat FightStick", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  307. { 0x1bad, 0xfa01, "MadCatz GamePad", 0, XTYPE_XBOX360 },
  308. { 0x1bad, 0xfd00, "Razer Onza TE", 0, XTYPE_XBOX360 },
  309. { 0x1bad, 0xfd01, "Razer Onza", 0, XTYPE_XBOX360 },
  310. { 0x20d6, 0x2001, "BDA Xbox Series X Wired Controller", 0, XTYPE_XBOXONE },
  311. { 0x20d6, 0x2009, "PowerA Enhanced Wired Controller for Xbox Series X|S", 0, XTYPE_XBOXONE },
  312. { 0x20d6, 0x281f, "PowerA Wired Controller For Xbox 360", 0, XTYPE_XBOX360 },
  313. { 0x2e24, 0x0652, "Hyperkin Duke X-Box One pad", 0, XTYPE_XBOXONE },
  314. { 0x24c6, 0x5000, "Razer Atrox Arcade Stick", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  315. { 0x24c6, 0x5300, "PowerA MINI PROEX Controller", 0, XTYPE_XBOX360 },
  316. { 0x24c6, 0x5303, "Xbox Airflo wired controller", 0, XTYPE_XBOX360 },
  317. { 0x24c6, 0x530a, "Xbox 360 Pro EX Controller", 0, XTYPE_XBOX360 },
  318. { 0x24c6, 0x531a, "PowerA Pro Ex", 0, XTYPE_XBOX360 },
  319. { 0x24c6, 0x5397, "FUS1ON Tournament Controller", 0, XTYPE_XBOX360 },
  320. { 0x24c6, 0x541a, "PowerA Xbox One Mini Wired Controller", 0, XTYPE_XBOXONE },
  321. { 0x24c6, 0x542a, "Xbox ONE spectra", 0, XTYPE_XBOXONE },
  322. { 0x24c6, 0x543a, "PowerA Xbox One wired controller", 0, XTYPE_XBOXONE },
  323. { 0x24c6, 0x5500, "Hori XBOX 360 EX 2 with Turbo", 0, XTYPE_XBOX360 },
  324. { 0x24c6, 0x5501, "Hori Real Arcade Pro VX-SA", 0, XTYPE_XBOX360 },
  325. { 0x24c6, 0x5502, "Hori Fighting Stick VX Alt", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  326. { 0x24c6, 0x5503, "Hori Fighting Edge", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  327. { 0x24c6, 0x5506, "Hori SOULCALIBUR V Stick", 0, XTYPE_XBOX360 },
  328. { 0x24c6, 0x550d, "Hori GEM Xbox controller", 0, XTYPE_XBOX360 },
  329. { 0x24c6, 0x550e, "Hori Real Arcade Pro V Kai 360", MAP_TRIGGERS_TO_BUTTONS, XTYPE_XBOX360 },
  330. { 0x24c6, 0x551a, "PowerA FUSION Pro Controller", 0, XTYPE_XBOXONE },
  331. { 0x24c6, 0x561a, "PowerA FUSION Controller", 0, XTYPE_XBOXONE },
  332. { 0x24c6, 0x5b00, "ThrustMaster Ferrari 458 Racing Wheel", 0, XTYPE_XBOX360 },
  333. { 0x24c6, 0x5b02, "Thrustmaster, Inc. GPX Controller", 0, XTYPE_XBOX360 },
  334. { 0x24c6, 0x5b03, "Thrustmaster Ferrari 458 Racing Wheel", 0, XTYPE_XBOX360 },
  335. { 0x24c6, 0x5d04, "Razer Sabertooth", 0, XTYPE_XBOX360 },
  336. { 0x24c6, 0xfafe, "Rock Candy Gamepad for Xbox 360", 0, XTYPE_XBOX360 },
  337. { 0x3767, 0x0101, "Fanatec Speedster 3 Forceshock Wheel", 0, XTYPE_XBOX },
  338. { 0x8555, 0x061c, "Gamesir G4 Pro", 0, XTYPE_XBOX360 },
  339. { 0x8555, 0x061b, "Gamesir G4 Pro Wireless", 0, XTYPE_XBOX360 },
  340. { 0xffff, 0xffff, "Chinese-made Xbox Controller", 0, XTYPE_XBOX },
  341. { 0x2563, 0x058d, "OneXPlayer Gamepad", 0, XTYPE_XBOX360 },
  342. { 0x0000, 0x0000, "Generic X-Box pad", 0, XTYPE_UNKNOWN }
  343. };
  344.  
  345. /* buttons shared with xbox and xbox360 */
  346. static const signed short xpad_common_btn[] = {
  347. BTN_A, BTN_B, BTN_X, BTN_Y, /* "analog" buttons */
  348. BTN_START, BTN_SELECT, BTN_THUMBL, BTN_THUMBR, /* start/back/sticks */
  349. -1 /* terminating entry */
  350. };
  351.  
  352. /* original xbox controllers only */
  353. static const signed short xpad_btn[] = {
  354. BTN_C, BTN_Z, /* "analog" buttons */
  355. -1 /* terminating entry */
  356. };
  357.  
  358. /* used when dpad is mapped to buttons */
  359. static const signed short xpad_btn_pad[] = {
  360. BTN_TRIGGER_HAPPY1, BTN_TRIGGER_HAPPY2, /* d-pad left, right */
  361. BTN_TRIGGER_HAPPY3, BTN_TRIGGER_HAPPY4, /* d-pad up, down */
  362. -1 /* terminating entry */
  363. };
  364.  
  365. /* used when triggers are mapped to buttons */
  366. static const signed short xpad_btn_triggers[] = {
  367. BTN_TL2, BTN_TR2, /* triggers left/right */
  368. -1
  369. };
  370.  
  371. static const signed short xpad360_btn[] = { /* buttons for x360 controller */
  372. BTN_TL, BTN_TR, /* Button LB/RB */
  373. BTN_MODE, /* The big X button */
  374. -1
  375. };
  376.  
  377. static const signed short xpad_abs[] = {
  378. ABS_X, ABS_Y, /* left stick */
  379. ABS_RX, ABS_RY, /* right stick */
  380. -1 /* terminating entry */
  381. };
  382.  
  383. /* used when dpad is mapped to axes */
  384. static const signed short xpad_abs_pad[] = {
  385. ABS_HAT0X, ABS_HAT0Y, /* d-pad axes */
  386. -1 /* terminating entry */
  387. };
  388.  
  389. /* used when triggers are mapped to axes */
  390. static const signed short xpad_abs_triggers[] = {
  391. ABS_Z, ABS_RZ, /* triggers left/right */
  392. -1
  393. };
  394.  
  395. /*
  396. * Xbox 360 has a vendor-specific class, so we cannot match it with only
  397. * USB_INTERFACE_INFO (also specifically refused by USB subsystem), so we
  398. * match against vendor id as well. Wired Xbox 360 devices have protocol 1,
  399. * wireless controllers have protocol 129.
  400. */
  401. #define XPAD_XBOX360_VENDOR_PROTOCOL(vend, pr) \
  402. .match_flags = USB_DEVICE_ID_MATCH_VENDOR | USB_DEVICE_ID_MATCH_INT_INFO, \
  403. .idVendor = (vend), \
  404. .bInterfaceClass = USB_CLASS_VENDOR_SPEC, \
  405. .bInterfaceSubClass = 93, \
  406. .bInterfaceProtocol = (pr)
  407. #define XPAD_XBOX360_VENDOR(vend) \
  408. { XPAD_XBOX360_VENDOR_PROTOCOL((vend), 1) }, \
  409. { XPAD_XBOX360_VENDOR_PROTOCOL((vend), 129) }
  410.  
  411. /* The Xbox One controller uses subclass 71 and protocol 208. */
  412. #define XPAD_XBOXONE_VENDOR_PROTOCOL(vend, pr) \
  413. .match_flags = USB_DEVICE_ID_MATCH_VENDOR | USB_DEVICE_ID_MATCH_INT_INFO, \
  414. .idVendor = (vend), \
  415. .bInterfaceClass = USB_CLASS_VENDOR_SPEC, \
  416. .bInterfaceSubClass = 71, \
  417. .bInterfaceProtocol = (pr)
  418. #define XPAD_XBOXONE_VENDOR(vend) \
  419. { XPAD_XBOXONE_VENDOR_PROTOCOL((vend), 208) }
  420.  
  421. static const struct usb_device_id xpad_table[] = {
  422. { USB_INTERFACE_INFO('X', 'B', 0) }, /* X-Box USB-IF not approved class */
  423. XPAD_XBOX360_VENDOR(0x0079), /* GPD Win 2 Controller */
  424. XPAD_XBOX360_VENDOR(0x044f), /* Thrustmaster X-Box 360 controllers */
  425. XPAD_XBOX360_VENDOR(0x045e), /* Microsoft X-Box 360 controllers */
  426. XPAD_XBOXONE_VENDOR(0x045e), /* Microsoft X-Box One controllers */
  427. XPAD_XBOX360_VENDOR(0x046d), /* Logitech X-Box 360 style controllers */
  428. XPAD_XBOX360_VENDOR(0x056e), /* Elecom JC-U3613M */
  429. XPAD_XBOX360_VENDOR(0x06a3), /* Saitek P3600 */
  430. XPAD_XBOX360_VENDOR(0x0738), /* Mad Catz X-Box 360 controllers */
  431. { USB_DEVICE(0x0738, 0x4540) }, /* Mad Catz Beat Pad */
  432. XPAD_XBOXONE_VENDOR(0x0738), /* Mad Catz FightStick TE 2 */
  433. XPAD_XBOX360_VENDOR(0x07ff), /* Mad Catz GamePad */
  434. XPAD_XBOX360_VENDOR(0x0e6f), /* 0x0e6f X-Box 360 controllers */
  435. XPAD_XBOXONE_VENDOR(0x0e6f), /* 0x0e6f X-Box One controllers */
  436. XPAD_XBOX360_VENDOR(0x0f0d), /* Hori Controllers */
  437. XPAD_XBOXONE_VENDOR(0x0f0d), /* Hori Controllers */
  438. XPAD_XBOX360_VENDOR(0x1038), /* SteelSeries Controllers */
  439. XPAD_XBOX360_VENDOR(0x11c9), /* Nacon GC100XF */
  440. XPAD_XBOX360_VENDOR(0x1209), /* Ardwiino Controllers */
  441. XPAD_XBOX360_VENDOR(0x12ab), /* X-Box 360 dance pads */
  442. XPAD_XBOX360_VENDOR(0x1430), /* RedOctane X-Box 360 controllers */
  443. XPAD_XBOX360_VENDOR(0x146b), /* BigBen Interactive Controllers */
  444. XPAD_XBOX360_VENDOR(0x1532), /* Razer Sabertooth */
  445. XPAD_XBOXONE_VENDOR(0x1532), /* Razer Wildcat */
  446. XPAD_XBOX360_VENDOR(0x15e4), /* Numark X-Box 360 controllers */
  447. XPAD_XBOX360_VENDOR(0x162e), /* Joytech X-Box 360 controllers */
  448. XPAD_XBOX360_VENDOR(0x1689), /* Razer Onza */
  449. XPAD_XBOX360_VENDOR(0x1949), /* Amazon controllers */
  450. XPAD_XBOX360_VENDOR(0x1bad), /* Harminix Rock Band Guitar and Drums */
  451. XPAD_XBOX360_VENDOR(0x20d6), /* PowerA Controllers */
  452. XPAD_XBOXONE_VENDOR(0x20d6), /* PowerA Controllers */
  453. XPAD_XBOX360_VENDOR(0x24c6), /* PowerA Controllers */
  454. XPAD_XBOXONE_VENDOR(0x24c6), /* PowerA Controllers */
  455. XPAD_XBOXONE_VENDOR(0x2e24), /* Hyperkin Duke X-Box One pad */
  456. XPAD_XBOX360_VENDOR(0x2f24), /* GameSir Controllers */
  457. XPAD_XBOX360_VENDOR(0x3285), /* Nacon Controllers */
  458. XPAD_XBOX360_VENDOR(0x2563), /* OneXPlayer Gamepad */
  459. XPAD_XBOX360_VENDOR(0x8555),
  460. { }
  461. };
  462.  
  463. MODULE_DEVICE_TABLE(usb, xpad_table);
  464.  
  465. struct xboxone_init_packet {
  466. u16 idVendor;
  467. u16 idProduct;
  468. const u8 *data;
  469. u8 len;
  470. };
  471.  
  472. #define XBOXONE_INIT_PKT(_vid, _pid, _data) \
  473. { \
  474. .idVendor = (_vid), \
  475. .idProduct = (_pid), \
  476. .data = (_data), \
  477. .len = ARRAY_SIZE(_data), \
  478. }
  479.  
  480.  
  481. /*
  482. * This packet is required for all Xbox One pads with 2015
  483. * or later firmware installed (or present from the factory).
  484. */
  485. static const u8 xboxone_fw2015_init[] = {
  486. 0x05, 0x20, 0x00, 0x01, 0x00
  487. };
  488.  
  489. /*
  490. * This packet is required for Xbox One S (0x045e:0x02ea)
  491. * and Xbox One Elite Series 2 (0x045e:0x0b00) pads to
  492. * initialize the controller that was previously used in
  493. * Bluetooth mode.
  494. */
  495. static const u8 xboxone_s_init[] = {
  496. 0x05, 0x20, 0x00, 0x0f, 0x06
  497. };
  498.  
  499. /*
  500. * This packet is required for the Titanfall 2 Xbox One pads
  501. * (0x0e6f:0x0165) to finish initialization and for Hori pads
  502. * (0x0f0d:0x0067) to make the analog sticks work.
  503. */
  504. static const u8 xboxone_hori_init[] = {
  505. 0x01, 0x20, 0x00, 0x09, 0x00, 0x04, 0x20, 0x3a,
  506. 0x00, 0x00, 0x00, 0x80, 0x00
  507. };
  508.  
  509. /*
  510. * This packet is required for most (all?) of the PDP pads to start
  511. * sending input reports. These pads include: (0x0e6f:0x02ab),
  512. * (0x0e6f:0x02a4), (0x0e6f:0x02a6).
  513. */
  514. static const u8 xboxone_pdp_init1[] = {
  515. 0x0a, 0x20, 0x00, 0x03, 0x00, 0x01, 0x14
  516. };
  517.  
  518. /*
  519. * This packet is required for most (all?) of the PDP pads to start
  520. * sending input reports. These pads include: (0x0e6f:0x02ab),
  521. * (0x0e6f:0x02a4), (0x0e6f:0x02a6).
  522. */
  523. static const u8 xboxone_pdp_init2[] = {
  524. 0x06, 0x20, 0x00, 0x02, 0x01, 0x00
  525. };
  526.  
  527. /*
  528. * A specific rumble packet is required for some PowerA pads to start
  529. * sending input reports. One of those pads is (0x24c6:0x543a).
  530. */
  531. static const u8 xboxone_rumblebegin_init[] = {
  532. 0x09, 0x00, 0x00, 0x09, 0x00, 0x0F, 0x00, 0x00,
  533. 0x1D, 0x1D, 0xFF, 0x00, 0x00
  534. };
  535.  
  536. /*
  537. * A rumble packet with zero FF intensity will immediately
  538. * terminate the rumbling required to init PowerA pads.
  539. * This should happen fast enough that the motors don't
  540. * spin up to enough speed to actually vibrate the gamepad.
  541. */
  542. static const u8 xboxone_rumbleend_init[] = {
  543. 0x09, 0x00, 0x00, 0x09, 0x00, 0x0F, 0x00, 0x00,
  544. 0x00, 0x00, 0x00, 0x00, 0x00
  545. };
  546.  
  547. /*
  548. * This specifies the selection of init packets that a gamepad
  549. * will be sent on init *and* the order in which they will be
  550. * sent. The correct sequence number will be added when the
  551. * packet is going to be sent.
  552. */
  553. static const struct xboxone_init_packet xboxone_init_packets[] = {
  554. XBOXONE_INIT_PKT(0x0e6f, 0x0165, xboxone_hori_init),
  555. XBOXONE_INIT_PKT(0x0f0d, 0x0067, xboxone_hori_init),
  556. XBOXONE_INIT_PKT(0x0000, 0x0000, xboxone_fw2015_init),
  557. XBOXONE_INIT_PKT(0x045e, 0x02ea, xboxone_s_init),
  558. XBOXONE_INIT_PKT(0x045e, 0x0b00, xboxone_s_init),
  559. XBOXONE_INIT_PKT(0x0e6f, 0x0000, xboxone_pdp_init1),
  560. XBOXONE_INIT_PKT(0x0e6f, 0x0000, xboxone_pdp_init2),
  561. XBOXONE_INIT_PKT(0x24c6, 0x541a, xboxone_rumblebegin_init),
  562. XBOXONE_INIT_PKT(0x24c6, 0x542a, xboxone_rumblebegin_init),
  563. XBOXONE_INIT_PKT(0x24c6, 0x543a, xboxone_rumblebegin_init),
  564. XBOXONE_INIT_PKT(0x24c6, 0x541a, xboxone_rumbleend_init),
  565. XBOXONE_INIT_PKT(0x24c6, 0x542a, xboxone_rumbleend_init),
  566. XBOXONE_INIT_PKT(0x24c6, 0x543a, xboxone_rumbleend_init),
  567. };
  568.  
  569. struct xpad_output_packet {
  570. u8 data[XPAD_PKT_LEN];
  571. u8 len;
  572. bool pending;
  573. };
  574.  
  575. #define XPAD_OUT_CMD_IDX 0
  576. #define XPAD_OUT_FF_IDX 1
  577. #define XPAD_OUT_LED_IDX (1 + IS_ENABLED(CONFIG_JOYSTICK_XPAD_FF))
  578. #define XPAD_NUM_OUT_PACKETS (1 + \
  579. IS_ENABLED(CONFIG_JOYSTICK_XPAD_FF) + \
  580. IS_ENABLED(CONFIG_JOYSTICK_XPAD_LEDS))
  581.  
  582. struct usb_xpad {
  583. struct input_dev *dev; /* input device interface */
  584. struct input_dev __rcu *x360w_dev;
  585. struct usb_device *udev; /* usb device */
  586. struct usb_interface *intf; /* usb interface */
  587.  
  588. bool pad_present;
  589. bool input_created;
  590.  
  591. struct urb *irq_in; /* urb for interrupt in report */
  592. unsigned char *idata; /* input data */
  593. dma_addr_t idata_dma;
  594.  
  595. struct urb *irq_out; /* urb for interrupt out report */
  596. struct usb_anchor irq_out_anchor;
  597. bool irq_out_active; /* we must not use an active URB */
  598. u8 odata_serial; /* serial number for xbox one protocol */
  599. unsigned char *odata; /* output data */
  600. dma_addr_t odata_dma;
  601. spinlock_t odata_lock;
  602.  
  603. struct xpad_output_packet out_packets[XPAD_NUM_OUT_PACKETS];
  604. int last_out_packet;
  605. int init_seq;
  606.  
  607. #if defined(CONFIG_JOYSTICK_XPAD_LEDS)
  608. struct xpad_led *led;
  609. #endif
  610.  
  611. char phys[64]; /* physical device path */
  612.  
  613. int mapping; /* map d-pad to buttons or to axes */
  614. int xtype; /* type of xbox device */
  615. int pad_nr; /* the order x360 pads were attached */
  616. const char *name; /* name of the device */
  617. struct work_struct work; /* init/remove device from callback */
  618. time64_t mode_btn_down_ts;
  619. };
  620.  
  621. static int xpad_init_input(struct usb_xpad *xpad);
  622. static void xpad_deinit_input(struct usb_xpad *xpad);
  623. static void xpadone_ack_mode_report(struct usb_xpad *xpad, u8 seq_num);
  624. static void xpad360w_poweroff_controller(struct usb_xpad *xpad);
  625.  
  626. /*
  627. * xpad_process_packet
  628. *
  629. * Completes a request by converting the data into events for the
  630. * input subsystem.
  631. *
  632. * The used report descriptor was taken from ITO Takayukis website:
  633. * http://euc.jp/periphs/xbox-controller.ja.html
  634. */
  635. static void xpad_process_packet(struct usb_xpad *xpad, u16 cmd, unsigned char *data)
  636. {
  637. struct input_dev *dev = xpad->dev;
  638.  
  639. if (!(xpad->mapping & MAP_STICKS_TO_NULL)) {
  640. /* left stick */
  641. input_report_abs(dev, ABS_X,
  642. (__s16) le16_to_cpup((__le16 *)(data + 12)));
  643. input_report_abs(dev, ABS_Y,
  644. ~(__s16) le16_to_cpup((__le16 *)(data + 14)));
  645.  
  646. /* right stick */
  647. input_report_abs(dev, ABS_RX,
  648. (__s16) le16_to_cpup((__le16 *)(data + 16)));
  649. input_report_abs(dev, ABS_RY,
  650. ~(__s16) le16_to_cpup((__le16 *)(data + 18)));
  651. }
  652.  
  653. /* triggers left/right */
  654. if (xpad->mapping & MAP_TRIGGERS_TO_BUTTONS) {
  655. input_report_key(dev, BTN_TL2, data[10]);
  656. input_report_key(dev, BTN_TR2, data[11]);
  657. } else {
  658. input_report_abs(dev, ABS_Z, data[10]);
  659. input_report_abs(dev, ABS_RZ, data[11]);
  660. }
  661.  
  662. /* digital pad */
  663. if (xpad->mapping & MAP_DPAD_TO_BUTTONS) {
  664. /* dpad as buttons (left, right, up, down) */
  665. input_report_key(dev, BTN_TRIGGER_HAPPY1, data[2] & 0x04);
  666. input_report_key(dev, BTN_TRIGGER_HAPPY2, data[2] & 0x08);
  667. input_report_key(dev, BTN_TRIGGER_HAPPY3, data[2] & 0x01);
  668. input_report_key(dev, BTN_TRIGGER_HAPPY4, data[2] & 0x02);
  669. } else {
  670. input_report_abs(dev, ABS_HAT0X,
  671. !!(data[2] & 0x08) - !!(data[2] & 0x04));
  672. input_report_abs(dev, ABS_HAT0Y,
  673. !!(data[2] & 0x02) - !!(data[2] & 0x01));
  674. }
  675.  
  676. /* start/back buttons and stick press left/right */
  677. input_report_key(dev, BTN_START, data[2] & 0x10);
  678. input_report_key(dev, BTN_SELECT, data[2] & 0x20);
  679. input_report_key(dev, BTN_THUMBL, data[2] & 0x40);
  680. input_report_key(dev, BTN_THUMBR, data[2] & 0x80);
  681.  
  682. /* "analog" buttons A, B, X, Y */
  683. input_report_key(dev, BTN_A, data[4]);
  684. input_report_key(dev, BTN_B, data[5]);
  685. input_report_key(dev, BTN_X, data[6]);
  686. input_report_key(dev, BTN_Y, data[7]);
  687.  
  688. /* "analog" buttons black, white */
  689. input_report_key(dev, BTN_C, data[8]);
  690. input_report_key(dev, BTN_Z, data[9]);
  691.  
  692. input_sync(dev);
  693. }
  694.  
  695. /*
  696. * xpad360_process_packet
  697. *
  698. * Completes a request by converting the data into events for the
  699. * input subsystem. It is version for xbox 360 controller
  700. *
  701. * The used report descriptor was taken from:
  702. * http://www.free60.org/wiki/Gamepad
  703. */
  704.  
  705. static void xpad360_process_packet(struct usb_xpad *xpad, struct input_dev *dev,
  706. u16 cmd, unsigned char *data)
  707. {
  708. /* valid pad data */
  709. if (data[0] != 0x00)
  710. return;
  711.  
  712. /* digital pad */
  713. if (xpad->mapping & MAP_DPAD_TO_BUTTONS) {
  714. /* dpad as buttons (left, right, up, down) */
  715. input_report_key(dev, BTN_TRIGGER_HAPPY1, data[2] & 0x04);
  716. input_report_key(dev, BTN_TRIGGER_HAPPY2, data[2] & 0x08);
  717. input_report_key(dev, BTN_TRIGGER_HAPPY3, data[2] & 0x01);
  718. input_report_key(dev, BTN_TRIGGER_HAPPY4, data[2] & 0x02);
  719. }
  720.  
  721. /*
  722. * This should be a simple else block. However historically
  723. * xbox360w has mapped DPAD to buttons while xbox360 did not. This
  724. * made no sense, but now we can not just switch back and have to
  725. * support both behaviors.
  726. */
  727. if (!(xpad->mapping & MAP_DPAD_TO_BUTTONS) ||
  728. xpad->xtype == XTYPE_XBOX360W) {
  729. input_report_abs(dev, ABS_HAT0X,
  730. !!(data[2] & 0x08) - !!(data[2] & 0x04));
  731. input_report_abs(dev, ABS_HAT0Y,
  732. !!(data[2] & 0x02) - !!(data[2] & 0x01));
  733. }
  734.  
  735. /* start/back buttons */
  736. input_report_key(dev, BTN_START, data[2] & 0x10);
  737. input_report_key(dev, BTN_SELECT, data[2] & 0x20);
  738.  
  739. /* stick press left/right */
  740. input_report_key(dev, BTN_THUMBL, data[2] & 0x40);
  741. input_report_key(dev, BTN_THUMBR, data[2] & 0x80);
  742.  
  743. /* buttons A,B,X,Y,TL,TR and MODE */
  744. input_report_key(dev, BTN_A, data[3] & 0x10);
  745. input_report_key(dev, BTN_B, data[3] & 0x20);
  746. input_report_key(dev, BTN_X, data[3] & 0x40);
  747. input_report_key(dev, BTN_Y, data[3] & 0x80);
  748. input_report_key(dev, BTN_TL, data[3] & 0x01);
  749. input_report_key(dev, BTN_TR, data[3] & 0x02);
  750. input_report_key(dev, BTN_MODE, data[3] & 0x04);
  751.  
  752. if (!(xpad->mapping & MAP_STICKS_TO_NULL)) {
  753. /* left stick */
  754. input_report_abs(dev, ABS_X,
  755. (__s16) le16_to_cpup((__le16 *)(data + 6)));
  756. input_report_abs(dev, ABS_Y,
  757. ~(__s16) le16_to_cpup((__le16 *)(data + 8)));
  758.  
  759. /* right stick */
  760. input_report_abs(dev, ABS_RX,
  761. (__s16) le16_to_cpup((__le16 *)(data + 10)));
  762. input_report_abs(dev, ABS_RY,
  763. ~(__s16) le16_to_cpup((__le16 *)(data + 12)));
  764. }
  765.  
  766. /* triggers left/right */
  767. if (xpad->mapping & MAP_TRIGGERS_TO_BUTTONS) {
  768. input_report_key(dev, BTN_TL2, data[4]);
  769. input_report_key(dev, BTN_TR2, data[5]);
  770. } else {
  771. input_report_abs(dev, ABS_Z, data[4]);
  772. input_report_abs(dev, ABS_RZ, data[5]);
  773. }
  774.  
  775. input_sync(dev);
  776.  
  777. /* XBOX360W controllers can't be turned off without driver assistance */
  778. if (xpad->xtype == XTYPE_XBOX360W) {
  779. if (xpad->mode_btn_down_ts > 0
  780. && xpad->pad_present
  781. && (ktime_get_seconds() - xpad->mode_btn_down_ts) >= 5) {
  782. xpad360w_poweroff_controller(xpad);
  783. xpad->mode_btn_down_ts = 0;
  784. return;
  785. }
  786.  
  787. /* mode button down/up */
  788. if (data[3] & 0x04)
  789. xpad->mode_btn_down_ts = ktime_get_seconds();
  790. else
  791. xpad->mode_btn_down_ts = 0;
  792. }
  793. }
  794.  
  795. static void xpad_presence_work(struct work_struct *work)
  796. {
  797. struct usb_xpad *xpad = container_of(work, struct usb_xpad, work);
  798. int error;
  799.  
  800. if (xpad->pad_present) {
  801. error = xpad_init_input(xpad);
  802. if (error) {
  803. /* complain only, not much else we can do here */
  804. dev_err(&xpad->dev->dev,
  805. "unable to init device: %d\n", error);
  806. } else {
  807. rcu_assign_pointer(xpad->x360w_dev, xpad->dev);
  808. }
  809. } else {
  810. RCU_INIT_POINTER(xpad->x360w_dev, NULL);
  811. synchronize_rcu();
  812. /*
  813. * Now that we are sure xpad360w_process_packet is not
  814. * using input device we can get rid of it.
  815. */
  816. xpad_deinit_input(xpad);
  817. }
  818. }
  819.  
  820. /*
  821. * xpad360w_process_packet
  822. *
  823. * Completes a request by converting the data into events for the
  824. * input subsystem. It is version for xbox 360 wireless controller.
  825. *
  826. * Byte.Bit
  827. * 00.1 - Status change: The controller or headset has connected/disconnected
  828. * Bits 01.7 and 01.6 are valid
  829. * 01.7 - Controller present
  830. * 01.6 - Headset present
  831. * 01.1 - Pad state (Bytes 4+) valid
  832. *
  833. */
  834. static void xpad360w_process_packet(struct usb_xpad *xpad, u16 cmd, unsigned char *data)
  835. {
  836. struct input_dev *dev;
  837. bool present;
  838.  
  839. /* Presence change */
  840. if (data[0] & 0x08) {
  841. present = (data[1] & 0x80) != 0;
  842.  
  843. if (xpad->pad_present != present) {
  844. xpad->pad_present = present;
  845. schedule_work(&xpad->work);
  846. }
  847. }
  848.  
  849. /* Valid pad data */
  850. if (data[1] != 0x1)
  851. return;
  852.  
  853. rcu_read_lock();
  854. dev = rcu_dereference(xpad->x360w_dev);
  855. if (dev)
  856. xpad360_process_packet(xpad, dev, cmd, &data[4]);
  857. rcu_read_unlock();
  858. }
  859.  
  860. /*
  861. * xpadone_process_packet
  862. *
  863. * Completes a request by converting the data into events for the
  864. * input subsystem. This version is for the Xbox One controller.
  865. *
  866. * The report format was gleaned from
  867. * https://github.com/kylelemons/xbox/blob/master/xbox.go
  868. */
  869. static void xpadone_process_packet(struct usb_xpad *xpad, u16 cmd, unsigned char *data)
  870. {
  871. struct input_dev *dev = xpad->dev;
  872.  
  873. /* the xbox button has its own special report */
  874. if (data[0] == 0X07) {
  875. /*
  876. * The Xbox One S controller requires these reports to be
  877. * acked otherwise it continues sending them forever and
  878. * won't report further mode button events.
  879. */
  880. if (data[1] == 0x30)
  881. xpadone_ack_mode_report(xpad, data[2]);
  882.  
  883. input_report_key(dev, BTN_MODE, data[4] & 0x01);
  884. input_sync(dev);
  885. return;
  886. }
  887. /* check invalid packet */
  888. else if (data[0] != 0X20)
  889. return;
  890.  
  891. /* menu/view buttons */
  892. input_report_key(dev, BTN_START, data[4] & 0x04);
  893. input_report_key(dev, BTN_SELECT, data[4] & 0x08);
  894. if (xpad->mapping & MAP_SELECT_BUTTON)
  895. input_report_key(dev, KEY_RECORD, data[22] & 0x01);
  896.  
  897. /* buttons A,B,X,Y */
  898. input_report_key(dev, BTN_A, data[4] & 0x10);
  899. input_report_key(dev, BTN_B, data[4] & 0x20);
  900. input_report_key(dev, BTN_X, data[4] & 0x40);
  901. input_report_key(dev, BTN_Y, data[4] & 0x80);
  902.  
  903. /* digital pad */
  904. if (xpad->mapping & MAP_DPAD_TO_BUTTONS) {
  905. /* dpad as buttons (left, right, up, down) */
  906. input_report_key(dev, BTN_TRIGGER_HAPPY1, data[5] & 0x04);
  907. input_report_key(dev, BTN_TRIGGER_HAPPY2, data[5] & 0x08);
  908. input_report_key(dev, BTN_TRIGGER_HAPPY3, data[5] & 0x01);
  909. input_report_key(dev, BTN_TRIGGER_HAPPY4, data[5] & 0x02);
  910. } else {
  911. input_report_abs(dev, ABS_HAT0X,
  912. !!(data[5] & 0x08) - !!(data[5] & 0x04));
  913. input_report_abs(dev, ABS_HAT0Y,
  914. !!(data[5] & 0x02) - !!(data[5] & 0x01));
  915. }
  916.  
  917. /* TL/TR */
  918. input_report_key(dev, BTN_TL, data[5] & 0x10);
  919. input_report_key(dev, BTN_TR, data[5] & 0x20);
  920.  
  921. /* stick press left/right */
  922. input_report_key(dev, BTN_THUMBL, data[5] & 0x40);
  923. input_report_key(dev, BTN_THUMBR, data[5] & 0x80);
  924.  
  925. if (!(xpad->mapping & MAP_STICKS_TO_NULL)) {
  926. /* left stick */
  927. input_report_abs(dev, ABS_X,
  928. (__s16) le16_to_cpup((__le16 *)(data + 10)));
  929. input_report_abs(dev, ABS_Y,
  930. ~(__s16) le16_to_cpup((__le16 *)(data + 12)));
  931.  
  932. /* right stick */
  933. input_report_abs(dev, ABS_RX,
  934. (__s16) le16_to_cpup((__le16 *)(data + 14)));
  935. input_report_abs(dev, ABS_RY,
  936. ~(__s16) le16_to_cpup((__le16 *)(data + 16)));
  937. }
  938.  
  939. /* triggers left/right */
  940. if (xpad->mapping & MAP_TRIGGERS_TO_BUTTONS) {
  941. input_report_key(dev, BTN_TL2,
  942. (__u16) le16_to_cpup((__le16 *)(data + 6)));
  943. input_report_key(dev, BTN_TR2,
  944. (__u16) le16_to_cpup((__le16 *)(data + 8)));
  945. } else {
  946. input_report_abs(dev, ABS_Z,
  947. (__u16) le16_to_cpup((__le16 *)(data + 6)));
  948. input_report_abs(dev, ABS_RZ,
  949. (__u16) le16_to_cpup((__le16 *)(data + 8)));
  950. }
  951.  
  952. input_sync(dev);
  953. }
  954.  
  955. static void xpad_irq_in(struct urb *urb)
  956. {
  957. struct usb_xpad *xpad = urb->context;
  958. struct device *dev = &xpad->intf->dev;
  959. int retval, status;
  960.  
  961. status = urb->status;
  962.  
  963. switch (status) {
  964. case 0:
  965. /* success */
  966. break;
  967. case -ECONNRESET:
  968. case -ENOENT:
  969. case -ESHUTDOWN:
  970. /* this urb is terminated, clean up */
  971. dev_dbg(dev, "%s - urb shutting down with status: %d\n",
  972. __func__, status);
  973. return;
  974. default:
  975. dev_dbg(dev, "%s - nonzero urb status received: %d\n",
  976. __func__, status);
  977. goto exit;
  978. }
  979.  
  980. #if defined(DEBUG_VERBOSE)
  981. /* If you set rowsize to larger than 32 it defaults to 16?
  982. * Otherwise I would set it to XPAD_PKT_LEN V
  983. */
  984. print_hex_dump(KERN_DEBUG, "xpad-dbg: ", DUMP_PREFIX_OFFSET, 32, 1, xpad->idata, XPAD_PKT_LEN, 0);
  985. #endif
  986.  
  987. switch (xpad->xtype) {
  988. case XTYPE_XBOX360:
  989. xpad360_process_packet(xpad, xpad->dev, 0, xpad->idata);
  990. break;
  991. case XTYPE_XBOX360W:
  992. xpad360w_process_packet(xpad, 0, xpad->idata);
  993. break;
  994. case XTYPE_XBOXONE:
  995. xpadone_process_packet(xpad, 0, xpad->idata);
  996. break;
  997. default:
  998. xpad_process_packet(xpad, 0, xpad->idata);
  999. }
  1000.  
  1001. exit:
  1002. retval = usb_submit_urb(urb, GFP_ATOMIC);
  1003. if (retval)
  1004. dev_err(dev, "%s - usb_submit_urb failed with result %d\n",
  1005. __func__, retval);
  1006. }
  1007.  
  1008. /* Callers must hold xpad->odata_lock spinlock */
  1009. static bool xpad_prepare_next_init_packet(struct usb_xpad *xpad)
  1010. {
  1011. const struct xboxone_init_packet *init_packet;
  1012.  
  1013. if (xpad->xtype != XTYPE_XBOXONE)
  1014. return false;
  1015.  
  1016. /* Perform initialization sequence for Xbox One pads that require it */
  1017. while (xpad->init_seq < ARRAY_SIZE(xboxone_init_packets)) {
  1018. init_packet = &xboxone_init_packets[xpad->init_seq++];
  1019.  
  1020. if (init_packet->idVendor != 0 &&
  1021. init_packet->idVendor != xpad->dev->id.vendor)
  1022. continue;
  1023.  
  1024. if (init_packet->idProduct != 0 &&
  1025. init_packet->idProduct != xpad->dev->id.product)
  1026. continue;
  1027.  
  1028. /* This packet applies to our device, so prepare to send it */
  1029. memcpy(xpad->odata, init_packet->data, init_packet->len);
  1030. xpad->irq_out->transfer_buffer_length = init_packet->len;
  1031.  
  1032. /* Update packet with current sequence number */
  1033. xpad->odata[2] = xpad->odata_serial++;
  1034. return true;
  1035. }
  1036.  
  1037. return false;
  1038. }
  1039.  
  1040. /* Callers must hold xpad->odata_lock spinlock */
  1041. static bool xpad_prepare_next_out_packet(struct usb_xpad *xpad)
  1042. {
  1043. struct xpad_output_packet *pkt, *packet = NULL;
  1044. int i;
  1045.  
  1046. /* We may have init packets to send before we can send user commands */
  1047. if (xpad_prepare_next_init_packet(xpad))
  1048. return true;
  1049.  
  1050. for (i = 0; i < XPAD_NUM_OUT_PACKETS; i++) {
  1051. if (++xpad->last_out_packet >= XPAD_NUM_OUT_PACKETS)
  1052. xpad->last_out_packet = 0;
  1053.  
  1054. pkt = &xpad->out_packets[xpad->last_out_packet];
  1055. if (pkt->pending) {
  1056. dev_dbg(&xpad->intf->dev,
  1057. "%s - found pending output packet %d\n",
  1058. __func__, xpad->last_out_packet);
  1059. packet = pkt;
  1060. break;
  1061. }
  1062. }
  1063.  
  1064. if (packet) {
  1065. memcpy(xpad->odata, packet->data, packet->len);
  1066. xpad->irq_out->transfer_buffer_length = packet->len;
  1067. packet->pending = false;
  1068. return true;
  1069. }
  1070.  
  1071. return false;
  1072. }
  1073.  
  1074. /* Callers must hold xpad->odata_lock spinlock */
  1075. static int xpad_try_sending_next_out_packet(struct usb_xpad *xpad)
  1076. {
  1077. int error;
  1078.  
  1079. if (!xpad->irq_out_active && xpad_prepare_next_out_packet(xpad)) {
  1080. usb_anchor_urb(xpad->irq_out, &xpad->irq_out_anchor);
  1081. error = usb_submit_urb(xpad->irq_out, GFP_ATOMIC);
  1082. if (error) {
  1083. dev_err(&xpad->intf->dev,
  1084. "%s - usb_submit_urb failed with result %d\n",
  1085. __func__, error);
  1086. usb_unanchor_urb(xpad->irq_out);
  1087. return -EIO;
  1088. }
  1089.  
  1090. xpad->irq_out_active = true;
  1091. }
  1092.  
  1093. return 0;
  1094. }
  1095.  
  1096. static void xpad_irq_out(struct urb *urb)
  1097. {
  1098. struct usb_xpad *xpad = urb->context;
  1099. struct device *dev = &xpad->intf->dev;
  1100. int status = urb->status;
  1101. int error;
  1102. unsigned long flags;
  1103.  
  1104. spin_lock_irqsave(&xpad->odata_lock, flags);
  1105.  
  1106. switch (status) {
  1107. case 0:
  1108. /* success */
  1109. xpad->irq_out_active = xpad_prepare_next_out_packet(xpad);
  1110. break;
  1111.  
  1112. case -ECONNRESET:
  1113. case -ENOENT:
  1114. case -ESHUTDOWN:
  1115. /* this urb is terminated, clean up */
  1116. dev_dbg(dev, "%s - urb shutting down with status: %d\n",
  1117. __func__, status);
  1118. xpad->irq_out_active = false;
  1119. break;
  1120.  
  1121. default:
  1122. dev_dbg(dev, "%s - nonzero urb status received: %d\n",
  1123. __func__, status);
  1124. break;
  1125. }
  1126.  
  1127. if (xpad->irq_out_active) {
  1128. usb_anchor_urb(urb, &xpad->irq_out_anchor);
  1129. error = usb_submit_urb(urb, GFP_ATOMIC);
  1130. if (error) {
  1131. dev_err(dev,
  1132. "%s - usb_submit_urb failed with result %d\n",
  1133. __func__, error);
  1134. usb_unanchor_urb(urb);
  1135. xpad->irq_out_active = false;
  1136. }
  1137. }
  1138.  
  1139. spin_unlock_irqrestore(&xpad->odata_lock, flags);
  1140. }
  1141.  
  1142. static int xpad_init_output(struct usb_interface *intf, struct usb_xpad *xpad,
  1143. struct usb_endpoint_descriptor *ep_irq_out)
  1144. {
  1145. int error;
  1146.  
  1147. if (xpad->xtype == XTYPE_UNKNOWN)
  1148. return 0;
  1149.  
  1150. init_usb_anchor(&xpad->irq_out_anchor);
  1151.  
  1152. xpad->odata = usb_alloc_coherent(xpad->udev, XPAD_PKT_LEN,
  1153. GFP_KERNEL, &xpad->odata_dma);
  1154. if (!xpad->odata)
  1155. return -ENOMEM;
  1156.  
  1157. spin_lock_init(&xpad->odata_lock);
  1158.  
  1159. xpad->irq_out = usb_alloc_urb(0, GFP_KERNEL);
  1160. if (!xpad->irq_out) {
  1161. error = -ENOMEM;
  1162. goto err_free_coherent;
  1163. }
  1164.  
  1165. usb_fill_int_urb(xpad->irq_out, xpad->udev,
  1166. usb_sndintpipe(xpad->udev, ep_irq_out->bEndpointAddress),
  1167. xpad->odata, XPAD_PKT_LEN,
  1168. xpad_irq_out, xpad, ep_irq_out->bInterval);
  1169. xpad->irq_out->transfer_dma = xpad->odata_dma;
  1170. xpad->irq_out->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
  1171.  
  1172. return 0;
  1173.  
  1174. err_free_coherent:
  1175. usb_free_coherent(xpad->udev, XPAD_PKT_LEN, xpad->odata, xpad->odata_dma);
  1176. return error;
  1177. }
  1178.  
  1179. static void xpad_stop_output(struct usb_xpad *xpad)
  1180. {
  1181. if (xpad->xtype != XTYPE_UNKNOWN) {
  1182. if (!usb_wait_anchor_empty_timeout(&xpad->irq_out_anchor,
  1183. 5000)) {
  1184. dev_warn(&xpad->intf->dev,
  1185. "timed out waiting for output URB to complete, killing\n");
  1186. usb_kill_anchored_urbs(&xpad->irq_out_anchor);
  1187. }
  1188. }
  1189. }
  1190.  
  1191. static void xpad_deinit_output(struct usb_xpad *xpad)
  1192. {
  1193. if (xpad->xtype != XTYPE_UNKNOWN) {
  1194. usb_free_urb(xpad->irq_out);
  1195. usb_free_coherent(xpad->udev, XPAD_PKT_LEN,
  1196. xpad->odata, xpad->odata_dma);
  1197. }
  1198. }
  1199.  
  1200. static int xpad_inquiry_pad_presence(struct usb_xpad *xpad)
  1201. {
  1202. struct xpad_output_packet *packet =
  1203. &xpad->out_packets[XPAD_OUT_CMD_IDX];
  1204. unsigned long flags;
  1205. int retval;
  1206.  
  1207. spin_lock_irqsave(&xpad->odata_lock, flags);
  1208.  
  1209. packet->data[0] = 0x08;
  1210. packet->data[1] = 0x00;
  1211. packet->data[2] = 0x0F;
  1212. packet->data[3] = 0xC0;
  1213. packet->data[4] = 0x00;
  1214. packet->data[5] = 0x00;
  1215. packet->data[6] = 0x00;
  1216. packet->data[7] = 0x00;
  1217. packet->data[8] = 0x00;
  1218. packet->data[9] = 0x00;
  1219. packet->data[10] = 0x00;
  1220. packet->data[11] = 0x00;
  1221. packet->len = 12;
  1222. packet->pending = true;
  1223.  
  1224. /* Reset the sequence so we send out presence first */
  1225. xpad->last_out_packet = -1;
  1226. retval = xpad_try_sending_next_out_packet(xpad);
  1227.  
  1228. spin_unlock_irqrestore(&xpad->odata_lock, flags);
  1229.  
  1230. return retval;
  1231. }
  1232.  
  1233. static int xpad_start_xbox_one(struct usb_xpad *xpad)
  1234. {
  1235. unsigned long flags;
  1236. int retval;
  1237.  
  1238. spin_lock_irqsave(&xpad->odata_lock, flags);
  1239.  
  1240. /*
  1241. * Begin the init sequence by attempting to send a packet.
  1242. * We will cycle through the init packet sequence before
  1243. * sending any packets from the output ring.
  1244. */
  1245. xpad->init_seq = 0;
  1246. retval = xpad_try_sending_next_out_packet(xpad);
  1247.  
  1248. spin_unlock_irqrestore(&xpad->odata_lock, flags);
  1249.  
  1250. return retval;
  1251. }
  1252.  
  1253. static int xpad_start_xbox_360(struct usb_xpad *xpad)
  1254. {
  1255. int status;
  1256.  
  1257. char *data = kzalloc(20, GFP_KERNEL);
  1258.  
  1259. int TIMEOUT = 100;
  1260.  
  1261. /*
  1262. this init sequence is needed for the gamesir g3w controller
  1263. and for shanwan controllers in xpad mode.
  1264. Unfortunately, in this mode they identify as 0x045e, 0x028e, so we
  1265. have to inspect the manufacturer string.
  1266. Sending this sequence to other controllers will break initialization.
  1267. */
  1268. bool is_shanwan = strcasecmp("shanwan", xpad->udev->manufacturer) == 0;
  1269. if ((xpad->dev->id.vendor != 0x05ac ||
  1270. xpad->dev->id.product != 0x055b) &&
  1271. !is_shanwan) {
  1272. status = 0;
  1273. goto err_free_ctrl_data;
  1274. }
  1275.  
  1276. status = usb_control_msg(xpad->udev,
  1277. usb_rcvctrlpipe(xpad->udev, 0),
  1278. 0x1, 0xc1,
  1279. cpu_to_le16(0x100), cpu_to_le16(0x0), data, cpu_to_le16(20),
  1280. TIMEOUT);
  1281.  
  1282. #ifdef DEBUG
  1283. dev_dbg(&xpad->intf->dev,
  1284. "%s - control message 1 returned %d\n", __func__, status);
  1285. #endif
  1286.  
  1287. if (status < 0) {
  1288. goto err_free_ctrl_data;
  1289. }
  1290. #ifdef DEBUG
  1291. else {
  1292. print_hex_dump(KERN_DEBUG, "xpad-dbg: ", DUMP_PREFIX_OFFSET, 32, 1, data, 20, 0);
  1293. }
  1294. #endif
  1295.  
  1296. status = usb_control_msg(xpad->udev,
  1297. usb_rcvctrlpipe(xpad->udev, 0),
  1298. 0x1, 0xc1,
  1299. cpu_to_le16(0x0), cpu_to_le16(0x0), data, cpu_to_le16(8),
  1300. TIMEOUT);
  1301. #ifdef DEBUG
  1302. dev_dbg(&xpad->intf->dev,
  1303. "%s - control message 2 returned %d\n", __func__, status);
  1304. #endif
  1305.  
  1306. if (status < 0) {
  1307. goto err_free_ctrl_data;
  1308. }
  1309. #ifdef DEBUG
  1310. else {
  1311. print_hex_dump(KERN_DEBUG, "xpad-dbg: ", DUMP_PREFIX_OFFSET, 32, 1, data, 8, 0);
  1312. }
  1313. #endif
  1314.  
  1315. status = usb_control_msg(xpad->udev,
  1316. usb_rcvctrlpipe(xpad->udev, 0),
  1317. 0x1, 0xc0,
  1318. cpu_to_le16(0x0), cpu_to_le16(0x0), data, cpu_to_le16(4),
  1319. TIMEOUT);
  1320. #ifdef DEBUG
  1321. dev_dbg(&xpad->intf->dev,
  1322. "%s - control message 3 returned %d\n", __func__, status);
  1323. #endif
  1324.  
  1325. if (status < 0) {
  1326. goto err_free_ctrl_data;
  1327. }
  1328. #ifdef DEBUG
  1329. else {
  1330. print_hex_dump(KERN_DEBUG, "xpad-dbg: ", DUMP_PREFIX_OFFSET, 32, 1, data, 4, 0);
  1331. }
  1332. #endif
  1333.  
  1334. status = 0;
  1335.  
  1336. err_free_ctrl_data:
  1337. kfree(data);
  1338. return status;
  1339. }
  1340.  
  1341. static void xpadone_ack_mode_report(struct usb_xpad *xpad, u8 seq_num)
  1342. {
  1343. unsigned long flags;
  1344. struct xpad_output_packet *packet =
  1345. &xpad->out_packets[XPAD_OUT_CMD_IDX];
  1346. static const u8 mode_report_ack[] = {
  1347. 0x01, 0x20, 0x00, 0x09, 0x00, 0x07, 0x20, 0x02,
  1348. 0x00, 0x00, 0x00, 0x00, 0x00
  1349. };
  1350.  
  1351. spin_lock_irqsave(&xpad->odata_lock, flags);
  1352.  
  1353. packet->len = sizeof(mode_report_ack);
  1354. memcpy(packet->data, mode_report_ack, packet->len);
  1355. packet->data[2] = seq_num;
  1356. packet->pending = true;
  1357.  
  1358. /* Reset the sequence so we send out the ack now */
  1359. xpad->last_out_packet = -1;
  1360. xpad_try_sending_next_out_packet(xpad);
  1361.  
  1362. spin_unlock_irqrestore(&xpad->odata_lock, flags);
  1363. }
  1364.  
  1365. #ifdef CONFIG_JOYSTICK_XPAD_FF
  1366. static int xpad_play_effect(struct input_dev *dev, void *data, struct ff_effect *effect)
  1367. {
  1368. struct usb_xpad *xpad = input_get_drvdata(dev);
  1369. struct xpad_output_packet *packet = &xpad->out_packets[XPAD_OUT_FF_IDX];
  1370. __u16 strong;
  1371. __u16 weak;
  1372. int retval;
  1373. unsigned long flags;
  1374.  
  1375. if (effect->type != FF_RUMBLE)
  1376. return 0;
  1377.  
  1378. strong = effect->u.rumble.strong_magnitude;
  1379. weak = effect->u.rumble.weak_magnitude;
  1380.  
  1381. spin_lock_irqsave(&xpad->odata_lock, flags);
  1382.  
  1383. switch (xpad->xtype) {
  1384. case XTYPE_XBOX:
  1385. packet->data[0] = 0x00;
  1386. packet->data[1] = 0x06;
  1387. packet->data[2] = 0x00;
  1388. packet->data[3] = strong / 256; /* left actuator */
  1389. packet->data[4] = 0x00;
  1390. packet->data[5] = weak / 256; /* right actuator */
  1391. packet->len = 6;
  1392. packet->pending = true;
  1393. break;
  1394.  
  1395. case XTYPE_XBOX360:
  1396. packet->data[0] = 0x00;
  1397. packet->data[1] = 0x08;
  1398. packet->data[2] = 0x00;
  1399. packet->data[3] = strong / 256; /* left actuator? */
  1400. packet->data[4] = weak / 256; /* right actuator? */
  1401. packet->data[5] = 0x00;
  1402. packet->data[6] = 0x00;
  1403. packet->data[7] = 0x00;
  1404. packet->len = 8;
  1405. packet->pending = true;
  1406. break;
  1407.  
  1408. case XTYPE_XBOX360W:
  1409. packet->data[0] = 0x00;
  1410. packet->data[1] = 0x01;
  1411. packet->data[2] = 0x0F;
  1412. packet->data[3] = 0xC0;
  1413. packet->data[4] = 0x00;
  1414. packet->data[5] = strong / 256;
  1415. packet->data[6] = weak / 256;
  1416. packet->data[7] = 0x00;
  1417. packet->data[8] = 0x00;
  1418. packet->data[9] = 0x00;
  1419. packet->data[10] = 0x00;
  1420. packet->data[11] = 0x00;
  1421. packet->len = 12;
  1422. packet->pending = true;
  1423. break;
  1424.  
  1425. case XTYPE_XBOXONE:
  1426. packet->data[0] = 0x09; /* activate rumble */
  1427. packet->data[1] = 0x00;
  1428. packet->data[2] = xpad->odata_serial++;
  1429. packet->data[3] = 0x09;
  1430. packet->data[4] = 0x00;
  1431. packet->data[5] = 0x0F;
  1432. packet->data[6] = 0x00;
  1433. packet->data[7] = 0x00;
  1434. packet->data[8] = strong / 512; /* left actuator */
  1435. packet->data[9] = weak / 512; /* right actuator */
  1436. packet->data[10] = 0xFF; /* on period */
  1437. packet->data[11] = 0x00; /* off period */
  1438. packet->data[12] = 0xFF; /* repeat count */
  1439. packet->len = 13;
  1440. packet->pending = true;
  1441. break;
  1442.  
  1443. default:
  1444. dev_dbg(&xpad->dev->dev,
  1445. "%s - rumble command sent to unsupported xpad type: %d\n",
  1446. __func__, xpad->xtype);
  1447. retval = -EINVAL;
  1448. goto out;
  1449. }
  1450.  
  1451. retval = xpad_try_sending_next_out_packet(xpad);
  1452.  
  1453. out:
  1454. spin_unlock_irqrestore(&xpad->odata_lock, flags);
  1455. return retval;
  1456. }
  1457.  
  1458. static int xpad_init_ff(struct usb_xpad *xpad)
  1459. {
  1460. if (xpad->xtype == XTYPE_UNKNOWN)
  1461. return 0;
  1462.  
  1463. input_set_capability(xpad->dev, EV_FF, FF_RUMBLE);
  1464.  
  1465. return input_ff_create_memless(xpad->dev, NULL, xpad_play_effect);
  1466. }
  1467.  
  1468. #else
  1469. static int xpad_init_ff(struct usb_xpad *xpad) { return 0; }
  1470. #endif
  1471.  
  1472. #if defined(CONFIG_JOYSTICK_XPAD_LEDS)
  1473. #include <linux/leds.h>
  1474. #include <linux/idr.h>
  1475.  
  1476. static DEFINE_IDA(xpad_pad_seq);
  1477.  
  1478. struct xpad_led {
  1479. char name[16];
  1480. struct led_classdev led_cdev;
  1481. struct usb_xpad *xpad;
  1482. };
  1483.  
  1484. /*
  1485. * set the LEDs on Xbox360 / Wireless Controllers
  1486. * @param command
  1487. * 0: off
  1488. * 1: all blink, then previous setting
  1489. * 2: 1/top-left blink, then on
  1490. * 3: 2/top-right blink, then on
  1491. * 4: 3/bottom-left blink, then on
  1492. * 5: 4/bottom-right blink, then on
  1493. * 6: 1/top-left on
  1494. * 7: 2/top-right on
  1495. * 8: 3/bottom-left on
  1496. * 9: 4/bottom-right on
  1497. * 10: rotate
  1498. * 11: blink, based on previous setting
  1499. * 12: slow blink, based on previous setting
  1500. * 13: rotate with two lights
  1501. * 14: persistent slow all blink
  1502. * 15: blink once, then previous setting
  1503. */
  1504. static void xpad_send_led_command(struct usb_xpad *xpad, int command)
  1505. {
  1506. struct xpad_output_packet *packet =
  1507. &xpad->out_packets[XPAD_OUT_LED_IDX];
  1508. unsigned long flags;
  1509.  
  1510. command %= 16;
  1511.  
  1512. spin_lock_irqsave(&xpad->odata_lock, flags);
  1513.  
  1514. switch (xpad->xtype) {
  1515. case XTYPE_XBOX360:
  1516. packet->data[0] = 0x01;
  1517. packet->data[1] = 0x03;
  1518. packet->data[2] = command;
  1519. packet->len = 3;
  1520. packet->pending = true;
  1521. break;
  1522.  
  1523. case XTYPE_XBOX360W:
  1524. packet->data[0] = 0x00;
  1525. packet->data[1] = 0x00;
  1526. packet->data[2] = 0x08;
  1527. packet->data[3] = 0x40 + command;
  1528. packet->data[4] = 0x00;
  1529. packet->data[5] = 0x00;
  1530. packet->data[6] = 0x00;
  1531. packet->data[7] = 0x00;
  1532. packet->data[8] = 0x00;
  1533. packet->data[9] = 0x00;
  1534. packet->data[10] = 0x00;
  1535. packet->data[11] = 0x00;
  1536. packet->len = 12;
  1537. packet->pending = true;
  1538. break;
  1539. }
  1540.  
  1541. xpad_try_sending_next_out_packet(xpad);
  1542.  
  1543. spin_unlock_irqrestore(&xpad->odata_lock, flags);
  1544. }
  1545.  
  1546. /*
  1547. * Light up the segment corresponding to the pad number on
  1548. * Xbox 360 Controllers.
  1549. */
  1550. static void xpad_identify_controller(struct usb_xpad *xpad)
  1551. {
  1552. led_set_brightness(&xpad->led->led_cdev, (xpad->pad_nr % 4) + 2);
  1553. }
  1554.  
  1555. static void xpad_led_set(struct led_classdev *led_cdev,
  1556. enum led_brightness value)
  1557. {
  1558. struct xpad_led *xpad_led = container_of(led_cdev,
  1559. struct xpad_led, led_cdev);
  1560.  
  1561. xpad_send_led_command(xpad_led->xpad, value);
  1562. }
  1563.  
  1564. static int xpad_led_probe(struct usb_xpad *xpad)
  1565. {
  1566. struct xpad_led *led;
  1567. struct led_classdev *led_cdev;
  1568. int error;
  1569.  
  1570. if (xpad->xtype != XTYPE_XBOX360 && xpad->xtype != XTYPE_XBOX360W)
  1571. return 0;
  1572.  
  1573. xpad->led = led = kzalloc(sizeof(struct xpad_led), GFP_KERNEL);
  1574. if (!led)
  1575. return -ENOMEM;
  1576.  
  1577. xpad->pad_nr = ida_simple_get(&xpad_pad_seq, 0, 0, GFP_KERNEL);
  1578. if (xpad->pad_nr < 0) {
  1579. error = xpad->pad_nr;
  1580. goto err_free_mem;
  1581. }
  1582.  
  1583. snprintf(led->name, sizeof(led->name), "xpad%d", xpad->pad_nr);
  1584. led->xpad = xpad;
  1585.  
  1586. led_cdev = &led->led_cdev;
  1587. led_cdev->name = led->name;
  1588. led_cdev->brightness_set = xpad_led_set;
  1589. led_cdev->flags = LED_CORE_SUSPENDRESUME;
  1590.  
  1591. error = led_classdev_register(&xpad->udev->dev, led_cdev);
  1592. if (error)
  1593. goto err_free_id;
  1594.  
  1595. xpad_identify_controller(xpad);
  1596.  
  1597. return 0;
  1598.  
  1599. err_free_id:
  1600. ida_simple_remove(&xpad_pad_seq, xpad->pad_nr);
  1601. err_free_mem:
  1602. kfree(led);
  1603. xpad->led = NULL;
  1604. return error;
  1605. }
  1606.  
  1607. static void xpad_led_disconnect(struct usb_xpad *xpad)
  1608. {
  1609. struct xpad_led *xpad_led = xpad->led;
  1610.  
  1611. if (xpad_led) {
  1612. led_classdev_unregister(&xpad_led->led_cdev);
  1613. ida_simple_remove(&xpad_pad_seq, xpad->pad_nr);
  1614. kfree(xpad_led);
  1615. }
  1616. }
  1617. #else
  1618. static int xpad_led_probe(struct usb_xpad *xpad) { return 0; }
  1619. static void xpad_led_disconnect(struct usb_xpad *xpad) { }
  1620. #endif
  1621.  
  1622. static int xpad_start_input(struct usb_xpad *xpad)
  1623. {
  1624. int error;
  1625.  
  1626. if (xpad->xtype == XTYPE_XBOX360) {
  1627. error = xpad_start_xbox_360(xpad);
  1628. if (error)
  1629. return error;
  1630. }
  1631.  
  1632. if (usb_submit_urb(xpad->irq_in, GFP_KERNEL))
  1633. return -EIO;
  1634.  
  1635. if (xpad->xtype == XTYPE_XBOXONE) {
  1636. error = xpad_start_xbox_one(xpad);
  1637. if (error) {
  1638. usb_kill_urb(xpad->irq_in);
  1639. return error;
  1640. }
  1641. }
  1642.  
  1643. return 0;
  1644. }
  1645.  
  1646. static void xpad_stop_input(struct usb_xpad *xpad)
  1647. {
  1648. usb_kill_urb(xpad->irq_in);
  1649. }
  1650.  
  1651. static void xpad360w_poweroff_controller(struct usb_xpad *xpad)
  1652. {
  1653. unsigned long flags;
  1654. struct xpad_output_packet *packet =
  1655. &xpad->out_packets[XPAD_OUT_CMD_IDX];
  1656.  
  1657. spin_lock_irqsave(&xpad->odata_lock, flags);
  1658.  
  1659. packet->data[0] = 0x00;
  1660. packet->data[1] = 0x00;
  1661. packet->data[2] = 0x08;
  1662. packet->data[3] = 0xC0;
  1663. packet->data[4] = 0x00;
  1664. packet->data[5] = 0x00;
  1665. packet->data[6] = 0x00;
  1666. packet->data[7] = 0x00;
  1667. packet->data[8] = 0x00;
  1668. packet->data[9] = 0x00;
  1669. packet->data[10] = 0x00;
  1670. packet->data[11] = 0x00;
  1671. packet->len = 12;
  1672. packet->pending = true;
  1673.  
  1674. /* Reset the sequence so we send out poweroff now */
  1675. xpad->last_out_packet = -1;
  1676. xpad_try_sending_next_out_packet(xpad);
  1677.  
  1678. spin_unlock_irqrestore(&xpad->odata_lock, flags);
  1679. }
  1680.  
  1681. static int xpad360w_start_input(struct usb_xpad *xpad)
  1682. {
  1683. int error;
  1684.  
  1685. error = usb_submit_urb(xpad->irq_in, GFP_KERNEL);
  1686. if (error)
  1687. return -EIO;
  1688.  
  1689. /*
  1690. * Send presence packet.
  1691. * This will force the controller to resend connection packets.
  1692. * This is useful in the case we activate the module after the
  1693. * adapter has been plugged in, as it won't automatically
  1694. * send us info about the controllers.
  1695. */
  1696. error = xpad_inquiry_pad_presence(xpad);
  1697. if (error) {
  1698. usb_kill_urb(xpad->irq_in);
  1699. return error;
  1700. }
  1701.  
  1702. return 0;
  1703. }
  1704.  
  1705. static void xpad360w_stop_input(struct usb_xpad *xpad)
  1706. {
  1707. usb_kill_urb(xpad->irq_in);
  1708.  
  1709. /* Make sure we are done with presence work if it was scheduled */
  1710. flush_work(&xpad->work);
  1711. }
  1712.  
  1713. static int xpad_open(struct input_dev *dev)
  1714. {
  1715. struct usb_xpad *xpad = input_get_drvdata(dev);
  1716.  
  1717. return xpad_start_input(xpad);
  1718. }
  1719.  
  1720. static void xpad_close(struct input_dev *dev)
  1721. {
  1722. struct usb_xpad *xpad = input_get_drvdata(dev);
  1723.  
  1724. xpad_stop_input(xpad);
  1725. }
  1726.  
  1727. static void xpad_set_up_abs(struct input_dev *input_dev, signed short abs)
  1728. {
  1729. struct usb_xpad *xpad = input_get_drvdata(input_dev);
  1730.  
  1731. switch (abs) {
  1732. case ABS_X:
  1733. case ABS_Y:
  1734. case ABS_RX:
  1735. case ABS_RY: /* the two sticks */
  1736. input_set_abs_params(input_dev, abs, -32768, 32767, 16, 128);
  1737. break;
  1738. case ABS_Z:
  1739. case ABS_RZ: /* the triggers (if mapped to axes) */
  1740. if (xpad->xtype == XTYPE_XBOXONE)
  1741. input_set_abs_params(input_dev, abs, 0, 1023, 0, 0);
  1742. else
  1743. input_set_abs_params(input_dev, abs, 0, 255, 0, 0);
  1744. break;
  1745. case ABS_HAT0X:
  1746. case ABS_HAT0Y: /* the d-pad (only if dpad is mapped to axes */
  1747. input_set_abs_params(input_dev, abs, -1, 1, 0, 0);
  1748. break;
  1749. default:
  1750. input_set_abs_params(input_dev, abs, 0, 0, 0, 0);
  1751. break;
  1752. }
  1753. }
  1754.  
  1755. static void xpad_deinit_input(struct usb_xpad *xpad)
  1756. {
  1757. if (xpad->input_created) {
  1758. xpad->input_created = false;
  1759. xpad_led_disconnect(xpad);
  1760. input_unregister_device(xpad->dev);
  1761. }
  1762. }
  1763.  
  1764. static int xpad_init_input(struct usb_xpad *xpad)
  1765. {
  1766. struct input_dev *input_dev;
  1767. int i, error;
  1768.  
  1769. input_dev = input_allocate_device();
  1770. if (!input_dev)
  1771. return -ENOMEM;
  1772.  
  1773. xpad->dev = input_dev;
  1774. input_dev->name = xpad->name;
  1775. input_dev->phys = xpad->phys;
  1776. usb_to_input_id(xpad->udev, &input_dev->id);
  1777.  
  1778. if (xpad->xtype == XTYPE_XBOX360W) {
  1779. /* x360w controllers and the receiver have different ids */
  1780. input_dev->id.product = 0x02a1;
  1781. }
  1782.  
  1783. input_dev->dev.parent = &xpad->intf->dev;
  1784.  
  1785. input_set_drvdata(input_dev, xpad);
  1786.  
  1787. if (xpad->xtype != XTYPE_XBOX360W) {
  1788. input_dev->open = xpad_open;
  1789. input_dev->close = xpad_close;
  1790. }
  1791.  
  1792. if (!(xpad->mapping & MAP_STICKS_TO_NULL)) {
  1793. /* set up axes */
  1794. for (i = 0; xpad_abs[i] >= 0; i++)
  1795. xpad_set_up_abs(input_dev, xpad_abs[i]);
  1796. }
  1797.  
  1798. /* set up standard buttons */
  1799. for (i = 0; xpad_common_btn[i] >= 0; i++)
  1800. input_set_capability(input_dev, EV_KEY, xpad_common_btn[i]);
  1801.  
  1802. /* set up model-specific ones */
  1803. if (xpad->xtype == XTYPE_XBOX360 || xpad->xtype == XTYPE_XBOX360W ||
  1804. xpad->xtype == XTYPE_XBOXONE) {
  1805. for (i = 0; xpad360_btn[i] >= 0; i++)
  1806. input_set_capability(input_dev, EV_KEY, xpad360_btn[i]);
  1807. if (xpad->mapping & MAP_SELECT_BUTTON)
  1808. input_set_capability(input_dev, EV_KEY, KEY_RECORD);
  1809. } else {
  1810. for (i = 0; xpad_btn[i] >= 0; i++)
  1811. input_set_capability(input_dev, EV_KEY, xpad_btn[i]);
  1812. }
  1813.  
  1814. if (xpad->mapping & MAP_DPAD_TO_BUTTONS) {
  1815. for (i = 0; xpad_btn_pad[i] >= 0; i++)
  1816. input_set_capability(input_dev, EV_KEY,
  1817. xpad_btn_pad[i]);
  1818. }
  1819.  
  1820. /*
  1821. * This should be a simple else block. However historically
  1822. * xbox360w has mapped DPAD to buttons while xbox360 did not. This
  1823. * made no sense, but now we can not just switch back and have to
  1824. * support both behaviors.
  1825. */
  1826. if (!(xpad->mapping & MAP_DPAD_TO_BUTTONS) ||
  1827. xpad->xtype == XTYPE_XBOX360W) {
  1828. for (i = 0; xpad_abs_pad[i] >= 0; i++)
  1829. xpad_set_up_abs(input_dev, xpad_abs_pad[i]);
  1830. }
  1831.  
  1832. if (xpad->mapping & MAP_TRIGGERS_TO_BUTTONS) {
  1833. for (i = 0; xpad_btn_triggers[i] >= 0; i++)
  1834. input_set_capability(input_dev, EV_KEY,
  1835. xpad_btn_triggers[i]);
  1836. } else {
  1837. for (i = 0; xpad_abs_triggers[i] >= 0; i++)
  1838. xpad_set_up_abs(input_dev, xpad_abs_triggers[i]);
  1839. }
  1840.  
  1841. error = xpad_init_ff(xpad);
  1842. if (error)
  1843. goto err_free_input;
  1844.  
  1845. error = xpad_led_probe(xpad);
  1846. if (error)
  1847. goto err_destroy_ff;
  1848.  
  1849. error = input_register_device(xpad->dev);
  1850. if (error)
  1851. goto err_disconnect_led;
  1852.  
  1853. xpad->input_created = true;
  1854. return 0;
  1855.  
  1856. err_disconnect_led:
  1857. xpad_led_disconnect(xpad);
  1858. err_destroy_ff:
  1859. input_ff_destroy(input_dev);
  1860. err_free_input:
  1861. input_free_device(input_dev);
  1862. return error;
  1863. }
  1864.  
  1865. static int xpad_probe(struct usb_interface *intf, const struct usb_device_id *id)
  1866. {
  1867. printk(KERN_INFO "xpad: currently in xpad_probe");
  1868. struct usb_device *udev = interface_to_usbdev(intf);
  1869. struct usb_xpad *xpad;
  1870. struct usb_endpoint_descriptor *ep_irq_in, *ep_irq_out;
  1871. int i, error;
  1872.  
  1873. if (intf->cur_altsetting->desc.bNumEndpoints != 2)
  1874. return -ENODEV;
  1875.  
  1876. for (i = 0; xpad_device[i].idVendor; i++) {
  1877. if ((le16_to_cpu(udev->descriptor.idVendor) == xpad_device[i].idVendor) &&
  1878. (le16_to_cpu(udev->descriptor.idProduct) == xpad_device[i].idProduct))
  1879. break;
  1880. }
  1881.  
  1882. xpad = kzalloc(sizeof(struct usb_xpad), GFP_KERNEL);
  1883. if (!xpad)
  1884. return -ENOMEM;
  1885.  
  1886. usb_make_path(udev, xpad->phys, sizeof(xpad->phys));
  1887. strlcat(xpad->phys, "/input0", sizeof(xpad->phys));
  1888.  
  1889. xpad->idata = usb_alloc_coherent(udev, XPAD_PKT_LEN,
  1890. GFP_KERNEL, &xpad->idata_dma);
  1891. if (!xpad->idata) {
  1892. error = -ENOMEM;
  1893. goto err_free_mem;
  1894. }
  1895.  
  1896. xpad->irq_in = usb_alloc_urb(0, GFP_KERNEL);
  1897. if (!xpad->irq_in) {
  1898. error = -ENOMEM;
  1899. goto err_free_idata;
  1900. }
  1901.  
  1902. xpad->udev = udev;
  1903. xpad->intf = intf;
  1904. xpad->mapping = xpad_device[i].mapping;
  1905. xpad->xtype = xpad_device[i].xtype;
  1906. xpad->name = xpad_device[i].name;
  1907. INIT_WORK(&xpad->work, xpad_presence_work);
  1908.  
  1909. if (xpad->xtype == XTYPE_UNKNOWN) {
  1910. if (intf->cur_altsetting->desc.bInterfaceClass == USB_CLASS_VENDOR_SPEC) {
  1911. if (intf->cur_altsetting->desc.bInterfaceProtocol == 129)
  1912. xpad->xtype = XTYPE_XBOX360W;
  1913. else if (intf->cur_altsetting->desc.bInterfaceProtocol == 208)
  1914. xpad->xtype = XTYPE_XBOXONE;
  1915. else
  1916. xpad->xtype = XTYPE_XBOX360;
  1917. } else {
  1918. xpad->xtype = XTYPE_XBOX;
  1919. }
  1920.  
  1921. if (dpad_to_buttons)
  1922. xpad->mapping |= MAP_DPAD_TO_BUTTONS;
  1923. if (triggers_to_buttons)
  1924. xpad->mapping |= MAP_TRIGGERS_TO_BUTTONS;
  1925. if (sticks_to_null)
  1926. xpad->mapping |= MAP_STICKS_TO_NULL;
  1927. }
  1928.  
  1929. if (xpad->xtype == XTYPE_XBOXONE &&
  1930. intf->cur_altsetting->desc.bInterfaceNumber != 0) {
  1931. /*
  1932. * The Xbox One controller lists three interfaces all with the
  1933. * same interface class, subclass and protocol. Differentiate by
  1934. * interface number.
  1935. */
  1936. error = -ENODEV;
  1937. goto err_free_in_urb;
  1938. }
  1939.  
  1940. ep_irq_in = ep_irq_out = NULL;
  1941.  
  1942. for (i = 0; i < 2; i++) {
  1943. struct usb_endpoint_descriptor *ep =
  1944. &intf->cur_altsetting->endpoint[i].desc;
  1945.  
  1946. if (usb_endpoint_xfer_int(ep)) {
  1947. if (usb_endpoint_dir_in(ep))
  1948. ep_irq_in = ep;
  1949. else
  1950. ep_irq_out = ep;
  1951. }
  1952. }
  1953.  
  1954. if (!ep_irq_in || !ep_irq_out) {
  1955. error = -ENODEV;
  1956. goto err_free_in_urb;
  1957. }
  1958.  
  1959. error = xpad_init_output(intf, xpad, ep_irq_out);
  1960. if (error)
  1961. goto err_free_in_urb;
  1962.  
  1963. usb_fill_int_urb(xpad->irq_in, udev,
  1964. usb_rcvintpipe(udev, ep_irq_in->bEndpointAddress),
  1965. xpad->idata, XPAD_PKT_LEN, xpad_irq_in,
  1966. xpad, ep_irq_in->bInterval);
  1967. xpad->irq_in->transfer_dma = xpad->idata_dma;
  1968. xpad->irq_in->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
  1969.  
  1970. usb_set_intfdata(intf, xpad);
  1971.  
  1972. if (xpad->xtype == XTYPE_XBOX360W) {
  1973. /*
  1974. * Submit the int URB immediately rather than waiting for open
  1975. * because we get status messages from the device whether
  1976. * or not any controllers are attached. In fact, it's
  1977. * exactly the message that a controller has arrived that
  1978. * we're waiting for.
  1979. */
  1980. error = xpad360w_start_input(xpad);
  1981. if (error)
  1982. goto err_deinit_output;
  1983. /*
  1984. * Wireless controllers require RESET_RESUME to work properly
  1985. * after suspend. Ideally this quirk should be in usb core
  1986. * quirk list, but we have too many vendors producing these
  1987. * controllers and we'd need to maintain 2 identical lists
  1988. * here in this driver and in usb core.
  1989. */
  1990. udev->quirks |= USB_QUIRK_RESET_RESUME;
  1991. } else {
  1992. error = xpad_init_input(xpad);
  1993. if (error)
  1994. goto err_deinit_output;
  1995. }
  1996. return 0;
  1997.  
  1998. err_deinit_output:
  1999. xpad_deinit_output(xpad);
  2000. err_free_in_urb:
  2001. usb_free_urb(xpad->irq_in);
  2002. err_free_idata:
  2003. usb_free_coherent(udev, XPAD_PKT_LEN, xpad->idata, xpad->idata_dma);
  2004. err_free_mem:
  2005. kfree(xpad);
  2006. return error;
  2007. }
  2008.  
  2009. static void xpad_disconnect(struct usb_interface *intf)
  2010. {
  2011. struct usb_xpad *xpad = usb_get_intfdata(intf);
  2012.  
  2013. if (xpad->xtype == XTYPE_XBOX360W)
  2014. xpad360w_stop_input(xpad);
  2015.  
  2016. xpad_deinit_input(xpad);
  2017.  
  2018. /*
  2019. * Now that both input device and LED device are gone we can
  2020. * stop output URB.
  2021. */
  2022. xpad_stop_output(xpad);
  2023.  
  2024. xpad_deinit_output(xpad);
  2025.  
  2026. usb_free_urb(xpad->irq_in);
  2027. usb_free_coherent(xpad->udev, XPAD_PKT_LEN,
  2028. xpad->idata, xpad->idata_dma);
  2029.  
  2030. kfree(xpad);
  2031.  
  2032. usb_set_intfdata(intf, NULL);
  2033. }
  2034.  
  2035. static int xpad_suspend(struct usb_interface *intf, pm_message_t message)
  2036. {
  2037. struct usb_xpad *xpad = usb_get_intfdata(intf);
  2038. struct input_dev *input = xpad->dev;
  2039.  
  2040. if (xpad->xtype == XTYPE_XBOX360W) {
  2041. /*
  2042. * Wireless controllers always listen to input so
  2043. * they are notified when controller shows up
  2044. * or goes away.
  2045. */
  2046. xpad360w_stop_input(xpad);
  2047.  
  2048. /*
  2049. * The wireless adapter is going off now, so the
  2050. * gamepads are going to become disconnected.
  2051. * Unless explicitly disabled, power them down
  2052. * so they don't just sit there flashing.
  2053. */
  2054. if (auto_poweroff && xpad->pad_present)
  2055. xpad360w_poweroff_controller(xpad);
  2056. } else {
  2057. mutex_lock(&input->mutex);
  2058. if (input->users)
  2059. xpad_stop_input(xpad);
  2060. mutex_unlock(&input->mutex);
  2061. }
  2062.  
  2063. xpad_stop_output(xpad);
  2064.  
  2065. return 0;
  2066. }
  2067.  
  2068. static int xpad_resume(struct usb_interface *intf)
  2069. {
  2070. struct usb_xpad *xpad = usb_get_intfdata(intf);
  2071. struct input_dev *input = xpad->dev;
  2072. int retval = 0;
  2073.  
  2074. if (xpad->xtype == XTYPE_XBOX360W) {
  2075. retval = xpad360w_start_input(xpad);
  2076. } else {
  2077. mutex_lock(&input->mutex);
  2078. if (input->users) {
  2079. retval = xpad_start_input(xpad);
  2080. } else if (xpad->xtype == XTYPE_XBOXONE) {
  2081. /*
  2082. * Even if there are no users, we'll send Xbox One pads
  2083. * the startup sequence so they don't sit there and
  2084. * blink until somebody opens the input device again.
  2085. */
  2086. retval = xpad_start_xbox_one(xpad);
  2087. }
  2088. mutex_unlock(&input->mutex);
  2089. }
  2090.  
  2091. return retval;
  2092. }
  2093.  
  2094. static struct usb_driver xpad_driver = {
  2095. .name = "xpad",
  2096. .probe = xpad_probe,
  2097. .disconnect = xpad_disconnect,
  2098. .suspend = xpad_suspend,
  2099. .resume = xpad_resume,
  2100. .id_table = xpad_table,
  2101. };
  2102.  
  2103. module_usb_driver(xpad_driver);
  2104.  
  2105. MODULE_AUTHOR("Marko Friedemann <[email protected]>");
  2106. MODULE_DESCRIPTION("X-Box pad driver");
  2107. MODULE_LICENSE("GPL");
Add Comment
Please, Sign In to add comment