projects / linux-2.6-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
HID: wacom: fix problems when device is not a valid USB device
[linux-2.6-block.git] / drivers / hid / hid-sony.c
CommitLineData
2874c5fd 1// SPDX-License-Identifier: GPL-2.0-or-later
bd28ce00 2/*
077147a3 3 * HID driver for Sony / PS2 / PS3 / PS4 BD devices.
bd28ce00
JS		 4 *
5 * Copyright (c) 1999 Andreas Gal
6 * Copyright (c) 2000-2005 Vojtech Pavlik <vojtech@suse.cz>
7 * Copyright (c) 2005 Michael Haboustak <mike-@cinci.rr.com> for Concept2, Inc
bd28ce00 8 * Copyright (c) 2008 Jiri Slaby
078328da
JK		 9 * Copyright (c) 2012 David Dillow <dave@thedillows.org>
10 * Copyright (c) 2006-2013 Jiri Kosina
f04d5140 11 * Copyright (c) 2013 Colin Leitner <colin.leitner@gmail.com>
c4425c8f 12 * Copyright (c) 2014-2016 Frank Praznik <frank.praznik@gmail.com>
b7289cb1 13 * Copyright (c) 2018 Todd Kelner
a4bfe13f 14 * Copyright (c) 2020-2021 Pascal Giard <pascal.giard@etsmtl.ca>
32e411d0 15 * Copyright (c) 2020 Sanjay Govind <sanjay.govind9@gmail.com>
a4bfe13f 16 * Copyright (c) 2021 Daniel Nguyen <daniel.nguyen.1@ens.etsmtl.ca>
bd28ce00
JS		 17 */
18
19/*
bd28ce00
JS		 20 */
21
ad142b9e
FP		 22/*
23 * NOTE: in order for the Sony PS3 BD Remote Control to be found by
078328da
JK		 24 * a Bluetooth host, the key combination Start+Enter has to be kept pressed
25 * for about 7 seconds with the Bluetooth Host Controller in discovering mode.
26 *
27 * There will be no PIN request from the device.
28 */
29
bd28ce00
JS		 30#include <linux/device.h>
31#include <linux/hid.h>
32#include <linux/module.h>
5a0e3ad6 33#include <linux/slab.h>
40e32ee6 34#include <linux/leds.h>
d902f472
FP		 35#include <linux/power_supply.h>
36#include <linux/spinlock.h>
d2d782fc 37#include <linux/list.h>
8025087a 38#include <linux/idr.h>
e5606230 39#include <linux/input/mt.h>
49b9ca6c 40#include <linux/crc32.h>
cc894ac5
PG		 41#include <linux/usb.h>
42#include <linux/timer.h>
49b9ca6c 43#include <asm/unaligned.h>
bd28ce00
JS		 44
45#include "hid-ids.h"
46
6c79c18c
FP		 47#define VAIO_RDESC_CONSTANT BIT(0)
48#define SIXAXIS_CONTROLLER_USB BIT(1)
49#define SIXAXIS_CONTROLLER_BT BIT(2)
50#define BUZZ_CONTROLLER BIT(3)
51#define PS3REMOTE BIT(4)
8ab1676b
FP		 52#define DUALSHOCK4_CONTROLLER_USB BIT(5)
53#define DUALSHOCK4_CONTROLLER_BT BIT(6)
35f436c3
RC		 54#define DUALSHOCK4_DONGLE BIT(7)
55#define MOTION_CONTROLLER_USB BIT(8)
56#define MOTION_CONTROLLER_BT BIT(9)
57#define NAVIGATION_CONTROLLER_USB BIT(10)
58#define NAVIGATION_CONTROLLER_BT BIT(11)
59#define SINO_LITE_CONTROLLER BIT(12)
60#define FUTUREMAX_DANCE_MAT BIT(13)
b7289cb1
TK		 61#define NSG_MR5U_REMOTE_BT BIT(14)
62#define NSG_MR7U_REMOTE_BT BIT(15)
69481059 63#define SHANWAN_GAMEPAD BIT(16)
32e411d0
SG		 64#define GH_GUITAR_CONTROLLER BIT(17)
65#define GHL_GUITAR_PS3WIIU BIT(18)
a4bfe13f 66#define GHL_GUITAR_PS4 BIT(19)
cc6e0bbb 67
fee4e2d5 68#define SIXAXIS_CONTROLLER (SIXAXIS_CONTROLLER_USB | SIXAXIS_CONTROLLER_BT)
b3bca326 69#define MOTION_CONTROLLER (MOTION_CONTROLLER_USB | MOTION_CONTROLLER_BT)
4545ee0a
SW		 70#define NAVIGATION_CONTROLLER (NAVIGATION_CONTROLLER_USB |\
71 NAVIGATION_CONTROLLER_BT)
68330d83 72#define DUALSHOCK4_CONTROLLER (DUALSHOCK4_CONTROLLER_USB |\
35f436c3
RC		 73 DUALSHOCK4_CONTROLLER_BT | \
74 DUALSHOCK4_DONGLE)
fee4e2d5 75#define SONY_LED_SUPPORT (SIXAXIS_CONTROLLER | BUZZ_CONTROLLER |\
4545ee0a
SW		 76 DUALSHOCK4_CONTROLLER | MOTION_CONTROLLER |\
77 NAVIGATION_CONTROLLER)
12e9a6d7 78#define SONY_BATTERY_SUPPORT (SIXAXIS_CONTROLLER | DUALSHOCK4_CONTROLLER |\
4545ee0a 79 MOTION_CONTROLLER_BT | NAVIGATION_CONTROLLER)
c5e0c1c4
FP		 80#define SONY_FF_SUPPORT (SIXAXIS_CONTROLLER | DUALSHOCK4_CONTROLLER |\
81 MOTION_CONTROLLER)
0f398230
FP		 82#define SONY_BT_DEVICE (SIXAXIS_CONTROLLER_BT | DUALSHOCK4_CONTROLLER_BT |\
83 MOTION_CONTROLLER_BT | NAVIGATION_CONTROLLER_BT)
b7289cb1 84#define NSG_MRXU_REMOTE (NSG_MR5U_REMOTE_BT | NSG_MR7U_REMOTE_BT)
60781cf4
FP		 85
86#define MAX_LEDS 4
b7289cb1
TK		 87#define NSG_MRXU_MAX_X 1667
88#define NSG_MRXU_MAX_Y 1868
0a286ef2 89
a4bfe13f
DN		 90/* The PS3/Wii U dongles require a poke every 10 seconds, but the PS4
91 * requires one every 8 seconds. Using 8 seconds for all for simplicity.
92 */
93#define GHL_GUITAR_POKE_INTERVAL 8 /* In seconds */
32e411d0 94#define GUITAR_TILT_USAGE 44
cc894ac5 95
a4bfe13f 96/* Magic data taken from GHLtarUtility:
cc894ac5
PG		 97 * https://github.com/ghlre/GHLtarUtility/blob/master/PS3Guitar.cs
98 * Note: The Wii U and PS3 dongles happen to share the same!
99 */
cc894ac5
PG		 100static const char ghl_ps3wiiu_magic_data[] = {
101 0x02, 0x08, 0x20, 0x00, 0x00, 0x00, 0x00, 0x00
102};
e57a67da 103
a4bfe13f
DN		 104/* Magic data for the PS4 dongles sniffed with a USB protocol
105 * analyzer.
106 */
107static const char ghl_ps4_magic_data[] = {
108 0x30, 0x02, 0x08, 0x0A, 0x00, 0x00, 0x00, 0x00, 0x00
109};
110
c5e0c1c4 111/* PS/3 Motion controller */
1adf904e 112static u8 motion_rdesc[] = {
c5e0c1c4
FP		 113 0x05, 0x01, /* Usage Page (Desktop), */
114 0x09, 0x04, /* Usage (Joystick), */
115 0xA1, 0x01, /* Collection (Application), */
116 0xA1, 0x02, /* Collection (Logical), */
117 0x85, 0x01, /* Report ID (1), */
c5e0c1c4 118 0x75, 0x01, /* Report Size (1), */
8b2513c3 119 0x95, 0x15, /* Report Count (21), */
c5e0c1c4
FP		 120 0x15, 0x00, /* Logical Minimum (0), */
121 0x25, 0x01, /* Logical Maximum (1), */
122 0x35, 0x00, /* Physical Minimum (0), */
123 0x45, 0x01, /* Physical Maximum (1), */
124 0x05, 0x09, /* Usage Page (Button), */
125 0x19, 0x01, /* Usage Minimum (01h), */
8b2513c3
SW		 126 0x29, 0x15, /* Usage Maximum (15h), */
127 0x81, 0x02, /* Input (Variable), * Buttons */
128 0x95, 0x0B, /* Report Count (11), */
c5e0c1c4 129 0x06, 0x00, 0xFF, /* Usage Page (FF00h), */
8b2513c3 130 0x81, 0x03, /* Input (Constant, Variable), * Padding */
c5e0c1c4
FP		 131 0x15, 0x00, /* Logical Minimum (0), */
132 0x26, 0xFF, 0x00, /* Logical Maximum (255), */
133 0x05, 0x01, /* Usage Page (Desktop), */
c5e0c1c4
FP		 134 0xA1, 0x00, /* Collection (Physical), */
135 0x75, 0x08, /* Report Size (8), */
8b2513c3 136 0x95, 0x01, /* Report Count (1), */
c5e0c1c4
FP		 137 0x35, 0x00, /* Physical Minimum (0), */
138 0x46, 0xFF, 0x00, /* Physical Maximum (255), */
139 0x09, 0x30, /* Usage (X), */
8b2513c3 140 0x81, 0x02, /* Input (Variable), * Trigger */
c5e0c1c4 141 0xC0, /* End Collection, */
8b2513c3
SW		 142 0x06, 0x00, 0xFF, /* Usage Page (FF00h), */
143 0x75, 0x08, /* Report Size (8), */
144 0x95, 0x07, /* Report Count (7), * skip 7 bytes */
c5e0c1c4 145 0x81, 0x02, /* Input (Variable), */
8b2513c3 146 0x05, 0x01, /* Usage Page (Desktop), */
c5e0c1c4 147 0x75, 0x10, /* Report Size (16), */
8b2513c3
SW		 148 0x46, 0xFF, 0xFF, /* Physical Maximum (65535), */
149 0x27, 0xFF, 0xFF, 0x00, 0x00, /* Logical Maximum (65535), */
150 0x95, 0x03, /* Report Count (3), * 3x Accels */
151 0x09, 0x33, /* Usage (rX), */
152 0x09, 0x34, /* Usage (rY), */
153 0x09, 0x35, /* Usage (rZ), */
154 0x81, 0x02, /* Input (Variable), */
155 0x06, 0x00, 0xFF, /* Usage Page (FF00h), */
156 0x95, 0x03, /* Report Count (3), * Skip Accels 2nd frame */
157 0x81, 0x02, /* Input (Variable), */
158 0x05, 0x01, /* Usage Page (Desktop), */
c5e0c1c4 159 0x09, 0x01, /* Usage (Pointer), */
8b2513c3
SW		 160 0x95, 0x03, /* Report Count (3), * 3x Gyros */
161 0x81, 0x02, /* Input (Variable), */
162 0x06, 0x00, 0xFF, /* Usage Page (FF00h), */
163 0x95, 0x03, /* Report Count (3), * Skip Gyros 2nd frame */
c5e0c1c4 164 0x81, 0x02, /* Input (Variable), */
8b2513c3
SW		 165 0x75, 0x0C, /* Report Size (12), */
166 0x46, 0xFF, 0x0F, /* Physical Maximum (4095), */
167 0x26, 0xFF, 0x0F, /* Logical Maximum (4095), */
168 0x95, 0x04, /* Report Count (4), * Skip Temp and Magnetometers */
169 0x81, 0x02, /* Input (Variable), */
170 0x75, 0x08, /* Report Size (8), */
171 0x46, 0xFF, 0x00, /* Physical Maximum (255), */
172 0x26, 0xFF, 0x00, /* Logical Maximum (255), */
173 0x95, 0x06, /* Report Count (6), * Skip Timestamp and Extension Bytes */
174 0x81, 0x02, /* Input (Variable), */
175 0x75, 0x08, /* Report Size (8), */
176 0x95, 0x30, /* Report Count (48), */
177 0x09, 0x01, /* Usage (Pointer), */
178 0x91, 0x02, /* Output (Variable), */
179 0x75, 0x08, /* Report Size (8), */
180 0x95, 0x30, /* Report Count (48), */
181 0x09, 0x01, /* Usage (Pointer), */
182 0xB1, 0x02, /* Feature (Variable), */
c5e0c1c4
FP		 183 0xC0, /* End Collection, */
184 0xA1, 0x02, /* Collection (Logical), */
185 0x85, 0x02, /* Report ID (2), */
186 0x75, 0x08, /* Report Size (8), */
187 0x95, 0x30, /* Report Count (48), */
188 0x09, 0x01, /* Usage (Pointer), */
189 0xB1, 0x02, /* Feature (Variable), */
190 0xC0, /* End Collection, */
191 0xA1, 0x02, /* Collection (Logical), */
192 0x85, 0xEE, /* Report ID (238), */
193 0x75, 0x08, /* Report Size (8), */
194 0x95, 0x30, /* Report Count (48), */
195 0x09, 0x01, /* Usage (Pointer), */
196 0xB1, 0x02, /* Feature (Variable), */
197 0xC0, /* End Collection, */
198 0xA1, 0x02, /* Collection (Logical), */
199 0x85, 0xEF, /* Report ID (239), */
200 0x75, 0x08, /* Report Size (8), */
201 0x95, 0x30, /* Report Count (48), */
202 0x09, 0x01, /* Usage (Pointer), */
203 0xB1, 0x02, /* Feature (Variable), */
204 0xC0, /* End Collection, */
205 0xC0 /* End Collection */
206};
207
1adf904e 208static u8 ps3remote_rdesc[] = {
078328da
JK		 209 0x05, 0x01, /* GUsagePage Generic Desktop */
210 0x09, 0x05, /* LUsage 0x05 [Game Pad] */
211 0xA1, 0x01, /* MCollection Application (mouse, keyboard) */
212
213 /* Use collection 1 for joypad buttons */
214 0xA1, 0x02, /* MCollection Logical (interrelated data) */
215
ef916ef5
AO		 216 /*
217 * Ignore the 1st byte, maybe it is used for a controller
218 * number but it's not needed for correct operation
219 */
078328da
JK		 220 0x75, 0x08, /* GReportSize 0x08 [8] */
221 0x95, 0x01, /* GReportCount 0x01 [1] */
222 0x81, 0x01, /* MInput 0x01 (Const[0] Arr[1] Abs[2]) */
223
ef916ef5
AO		 224 /*
225 * Bytes from 2nd to 4th are a bitmap for joypad buttons, for these
226 * buttons multiple keypresses are allowed
227 */
078328da
JK		 228 0x05, 0x09, /* GUsagePage Button */
229 0x19, 0x01, /* LUsageMinimum 0x01 [Button 1 (primary/trigger)] */
230 0x29, 0x18, /* LUsageMaximum 0x18 [Button 24] */
231 0x14, /* GLogicalMinimum [0] */
232 0x25, 0x01, /* GLogicalMaximum 0x01 [1] */
233 0x75, 0x01, /* GReportSize 0x01 [1] */
234 0x95, 0x18, /* GReportCount 0x18 [24] */
235 0x81, 0x02, /* MInput 0x02 (Data[0] Var[1] Abs[2]) */
236
237 0xC0, /* MEndCollection */
238
239 /* Use collection 2 for remote control buttons */
240 0xA1, 0x02, /* MCollection Logical (interrelated data) */
241
242 /* 5th byte is used for remote control buttons */
243 0x05, 0x09, /* GUsagePage Button */
244 0x18, /* LUsageMinimum [No button pressed] */
245 0x29, 0xFE, /* LUsageMaximum 0xFE [Button 254] */
246 0x14, /* GLogicalMinimum [0] */
247 0x26, 0xFE, 0x00, /* GLogicalMaximum 0x00FE [254] */
248 0x75, 0x08, /* GReportSize 0x08 [8] */
249 0x95, 0x01, /* GReportCount 0x01 [1] */
250 0x80, /* MInput */
251
ef916ef5
AO		 252 /*
253 * Ignore bytes from 6th to 11th, 6th to 10th are always constant at
254 * 0xff and 11th is for press indication
255 */
078328da
JK		 256 0x75, 0x08, /* GReportSize 0x08 [8] */
257 0x95, 0x06, /* GReportCount 0x06 [6] */
258 0x81, 0x01, /* MInput 0x01 (Const[0] Arr[1] Abs[2]) */
259
260 /* 12th byte is for battery strength */
261 0x05, 0x06, /* GUsagePage Generic Device Controls */
262 0x09, 0x20, /* LUsage 0x20 [Battery Strength] */
263 0x14, /* GLogicalMinimum [0] */
264 0x25, 0x05, /* GLogicalMaximum 0x05 [5] */
265 0x75, 0x08, /* GReportSize 0x08 [8] */
266 0x95, 0x01, /* GReportCount 0x01 [1] */
267 0x81, 0x02, /* MInput 0x02 (Data[0] Var[1] Abs[2]) */
268
269 0xC0, /* MEndCollection */
270
271 0xC0 /* MEndCollection [Game Pad] */
272};
273
274static const unsigned int ps3remote_keymap_joypad_buttons[] = {
275 [0x01] = KEY_SELECT,
276 [0x02] = BTN_THUMBL, /* L3 */
277 [0x03] = BTN_THUMBR, /* R3 */
278 [0x04] = BTN_START,
279 [0x05] = KEY_UP,
280 [0x06] = KEY_RIGHT,
281 [0x07] = KEY_DOWN,
282 [0x08] = KEY_LEFT,
283 [0x09] = BTN_TL2, /* L2 */
284 [0x0a] = BTN_TR2, /* R2 */
285 [0x0b] = BTN_TL, /* L1 */
286 [0x0c] = BTN_TR, /* R1 */
287 [0x0d] = KEY_OPTION, /* options/triangle */
288 [0x0e] = KEY_BACK, /* back/circle */
289 [0x0f] = BTN_0, /* cross */
290 [0x10] = KEY_SCREEN, /* view/square */
291 [0x11] = KEY_HOMEPAGE, /* PS button */
292 [0x14] = KEY_ENTER,
293};
294static const unsigned int ps3remote_keymap_remote_buttons[] = {
295 [0x00] = KEY_1,
296 [0x01] = KEY_2,
297 [0x02] = KEY_3,
298 [0x03] = KEY_4,
299 [0x04] = KEY_5,
300 [0x05] = KEY_6,
301 [0x06] = KEY_7,
302 [0x07] = KEY_8,
303 [0x08] = KEY_9,
304 [0x09] = KEY_0,
305 [0x0e] = KEY_ESC, /* return */
306 [0x0f] = KEY_CLEAR,
307 [0x16] = KEY_EJECTCD,
308 [0x1a] = KEY_MENU, /* top menu */
309 [0x28] = KEY_TIME,
310 [0x30] = KEY_PREVIOUS,
311 [0x31] = KEY_NEXT,
312 [0x32] = KEY_PLAY,
313 [0x33] = KEY_REWIND, /* scan back */
314 [0x34] = KEY_FORWARD, /* scan forward */
315 [0x38] = KEY_STOP,
316 [0x39] = KEY_PAUSE,
317 [0x40] = KEY_CONTEXT_MENU, /* pop up/menu */
318 [0x60] = KEY_FRAMEBACK, /* slow/step back */
319 [0x61] = KEY_FRAMEFORWARD, /* slow/step forward */
320 [0x63] = KEY_SUBTITLE,
321 [0x64] = KEY_AUDIO,
322 [0x65] = KEY_ANGLE,
323 [0x70] = KEY_INFO, /* display */
324 [0x80] = KEY_BLUE,
325 [0x81] = KEY_RED,
326 [0x82] = KEY_GREEN,
327 [0x83] = KEY_YELLOW,
328};
329
f04d5140 330static const unsigned int buzz_keymap[] = {
ad142b9e
FP		 331 /*
332 * The controller has 4 remote buzzers, each with one LED and 5
f04d5140 333 * buttons.
09593e38 334 *
f04d5140
CL		 335 * We use the mapping chosen by the controller, which is:
336 *
337 * Key Offset
338 * -------------------
339 * Buzz 1
340 * Blue 5
341 * Orange 4
342 * Green 3
343 * Yellow 2
344 *
345 * So, for example, the orange button on the third buzzer is mapped to
346 * BTN_TRIGGER_HAPPY14
347 */
09593e38
AO		 348 [1] = BTN_TRIGGER_HAPPY1,
349 [2] = BTN_TRIGGER_HAPPY2,
350 [3] = BTN_TRIGGER_HAPPY3,
351 [4] = BTN_TRIGGER_HAPPY4,
352 [5] = BTN_TRIGGER_HAPPY5,
353 [6] = BTN_TRIGGER_HAPPY6,
354 [7] = BTN_TRIGGER_HAPPY7,
355 [8] = BTN_TRIGGER_HAPPY8,
356 [9] = BTN_TRIGGER_HAPPY9,
f04d5140
CL		 357 [10] = BTN_TRIGGER_HAPPY10,
358 [11] = BTN_TRIGGER_HAPPY11,
359 [12] = BTN_TRIGGER_HAPPY12,
360 [13] = BTN_TRIGGER_HAPPY13,
361 [14] = BTN_TRIGGER_HAPPY14,
362 [15] = BTN_TRIGGER_HAPPY15,
363 [16] = BTN_TRIGGER_HAPPY16,
364 [17] = BTN_TRIGGER_HAPPY17,
365 [18] = BTN_TRIGGER_HAPPY18,
366 [19] = BTN_TRIGGER_HAPPY19,
367 [20] = BTN_TRIGGER_HAPPY20,
368};
369
b8f0970d
RC		 370/* The Navigation controller is a partial DS3 and uses the same HID report
371 * and hence the same keymap indices, however not not all axes/buttons
372 * are physically present. We use the same axis and button mapping as
373 * the DS3, which uses the Linux gamepad spec.
374 */
375static const unsigned int navigation_absmap[] = {
376 [0x30] = ABS_X,
377 [0x31] = ABS_Y,
378 [0x33] = ABS_Z, /* L2 */
379};
380
381/* Buttons not physically available on the device, but still available
382 * in the reports are explicitly set to 0 for documentation purposes.
383 */
384static const unsigned int navigation_keymap[] = {
385 [0x01] = 0, /* Select */
386 [0x02] = BTN_THUMBL, /* L3 */
387 [0x03] = 0, /* R3 */
388 [0x04] = 0, /* Start */
389 [0x05] = BTN_DPAD_UP, /* Up */
390 [0x06] = BTN_DPAD_RIGHT, /* Right */
391 [0x07] = BTN_DPAD_DOWN, /* Down */
392 [0x08] = BTN_DPAD_LEFT, /* Left */
393 [0x09] = BTN_TL2, /* L2 */
394 [0x0a] = 0, /* R2 */
395 [0x0b] = BTN_TL, /* L1 */
396 [0x0c] = 0, /* R1 */
397 [0x0d] = BTN_NORTH, /* Triangle */
398 [0x0e] = BTN_EAST, /* Circle */
399 [0x0f] = BTN_SOUTH, /* Cross */
400 [0x10] = BTN_WEST, /* Square */
401 [0x11] = BTN_MODE, /* PS */
402};
403
e19a267b
RC		 404static const unsigned int sixaxis_absmap[] = {
405 [0x30] = ABS_X,
406 [0x31] = ABS_Y,
407 [0x32] = ABS_RX, /* right stick X */
408 [0x35] = ABS_RY, /* right stick Y */
409};
410
411static const unsigned int sixaxis_keymap[] = {
412 [0x01] = BTN_SELECT, /* Select */
413 [0x02] = BTN_THUMBL, /* L3 */
414 [0x03] = BTN_THUMBR, /* R3 */
415 [0x04] = BTN_START, /* Start */
416 [0x05] = BTN_DPAD_UP, /* Up */
417 [0x06] = BTN_DPAD_RIGHT, /* Right */
418 [0x07] = BTN_DPAD_DOWN, /* Down */
419 [0x08] = BTN_DPAD_LEFT, /* Left */
420 [0x09] = BTN_TL2, /* L2 */
421 [0x0a] = BTN_TR2, /* R2 */
422 [0x0b] = BTN_TL, /* L1 */
423 [0x0c] = BTN_TR, /* R1 */
424 [0x0d] = BTN_NORTH, /* Triangle */
425 [0x0e] = BTN_EAST, /* Circle */
426 [0x0f] = BTN_SOUTH, /* Cross */
427 [0x10] = BTN_WEST, /* Square */
428 [0x11] = BTN_MODE, /* PS */
429};
430
9131f8cc
RC		 431static const unsigned int ds4_absmap[] = {
432 [0x30] = ABS_X,
433 [0x31] = ABS_Y,
434 [0x32] = ABS_RX, /* right stick X */
435 [0x33] = ABS_Z, /* L2 */
436 [0x34] = ABS_RZ, /* R2 */
437 [0x35] = ABS_RY, /* right stick Y */
438};
439
440static const unsigned int ds4_keymap[] = {
441 [0x1] = BTN_WEST, /* Square */
442 [0x2] = BTN_SOUTH, /* Cross */
443 [0x3] = BTN_EAST, /* Circle */
444 [0x4] = BTN_NORTH, /* Triangle */
445 [0x5] = BTN_TL, /* L1 */
446 [0x6] = BTN_TR, /* R1 */
447 [0x7] = BTN_TL2, /* L2 */
448 [0x8] = BTN_TR2, /* R2 */
449 [0x9] = BTN_SELECT, /* Share */
450 [0xa] = BTN_START, /* Options */
451 [0xb] = BTN_THUMBL, /* L3 */
452 [0xc] = BTN_THUMBR, /* R3 */
453 [0xd] = BTN_MODE, /* PS */
454};
455
d03ae2e1
RC		 456static const struct {int x; int y; } ds4_hat_mapping[] = {
457 {0, -1}, {1, -1}, {1, 0}, {1, 1}, {0, 1}, {-1, 1}, {-1, 0}, {-1, -1},
458 {0, 0}
459};
9131f8cc 460
d902f472
FP		 461static enum power_supply_property sony_battery_props[] = {
462 POWER_SUPPLY_PROP_PRESENT,
463 POWER_SUPPLY_PROP_CAPACITY,
464 POWER_SUPPLY_PROP_SCOPE,
465 POWER_SUPPLY_PROP_STATUS,
466};
467
55d3b664 468struct sixaxis_led {
1adf904e
PM		 469 u8 time_enabled; /* the total time the led is active (0xff means forever) */
470 u8 duty_length; /* how long a cycle is in deciseconds (0 means "really fast") */
471 u8 enabled;
472 u8 duty_off; /* % of duty_length the led is off (0xff means 100%) */
473 u8 duty_on; /* % of duty_length the led is on (0xff mean 100%) */
55d3b664
FP		 474} __packed;
475
476struct sixaxis_rumble {
1adf904e
PM		 477 u8 padding;
478 u8 right_duration; /* Right motor duration (0xff means forever) */
479 u8 right_motor_on; /* Right (small) motor on/off, only supports values of 0 or 1 (off/on) */
480 u8 left_duration; /* Left motor duration (0xff means forever) */
481 u8 left_motor_force; /* left (large) motor, supports force values from 0 to 255 */
55d3b664
FP		 482} __packed;
483
484struct sixaxis_output_report {
1adf904e 485 u8 report_id;
55d3b664 486 struct sixaxis_rumble rumble;
1adf904e
PM		 487 u8 padding[4];
488 u8 leds_bitmap; /* bitmap of enabled LEDs: LED_1 = 0x02, LED_2 = 0x04, ... */
55d3b664
FP		 489 struct sixaxis_led led[4]; /* LEDx at (4 - x) */
490 struct sixaxis_led _reserved; /* LED5, not actually soldered */
491} __packed;
492
493union sixaxis_output_report_01 {
494 struct sixaxis_output_report data;
1adf904e 495 u8 buf[36];
55d3b664
FP		 496};
497
c5e0c1c4
FP		 498struct motion_output_report_02 {
499 u8 type, zero;
500 u8 r, g, b;
501 u8 zero2;
502 u8 rumble;
503};
504
2c159de0 505#define DS4_FEATURE_REPORT_0x02_SIZE 37
55a07d62 506#define DS4_FEATURE_REPORT_0x05_SIZE 41
2c159de0 507#define DS4_FEATURE_REPORT_0x81_SIZE 7
169f15ab 508#define DS4_FEATURE_REPORT_0xA3_SIZE 49
49b9ca6c 509#define DS4_INPUT_REPORT_0x11_SIZE 78
2c159de0
RC		 510#define DS4_OUTPUT_REPORT_0x05_SIZE 32
511#define DS4_OUTPUT_REPORT_0x11_SIZE 78
29b691a8 512#define SIXAXIS_REPORT_0xF2_SIZE 17
a85d67b5 513#define SIXAXIS_REPORT_0xF5_SIZE 8
41d2d425 514#define MOTION_REPORT_0x02_SIZE 49
9b2b5c9a 515
cdc1c021
RC		 516/* Offsets relative to USB input report (0x1). Bluetooth (0x11) requires an
517 * additional +2.
518 */
d03ae2e1 519#define DS4_INPUT_REPORT_AXIS_OFFSET 1
ac797b95 520#define DS4_INPUT_REPORT_BUTTON_OFFSET 5
80786eb9 521#define DS4_INPUT_REPORT_TIMESTAMP_OFFSET 10
227c011b 522#define DS4_INPUT_REPORT_GYRO_X_OFFSET 13
cdc1c021
RC		 523#define DS4_INPUT_REPORT_BATTERY_OFFSET 30
524#define DS4_INPUT_REPORT_TOUCHPAD_OFFSET 33
525
510c8b7c 526#define SENSOR_SUFFIX " Motion Sensors"
ac797b95
RC		 527#define DS4_TOUCHPAD_SUFFIX " Touchpad"
528
77b499e7
RC		 529/* Default to 4ms poll interval, which is same as USB (not adjustable). */
530#define DS4_BT_DEFAULT_POLL_INTERVAL_MS 4
531#define DS4_BT_MAX_POLL_INTERVAL_MS 62
55a07d62
RC		 532#define DS4_GYRO_RES_PER_DEG_S 1024
533#define DS4_ACC_RES_PER_G 8192
534
510c8b7c
RC		 535#define SIXAXIS_INPUT_REPORT_ACC_X_OFFSET 41
536#define SIXAXIS_ACC_RES_PER_G 113
537
8b402c92 538static DEFINE_SPINLOCK(sony_dev_list_lock);
d2d782fc 539static LIST_HEAD(sony_device_list);
8025087a 540static DEFINE_IDA(sony_device_id_allocator);
d2d782fc 541
55a07d62
RC		 542/* Used for calibration of DS4 accelerometer and gyro. */
543struct ds4_calibration_data {
544 int abs_code;
545 short bias;
546 /* Calibration requires scaling against a sensitivity value, which is a
547 * float. Store sensitivity as a fraction to limit floating point
548 * calculations until final calibration.
549 */
550 int sens_numer;
551 int sens_denom;
552};
553
f2f47c38
RC		 554enum ds4_dongle_state {
555 DONGLE_DISCONNECTED,
556 DONGLE_CALIBRATING,
557 DONGLE_CONNECTED,
558 DONGLE_DISABLED
559};
560
b5322736 561enum sony_worker {
f2f47c38
RC		 562 SONY_WORKER_STATE,
563 SONY_WORKER_HOTPLUG
b5322736
RC		 564};
565
cc6e0bbb 566struct sony_sc {
d902f472 567 spinlock_t lock;
d2d782fc 568 struct list_head list_node;
0a286ef2 569 struct hid_device *hdev;
ac797b95 570 struct input_dev *touchpad;
227c011b 571 struct input_dev *sensor_dev;
60781cf4 572 struct led_classdev *leds[MAX_LEDS];
cc6e0bbb 573 unsigned long quirks;
f2f47c38 574 struct work_struct hotplug_worker;
0a286ef2 575 struct work_struct state_worker;
09593e38 576 void (*send_output_report)(struct sony_sc *);
297d716f
KK		 577 struct power_supply *battery;
578 struct power_supply_desc battery_desc;
8025087a 579 int device_id;
169f15ab 580 unsigned fw_version;
1a8212e8 581 bool fw_version_created;
169f15ab 582 unsigned hw_version;
1a8212e8 583 bool hw_version_created;
1adf904e 584 u8 *output_report_dmabuf;
f04d5140 585
9f323b68 586#ifdef CONFIG_SONY_FF
1adf904e
PM		 587 u8 left;
588 u8 right;
9f323b68
SE		 589#endif
590
1adf904e 591 u8 mac_address[6];
f2f47c38 592 u8 hotplug_worker_initialized;
b5322736 593 u8 state_worker_initialized;
2a242932 594 u8 defer_initialization;
1adf904e 595 u8 battery_capacity;
a76a6c18 596 int battery_status;
1adf904e 597 u8 led_state[MAX_LEDS];
1adf904e
PM		 598 u8 led_delay_on[MAX_LEDS];
599 u8 led_delay_off[MAX_LEDS];
600 u8 led_count;
80786eb9
RC		 601
602 bool timestamp_initialized;
603 u16 prev_timestamp;
604 unsigned int timestamp_us;
605
77b499e7 606 u8 ds4_bt_poll_interval;
f2f47c38 607 enum ds4_dongle_state ds4_dongle_state;
55a07d62
RC		 608 /* DS4 calibration data */
609 struct ds4_calibration_data ds4_calib_data[6];
cc894ac5 610 /* GH Live */
fb1a79a6 611 struct urb *ghl_urb;
cc894ac5 612 struct timer_list ghl_poke_timer;
cc6e0bbb
JK		 613};
614
405182c2
RC		 615static void sony_set_leds(struct sony_sc *sc);
616
b5322736
RC		 617static inline void sony_schedule_work(struct sony_sc *sc,
618 enum sony_worker which)
2a242932 619{
e0f6974a
RC		 620 unsigned long flags;
621
b5322736
RC		 622 switch (which) {
623 case SONY_WORKER_STATE:
e0f6974a
RC		 624 spin_lock_irqsave(&sc->lock, flags);
625 if (!sc->defer_initialization && sc->state_worker_initialized)
b5322736 626 schedule_work(&sc->state_worker);
e0f6974a 627 spin_unlock_irqrestore(&sc->lock, flags);
f2f47c38
RC		 628 break;
629 case SONY_WORKER_HOTPLUG:
630 if (sc->hotplug_worker_initialized)
631 schedule_work(&sc->hotplug_worker);
632 break;
b5322736 633 }
2a242932
FP		 634}
635
cc894ac5
PG		 636static void ghl_magic_poke_cb(struct urb *urb)
637{
fb1a79a6
PG		 638 struct sony_sc *sc = urb->context;
639
640 if (urb->status < 0)
641 hid_err(sc->hdev, "URB transfer failed : %d", urb->status);
642
643 mod_timer(&sc->ghl_poke_timer, jiffies + GHL_GUITAR_POKE_INTERVAL*HZ);
cc894ac5
PG		 644}
645
646static void ghl_magic_poke(struct timer_list *t)
647{
fb1a79a6 648 int ret;
cc894ac5
PG		 649 struct sony_sc *sc = from_timer(sc, t, ghl_poke_timer);
650
fb1a79a6
PG		 651 ret = usb_submit_urb(sc->ghl_urb, GFP_ATOMIC);
652 if (ret < 0)
653 hid_err(sc->hdev, "usb_submit_urb failed: %d", ret);
654}
655
a4bfe13f
DN		 656static int ghl_init_urb(struct sony_sc *sc, struct usb_device *usbdev,
657 const char ghl_magic_data[], u16 poke_size)
fb1a79a6
PG		 658{
659 struct usb_ctrlrequest *cr;
fb1a79a6 660 u8 *databuf;
cc894ac5 661 unsigned int pipe;
a4bfe13f 662 u16 ghl_magic_value = (((HID_OUTPUT_REPORT + 1) << 8) | ghl_magic_data[0]);
cc894ac5
PG		 663
664 pipe = usb_sndctrlpipe(usbdev, 0);
665
fb1a79a6
PG		 666 cr = devm_kzalloc(&sc->hdev->dev, sizeof(*cr), GFP_ATOMIC);
667 if (cr == NULL)
668 return -ENOMEM;
cc894ac5 669
fb1a79a6
PG		 670 databuf = devm_kzalloc(&sc->hdev->dev, poke_size, GFP_ATOMIC);
671 if (databuf == NULL)
672 return -ENOMEM;
cc894ac5 673
fb1a79a6 674 cr->bRequestType =
cc894ac5 675 USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_OUT;
fb1a79a6 676 cr->bRequest = USB_REQ_SET_CONFIGURATION;
a4bfe13f 677 cr->wValue = cpu_to_le16(ghl_magic_value);
fb1a79a6
PG		 678 cr->wIndex = 0;
679 cr->wLength = cpu_to_le16(poke_size);
a4bfe13f 680 memcpy(databuf, ghl_magic_data, poke_size);
cc894ac5 681 usb_fill_control_urb(
fb1a79a6
PG		 682 sc->ghl_urb, usbdev, pipe,
683 (unsigned char *) cr, databuf, poke_size,
684 ghl_magic_poke_cb, sc);
685 return 0;
cc894ac5
PG		 686}
687
688static int guitar_mapping(struct hid_device *hdev, struct hid_input *hi,
689 struct hid_field *field, struct hid_usage *usage,
690 unsigned long **bit, int *max)
691{
692 if ((usage->hid & HID_USAGE_PAGE) == HID_UP_MSVENDOR) {
693 unsigned int abs = usage->hid & HID_USAGE;
694
32e411d0 695 if (abs == GUITAR_TILT_USAGE) {
cc894ac5
PG		 696 hid_map_usage_clear(hi, usage, bit, max, EV_ABS, ABS_RY);
697 return 1;
698 }
699 }
700 return 0;
701}
702
77b499e7
RC		 703static ssize_t ds4_show_poll_interval(struct device *dev,
704 struct device_attribute
705 *attr, char *buf)
c607fb8d 706{
77b499e7
RC		 707 struct hid_device *hdev = to_hid_device(dev);
708 struct sony_sc *sc = hid_get_drvdata(hdev);
709
710 return snprintf(buf, PAGE_SIZE, "%i\n", sc->ds4_bt_poll_interval);
c607fb8d
AO		 711}
712
77b499e7
RC		 713static ssize_t ds4_store_poll_interval(struct device *dev,
714 struct device_attribute *attr,
715 const char *buf, size_t count)
c5e0c1c4 716{
77b499e7
RC		 717 struct hid_device *hdev = to_hid_device(dev);
718 struct sony_sc *sc = hid_get_drvdata(hdev);
719 unsigned long flags;
720 u8 interval;
721
722 if (kstrtou8(buf, 0, &interval))
723 return -EINVAL;
724
725 if (interval > DS4_BT_MAX_POLL_INTERVAL_MS)
726 return -EINVAL;
727
728 spin_lock_irqsave(&sc->lock, flags);
729 sc->ds4_bt_poll_interval = interval;
730 spin_unlock_irqrestore(&sc->lock, flags);
731
732 sony_schedule_work(sc, SONY_WORKER_STATE);
733
734 return count;
c5e0c1c4
FP		 735}
736
77b499e7
RC		 737static DEVICE_ATTR(bt_poll_interval, 0644, ds4_show_poll_interval,
738 ds4_store_poll_interval);
739
169f15ab
RC		 740static ssize_t sony_show_firmware_version(struct device *dev,
741 struct device_attribute
742 *attr, char *buf)
743{
744 struct hid_device *hdev = to_hid_device(dev);
745 struct sony_sc *sc = hid_get_drvdata(hdev);
746
747 return snprintf(buf, PAGE_SIZE, "0x%04x\n", sc->fw_version);
748}
749
750static DEVICE_ATTR(firmware_version, 0444, sony_show_firmware_version, NULL);
751
752static ssize_t sony_show_hardware_version(struct device *dev,
753 struct device_attribute
754 *attr, char *buf)
755{
756 struct hid_device *hdev = to_hid_device(dev);
757 struct sony_sc *sc = hid_get_drvdata(hdev);
758
759 return snprintf(buf, PAGE_SIZE, "0x%04x\n", sc->hw_version);
760}
761
762static DEVICE_ATTR(hardware_version, 0444, sony_show_hardware_version, NULL);
77b499e7 763
c5e0c1c4 764static u8 *motion_fixup(struct hid_device *hdev, u8 *rdesc,
b2723eb7
SW		 765 unsigned int *rsize)
766{
c5e0c1c4
FP		 767 *rsize = sizeof(motion_rdesc);
768 return motion_rdesc;
b2723eb7
SW		 769}
770
1adf904e 771static u8 *ps3remote_fixup(struct hid_device *hdev, u8 *rdesc,
078328da
JK		 772 unsigned int *rsize)
773{
774 *rsize = sizeof(ps3remote_rdesc);
775 return ps3remote_rdesc;
776}
777
778static int ps3remote_mapping(struct hid_device *hdev, struct hid_input *hi,
779 struct hid_field *field, struct hid_usage *usage,
780 unsigned long **bit, int *max)
781{
782 unsigned int key = usage->hid & HID_USAGE;
783
784 if ((usage->hid & HID_USAGE_PAGE) != HID_UP_BUTTON)
785 return -1;
786
787 switch (usage->collection_index) {
788 case 1:
789 if (key >= ARRAY_SIZE(ps3remote_keymap_joypad_buttons))
790 return -1;
791
792 key = ps3remote_keymap_joypad_buttons[key];
793 if (!key)
794 return -1;
795 break;
796 case 2:
797 if (key >= ARRAY_SIZE(ps3remote_keymap_remote_buttons))
798 return -1;
799
800 key = ps3remote_keymap_remote_buttons[key];
801 if (!key)
802 return -1;
803 break;
804 default:
805 return -1;
806 }
807
808 hid_map_usage_clear(hi, usage, bit, max, EV_KEY, key);
809 return 1;
810}
811
b8f0970d
RC		 812static int navigation_mapping(struct hid_device *hdev, struct hid_input *hi,
813 struct hid_field *field, struct hid_usage *usage,
814 unsigned long **bit, int *max)
815{
816 if ((usage->hid & HID_USAGE_PAGE) == HID_UP_BUTTON) {
817 unsigned int key = usage->hid & HID_USAGE;
818
819 if (key >= ARRAY_SIZE(sixaxis_keymap))
820 return -1;
821
822 key = navigation_keymap[key];
823 if (!key)
824 return -1;
825
826 hid_map_usage_clear(hi, usage, bit, max, EV_KEY, key);
827 return 1;
828 } else if (usage->hid == HID_GD_POINTER) {
829 /* See comment in sixaxis_mapping, basically the L2 (and R2)
830 * triggers are reported through GD Pointer.
831 * In addition we ignore any analog button 'axes' and only
832 * support digital buttons.
833 */
834 switch (usage->usage_index) {
835 case 8: /* L2 */
836 usage->hid = HID_GD_Z;
837 break;
838 default:
839 return -1;
840 }
841
842 hid_map_usage_clear(hi, usage, bit, max, EV_ABS, usage->hid & 0xf);
843 return 1;
844 } else if ((usage->hid & HID_USAGE_PAGE) == HID_UP_GENDESK) {
845 unsigned int abs = usage->hid & HID_USAGE;
846
847 if (abs >= ARRAY_SIZE(navigation_absmap))
848 return -1;
849
850 abs = navigation_absmap[abs];
851
852 hid_map_usage_clear(hi, usage, bit, max, EV_ABS, abs);
853 return 1;
854 }
855
856 return -1;
857}
858
859
e19a267b
RC		 860static int sixaxis_mapping(struct hid_device *hdev, struct hid_input *hi,
861 struct hid_field *field, struct hid_usage *usage,
862 unsigned long **bit, int *max)
863{
864 if ((usage->hid & HID_USAGE_PAGE) == HID_UP_BUTTON) {
865 unsigned int key = usage->hid & HID_USAGE;
866
867 if (key >= ARRAY_SIZE(sixaxis_keymap))
868 return -1;
869
870 key = sixaxis_keymap[key];
871 hid_map_usage_clear(hi, usage, bit, max, EV_KEY, key);
872 return 1;
873 } else if (usage->hid == HID_GD_POINTER) {
874 /* The DS3 provides analog values for most buttons and even
875 * for HAT axes through GD Pointer. L2 and R2 are reported
876 * among these as well instead of as GD Z / RZ. Remap L2
877 * and R2 and ignore other analog 'button axes' as there is
878 * no good way for reporting them.
879 */
880 switch (usage->usage_index) {
881 case 8: /* L2 */
882 usage->hid = HID_GD_Z;
883 break;
884 case 9: /* R2 */
885 usage->hid = HID_GD_RZ;
886 break;
887 default:
888 return -1;
889 }
890
891 hid_map_usage_clear(hi, usage, bit, max, EV_ABS, usage->hid & 0xf);
892 return 1;
893 } else if ((usage->hid & HID_USAGE_PAGE) == HID_UP_GENDESK) {
894 unsigned int abs = usage->hid & HID_USAGE;
895
896 if (abs >= ARRAY_SIZE(sixaxis_absmap))
897 return -1;
898
899 abs = sixaxis_absmap[abs];
900
901 hid_map_usage_clear(hi, usage, bit, max, EV_ABS, abs);
902 return 1;
903 }
904
905 return -1;
906}
907
9131f8cc
RC		 908static int ds4_mapping(struct hid_device *hdev, struct hid_input *hi,
909 struct hid_field *field, struct hid_usage *usage,
910 unsigned long **bit, int *max)
911{
912 if ((usage->hid & HID_USAGE_PAGE) == HID_UP_BUTTON) {
913 unsigned int key = usage->hid & HID_USAGE;
914
915 if (key >= ARRAY_SIZE(ds4_keymap))
916 return -1;
917
918 key = ds4_keymap[key];
919 hid_map_usage_clear(hi, usage, bit, max, EV_KEY, key);
920 return 1;
921 } else if ((usage->hid & HID_USAGE_PAGE) == HID_UP_GENDESK) {
922 unsigned int abs = usage->hid & HID_USAGE;
923
924 /* Let the HID parser deal with the HAT. */
925 if (usage->hid == HID_GD_HATSWITCH)
926 return 0;
927
928 if (abs >= ARRAY_SIZE(ds4_absmap))
929 return -1;
930
931 abs = ds4_absmap[abs];
932 hid_map_usage_clear(hi, usage, bit, max, EV_ABS, abs);
933 return 1;
934 }
935
936 return 0;
937}
938
1adf904e 939static u8 *sony_report_fixup(struct hid_device *hdev, u8 *rdesc,
73e4008d 940 unsigned int *rsize)
cc6e0bbb
JK		 941{
942 struct sony_sc *sc = hid_get_drvdata(hdev);
943
4ba1eeeb 944 if (sc->quirks & (SINO_LITE_CONTROLLER | FUTUREMAX_DANCE_MAT))
74500cc8
SM		 945 return rdesc;
946
99d24902
FLVC		 947 /*
948 * Some Sony RF receivers wrongly declare the mouse pointer as a
949 * a constant non-data variable.
950 */
951 if ((sc->quirks & VAIO_RDESC_CONSTANT) && *rsize >= 56 &&
952 /* usage page: generic desktop controls */
953 /* rdesc[0] == 0x05 && rdesc[1] == 0x01 && */
954 /* usage: mouse */
955 rdesc[2] == 0x09 && rdesc[3] == 0x02 &&
956 /* input (usage page for x,y axes): constant, variable, relative */
957 rdesc[54] == 0x81 && rdesc[55] == 0x07) {
a4649184 958 hid_info(hdev, "Fixing up Sony RF Receiver report descriptor\n");
99d24902 959 /* input: data, variable, relative */
cc6e0bbb
JK		 960 rdesc[55] = 0x06;
961 }
61ab44be 962
c5e0c1c4
FP		 963 if (sc->quirks & MOTION_CONTROLLER)
964 return motion_fixup(hdev, rdesc, rsize);
965
078328da
JK		 966 if (sc->quirks & PS3REMOTE)
967 return ps3remote_fixup(hdev, rdesc, rsize);
968
e72455b8
SS		 969 /*
970 * Some knock-off USB dongles incorrectly report their button count
971 * as 13 instead of 16 causing three non-functional buttons.
972 */
973 if ((sc->quirks & SIXAXIS_CONTROLLER_USB) && *rsize >= 45 &&
974 /* Report Count (13) */
975 rdesc[23] == 0x95 && rdesc[24] == 0x0D &&
976 /* Usage Maximum (13) */
977 rdesc[37] == 0x29 && rdesc[38] == 0x0D &&
978 /* Report Count (3) */
979 rdesc[43] == 0x95 && rdesc[44] == 0x03) {
980 hid_info(hdev, "Fixing up USB dongle report descriptor\n");
981 rdesc[24] = 0x10;
982 rdesc[38] = 0x10;
983 rdesc[44] = 0x00;
984 }
985
73e4008d 986 return rdesc;
cc6e0bbb
JK		 987}
988
1adf904e 989static void sixaxis_parse_report(struct sony_sc *sc, u8 *rd, int size)
d902f472 990{
1adf904e 991 static const u8 sixaxis_battery_capacity[] = { 0, 1, 25, 50, 75, 100 };
d902f472 992 unsigned long flags;
12e9a6d7 993 int offset;
a76a6c18
RC		 994 u8 battery_capacity;
995 int battery_status;
d902f472 996
ad142b9e
FP		 997 /*
998 * The sixaxis is charging if the battery value is 0xee
d902f472
FP		 999 * and it is fully charged if the value is 0xef.
1000 * It does not report the actual level while charging so it
1001 * is set to 100% while charging is in progress.
1002 */
12e9a6d7
SW		 1003 offset = (sc->quirks & MOTION_CONTROLLER) ? 12 : 30;
1004
1005 if (rd[offset] >= 0xee) {
d902f472 1006 battery_capacity = 100;
a76a6c18 1007 battery_status = (rd[offset] & 0x01) ? POWER_SUPPLY_STATUS_FULL : POWER_SUPPLY_STATUS_CHARGING;
d902f472 1008 } else {
1adf904e 1009 u8 index = rd[offset] <= 5 ? rd[offset] : 5;
ac3c9a94 1010 battery_capacity = sixaxis_battery_capacity[index];
a76a6c18 1011 battery_status = POWER_SUPPLY_STATUS_DISCHARGING;
d902f472 1012 }
d902f472
FP		 1013
1014 spin_lock_irqsave(&sc->lock, flags);
d902f472 1015 sc->battery_capacity = battery_capacity;
a76a6c18 1016 sc->battery_status = battery_status;
d902f472 1017 spin_unlock_irqrestore(&sc->lock, flags);
510c8b7c
RC		 1018
1019 if (sc->quirks & SIXAXIS_CONTROLLER) {
1020 int val;
1021
1022 offset = SIXAXIS_INPUT_REPORT_ACC_X_OFFSET;
1023 val = ((rd[offset+1] << 8) | rd[offset]) - 511;
1024 input_report_abs(sc->sensor_dev, ABS_X, val);
1025
1026 /* Y and Z are swapped and inversed */
1027 val = 511 - ((rd[offset+5] << 8) | rd[offset+4]);
1028 input_report_abs(sc->sensor_dev, ABS_Y, val);
1029
1030 val = 511 - ((rd[offset+3] << 8) | rd[offset+2]);
1031 input_report_abs(sc->sensor_dev, ABS_Z, val);
1032
1033 input_sync(sc->sensor_dev);
1034 }
d902f472
FP		 1035}
1036
1adf904e 1037static void dualshock4_parse_report(struct sony_sc *sc, u8 *rd, int size)
d902f472 1038{
d03ae2e1
RC		 1039 struct hid_input *hidinput = list_entry(sc->hdev->inputs.next,
1040 struct hid_input, list);
1041 struct input_dev *input_dev = hidinput->input;
d902f472 1042 unsigned long flags;
cdc1c021 1043 int n, m, offset, num_touch_data, max_touch_data;
a76a6c18
RC		 1044 u8 cable_state, battery_capacity;
1045 int battery_status;
80786eb9 1046 u16 timestamp;
d902f472 1047
cdc1c021 1048 /* When using Bluetooth the header is 2 bytes longer, so skip these. */
35f436c3 1049 int data_offset = (sc->quirks & DUALSHOCK4_CONTROLLER_BT) ? 2 : 0;
6c5f860d 1050
ac797b95
RC		 1051 /* Second bit of third button byte is for the touchpad button. */
1052 offset = data_offset + DS4_INPUT_REPORT_BUTTON_OFFSET;
1053 input_report_key(sc->touchpad, BTN_LEFT, rd[offset+2] & 0x2);
1054
d03ae2e1
RC		 1055 /*
1056 * The default behavior of the Dualshock 4 is to send reports using
1057 * report type 1 when running over Bluetooth. However, when feature
1058 * report 2 is requested during the controller initialization it starts
1059 * sending input reports in report 17. Since report 17 is undefined
1060 * in the default HID descriptor, the HID layer won't generate events.
1061 * While it is possible (and this was done before) to fixup the HID
1062 * descriptor to add this mapping, it was better to do this manually.
1063 * The reason is there were various pieces software both open and closed
1064 * source, relying on the descriptors to be the same across various
1065 * operating systems. If the descriptors wouldn't match some
1066 * applications e.g. games on Wine would not be able to function due
1067 * to different descriptors, which such applications are not parsing.
1068 */
1069 if (rd[0] == 17) {
1070 int value;
1071
1072 offset = data_offset + DS4_INPUT_REPORT_AXIS_OFFSET;
1073 input_report_abs(input_dev, ABS_X, rd[offset]);
1074 input_report_abs(input_dev, ABS_Y, rd[offset+1]);
1075 input_report_abs(input_dev, ABS_RX, rd[offset+2]);
1076 input_report_abs(input_dev, ABS_RY, rd[offset+3]);
1077
1078 value = rd[offset+4] & 0xf;
1079 if (value > 7)
1080 value = 8; /* Center 0, 0 */
1081 input_report_abs(input_dev, ABS_HAT0X, ds4_hat_mapping[value].x);
1082 input_report_abs(input_dev, ABS_HAT0Y, ds4_hat_mapping[value].y);
1083
1084 input_report_key(input_dev, BTN_WEST, rd[offset+4] & 0x10);
1085 input_report_key(input_dev, BTN_SOUTH, rd[offset+4] & 0x20);
1086 input_report_key(input_dev, BTN_EAST, rd[offset+4] & 0x40);
1087 input_report_key(input_dev, BTN_NORTH, rd[offset+4] & 0x80);
1088
1089 input_report_key(input_dev, BTN_TL, rd[offset+5] & 0x1);
1090 input_report_key(input_dev, BTN_TR, rd[offset+5] & 0x2);
1091 input_report_key(input_dev, BTN_TL2, rd[offset+5] & 0x4);
1092 input_report_key(input_dev, BTN_TR2, rd[offset+5] & 0x8);
1093 input_report_key(input_dev, BTN_SELECT, rd[offset+5] & 0x10);
1094 input_report_key(input_dev, BTN_START, rd[offset+5] & 0x20);
1095 input_report_key(input_dev, BTN_THUMBL, rd[offset+5] & 0x40);
1096 input_report_key(input_dev, BTN_THUMBR, rd[offset+5] & 0x80);
1097
1098 input_report_key(input_dev, BTN_MODE, rd[offset+6] & 0x1);
1099
1100 input_report_abs(input_dev, ABS_Z, rd[offset+7]);
1101 input_report_abs(input_dev, ABS_RZ, rd[offset+8]);
1102
1103 input_sync(input_dev);
1104 }
1105
80786eb9
RC		 1106 /* Convert timestamp (in 5.33us unit) to timestamp_us */
1107 offset = data_offset + DS4_INPUT_REPORT_TIMESTAMP_OFFSET;
1108 timestamp = get_unaligned_le16(&rd[offset]);
1109 if (!sc->timestamp_initialized) {
1110 sc->timestamp_us = ((unsigned int)timestamp * 16) / 3;
1111 sc->timestamp_initialized = true;
1112 } else {
1113 u16 delta;
1114
1115 if (sc->prev_timestamp > timestamp)
1116 delta = (U16_MAX - sc->prev_timestamp + timestamp + 1);
1117 else
1118 delta = timestamp - sc->prev_timestamp;
1119 sc->timestamp_us += (delta * 16) / 3;
1120 }
1121 sc->prev_timestamp = timestamp;
1122 input_event(sc->sensor_dev, EV_MSC, MSC_TIMESTAMP, sc->timestamp_us);
1123
227c011b 1124 offset = data_offset + DS4_INPUT_REPORT_GYRO_X_OFFSET;
55a07d62
RC		 1125 for (n = 0; n < 6; n++) {
1126 /* Store data in int for more precision during mult_frac. */
1127 int raw_data = (short)((rd[offset+1] << 8) | rd[offset]);
1128 struct ds4_calibration_data *calib = &sc->ds4_calib_data[n];
1129
1130 /* High precision is needed during calibration, but the
1131 * calibrated values are within 32-bit.
1132 * Note: we swap numerator 'x' and 'numer' in mult_frac for
1133 * precision reasons so we don't need 64-bit.
1134 */
1135 int calib_data = mult_frac(calib->sens_numer,
1136 raw_data - calib->bias,
1137 calib->sens_denom);
227c011b 1138
55a07d62
RC		 1139 input_report_abs(sc->sensor_dev, calib->abs_code, calib_data);
1140 offset += 2;
227c011b
RC		 1141 }
1142 input_sync(sc->sensor_dev);
1143
ad142b9e 1144 /*
cdc1c021 1145 * The lower 4 bits of byte 30 (or 32 for BT) contain the battery level
d902f472
FP		 1146 * and the 5th bit contains the USB cable state.
1147 */
cdc1c021 1148 offset = data_offset + DS4_INPUT_REPORT_BATTERY_OFFSET;
6c5f860d 1149 cable_state = (rd[offset] >> 4) & 0x01;
d902f472 1150
ad142b9e 1151 /*
a76a6c18
RC		 1152 * Interpretation of the battery_capacity data depends on the cable state.
1153 * When no cable is connected (bit4 is 0):
1154 * - 0:10: percentage in units of 10%.
1155 * When a cable is plugged in:
1156 * - 0-10: percentage in units of 10%.
1157 * - 11: battery is full
1158 * - 14: not charging due to Voltage or temperature error
1159 * - 15: charge error
d902f472 1160 */
a76a6c18
RC		 1161 if (cable_state) {
1162 u8 battery_data = rd[offset] & 0xf;
1163
1164 if (battery_data < 10) {
1165 /* Take the mid-point for each battery capacity value,
1166 * because on the hardware side 0 = 0-9%, 1=10-19%, etc.
1167 * This matches official platform behavior, which does
1168 * the same.
1169 */
1170 battery_capacity = battery_data * 10 + 5;
1171 battery_status = POWER_SUPPLY_STATUS_CHARGING;
1172 } else if (battery_data == 10) {
1173 battery_capacity = 100;
1174 battery_status = POWER_SUPPLY_STATUS_CHARGING;
1175 } else if (battery_data == 11) {
1176 battery_capacity = 100;
1177 battery_status = POWER_SUPPLY_STATUS_FULL;
1178 } else { /* 14, 15 and undefined values */
1179 battery_capacity = 0;
1180 battery_status = POWER_SUPPLY_STATUS_UNKNOWN;
1181 }
1182 } else {
1183 u8 battery_data = rd[offset] & 0xf;
d902f472 1184
a76a6c18
RC		 1185 if (battery_data < 10)
1186 battery_capacity = battery_data * 10 + 5;
1187 else /* 10 */
1188 battery_capacity = 100;
6c5f860d 1189
a76a6c18
RC		 1190 battery_status = POWER_SUPPLY_STATUS_DISCHARGING;
1191 }
d902f472
FP		 1192
1193 spin_lock_irqsave(&sc->lock, flags);
d902f472 1194 sc->battery_capacity = battery_capacity;
a76a6c18 1195 sc->battery_status = battery_status;
d902f472 1196 spin_unlock_irqrestore(&sc->lock, flags);
e5606230 1197
ad142b9e 1198 /*
cdc1c021
RC		 1199 * The Dualshock 4 multi-touch trackpad data starts at offset 33 on USB
1200 * and 35 on Bluetooth.
1201 * The first byte indicates the number of touch data in the report.
1202 * Trackpad data starts 2 bytes later (e.g. 35 for USB).
e5606230 1203 */
cdc1c021 1204 offset = data_offset + DS4_INPUT_REPORT_TOUCHPAD_OFFSET;
35f436c3 1205 max_touch_data = (sc->quirks & DUALSHOCK4_CONTROLLER_BT) ? 4 : 3;
cdc1c021
RC		 1206 if (rd[offset] > 0 && rd[offset] <= max_touch_data)
1207 num_touch_data = rd[offset];
1208 else
1209 num_touch_data = 1;
1210 offset += 1;
e5606230 1211
cdc1c021
RC		 1212 for (m = 0; m < num_touch_data; m++) {
1213 /* Skip past timestamp */
1214 offset += 1;
e5606230 1215
cdc1c021
RC		 1216 /*
1217 * The first 7 bits of the first byte is a counter and bit 8 is
1218 * a touch indicator that is 0 when pressed and 1 when not
1219 * pressed.
1220 * The next 3 bytes are two 12 bit touch coordinates, X and Y.
1221 * The data for the second touch is in the same format and
1222 * immediately follows the data for the first.
1223 */
1224 for (n = 0; n < 2; n++) {
1225 u16 x, y;
1226 bool active;
1227
1228 x = rd[offset+1] | ((rd[offset+2] & 0xF) << 8);
1229 y = ((rd[offset+2] & 0xF0) >> 4) | (rd[offset+3] << 4);
1230
1231 active = !(rd[offset] >> 7);
ac797b95
RC		 1232 input_mt_slot(sc->touchpad, n);
1233 input_mt_report_slot_state(sc->touchpad, MT_TOOL_FINGER, active);
cdc1c021
RC		 1234
1235 if (active) {
ac797b95
RC		 1236 input_report_abs(sc->touchpad, ABS_MT_POSITION_X, x);
1237 input_report_abs(sc->touchpad, ABS_MT_POSITION_Y, y);
cdc1c021
RC		 1238 }
1239
1240 offset += 4;
1241 }
ac797b95
RC		 1242 input_mt_sync_frame(sc->touchpad);
1243 input_sync(sc->touchpad);
e5606230 1244 }
d902f472
FP		 1245}
1246
b7289cb1
TK		 1247static void nsg_mrxu_parse_report(struct sony_sc *sc, u8 *rd, int size)
1248{
1249 int n, offset, relx, rely;
1250 u8 active;
1251
1252 /*
1253 * The NSG-MRxU multi-touch trackpad data starts at offset 1 and
1254 * the touch-related data starts at offset 2.
1255 * For the first byte, bit 0 is set when touchpad button is pressed.
1256 * Bit 2 is set when a touch is active and the drag (Fn) key is pressed.
1257 * This drag key is mapped to BTN_LEFT. It is operational only when a
1258 * touch point is active.
1259 * Bit 4 is set when only the first touch point is active.
1260 * Bit 6 is set when only the second touch point is active.
1261 * Bits 5 and 7 are set when both touch points are active.
1262 * The next 3 bytes are two 12 bit X/Y coordinates for the first touch.
1263 * The following byte, offset 5, has the touch width and length.
1264 * Bits 0-4=X (width), bits 5-7=Y (length).
1265 * A signed relative X coordinate is at offset 6.
1266 * The bytes at offset 7-9 are the second touch X/Y coordinates.
1267 * Offset 10 has the second touch width and length.
1268 * Offset 11 has the relative Y coordinate.
1269 */
1270 offset = 1;
1271
1272 input_report_key(sc->touchpad, BTN_LEFT, rd[offset] & 0x0F);
1273 active = (rd[offset] >> 4);
1274 relx = (s8) rd[offset+5];
1275 rely = ((s8) rd[offset+10]) * -1;
1276
1277 offset++;
1278
1279 for (n = 0; n < 2; n++) {
1280 u16 x, y;
1281 u8 contactx, contacty;
1282
1283 x = rd[offset] | ((rd[offset+1] & 0x0F) << 8);
1284 y = ((rd[offset+1] & 0xF0) >> 4) | (rd[offset+2] << 4);
1285
1286 input_mt_slot(sc->touchpad, n);
1287 input_mt_report_slot_state(sc->touchpad, MT_TOOL_FINGER, active & 0x03);
1288
1289 if (active & 0x03) {
1290 contactx = rd[offset+3] & 0x0F;
1291 contacty = rd[offset+3] >> 4;
1292 input_report_abs(sc->touchpad, ABS_MT_TOUCH_MAJOR,
1293 max(contactx, contacty));
1294 input_report_abs(sc->touchpad, ABS_MT_TOUCH_MINOR,
1295 min(contactx, contacty));
1296 input_report_abs(sc->touchpad, ABS_MT_ORIENTATION,
1297 (bool) (contactx > contacty));
1298 input_report_abs(sc->touchpad, ABS_MT_POSITION_X, x);
1299 input_report_abs(sc->touchpad, ABS_MT_POSITION_Y,
1300 NSG_MRXU_MAX_Y - y);
1301 /*
1302 * The relative coordinates belong to the first touch
1303 * point, when present, or to the second touch point
1304 * when the first is not active.
1305 */
1306 if ((n == 0) || ((n == 1) && (active & 0x01))) {
1307 input_report_rel(sc->touchpad, REL_X, relx);
1308 input_report_rel(sc->touchpad, REL_Y, rely);
1309 }
1310 }
1311
1312 offset += 5;
1313 active >>= 2;
1314 }
1315
1316 input_mt_sync_frame(sc->touchpad);
1317
1318 input_sync(sc->touchpad);
1319}
1320
c9e4d877 1321static int sony_raw_event(struct hid_device *hdev, struct hid_report *report,
1adf904e 1322 u8 *rd, int size)
c9e4d877
SW		 1323{
1324 struct sony_sc *sc = hid_get_drvdata(hdev);
1325
ad142b9e
FP		 1326 /*
1327 * Sixaxis HID report has acclerometers/gyro with MSByte first, this
c9e4d877
SW		 1328 * has to be BYTE_SWAPPED before passing up to joystick interface
1329 */
fee4e2d5 1330 if ((sc->quirks & SIXAXIS_CONTROLLER) && rd[0] == 0x01 && size == 49) {
8f5f0bc2
FP		 1331 /*
1332 * When connected via Bluetooth the Sixaxis occasionally sends
1333 * a report with the second byte 0xff and the rest zeroed.
1334 *
1335 * This report does not reflect the actual state of the
1336 * controller must be ignored to avoid generating false input
1337 * events.
1338 */
1339 if (rd[1] == 0xff)
1340 return -EINVAL;
1341
c9e4d877
SW		 1342 swap(rd[41], rd[42]);
1343 swap(rd[43], rd[44]);
1344 swap(rd[45], rd[46]);
1345 swap(rd[47], rd[48]);
d902f472 1346
12e9a6d7
SW		 1347 sixaxis_parse_report(sc, rd, size);
1348 } else if ((sc->quirks & MOTION_CONTROLLER_BT) && rd[0] == 0x01 && size == 49) {
d902f472 1349 sixaxis_parse_report(sc, rd, size);
4545ee0a
SW		 1350 } else if ((sc->quirks & NAVIGATION_CONTROLLER) && rd[0] == 0x01 &&
1351 size == 49) {
1352 sixaxis_parse_report(sc, rd, size);
35f436c3
RC		 1353 } else if ((sc->quirks & DUALSHOCK4_CONTROLLER_USB) && rd[0] == 0x01 &&
1354 size == 64) {
1355 dualshock4_parse_report(sc, rd, size);
1356 } else if (((sc->quirks & DUALSHOCK4_CONTROLLER_BT) && rd[0] == 0x11 &&
1357 size == 78)) {
1358 /* CRC check */
1359 u8 bthdr = 0xA1;
1360 u32 crc;
1361 u32 report_crc;
49b9ca6c 1362
35f436c3
RC		 1363 crc = crc32_le(0xFFFFFFFF, &bthdr, 1);
1364 crc = ~crc32_le(crc, rd, DS4_INPUT_REPORT_0x11_SIZE-4);
1365 report_crc = get_unaligned_le32(&rd[DS4_INPUT_REPORT_0x11_SIZE-4]);
1366 if (crc != report_crc) {
1367 hid_dbg(sc->hdev, "DualShock 4 input report's CRC check failed, received crc 0x%0x != 0x%0x\n",
1368 report_crc, crc);
1369 return -EILSEQ;
49b9ca6c 1370 }
405182c2 1371
35f436c3
RC		 1372 dualshock4_parse_report(sc, rd, size);
1373 } else if ((sc->quirks & DUALSHOCK4_DONGLE) && rd[0] == 0x01 &&
1374 size == 64) {
f2f47c38
RC		 1375 unsigned long flags;
1376 enum ds4_dongle_state dongle_state;
1377
405182c2
RC		 1378 /*
1379 * In the case of a DS4 USB dongle, bit[2] of byte 31 indicates
1380 * if a DS4 is actually connected (indicated by '0').
1381 * For non-dongle, this bit is always 0 (connected).
1382 */
35f436c3
RC		 1383 bool connected = (rd[31] & 0x04) ? false : true;
1384
f2f47c38
RC		 1385 spin_lock_irqsave(&sc->lock, flags);
1386 dongle_state = sc->ds4_dongle_state;
1387 spin_unlock_irqrestore(&sc->lock, flags);
1388
1389 /*
1390 * The dongle always sends input reports even when no
1391 * DS4 is attached. When a DS4 is connected, we need to
1392 * obtain calibration data before we can use it.
1393 * The code below tracks dongle state and kicks of
1394 * calibration when needed and only allows us to process
1395 * input if a DS4 is actually connected.
1396 */
1397 if (dongle_state == DONGLE_DISCONNECTED && connected) {
35f436c3
RC		 1398 hid_info(sc->hdev, "DualShock 4 USB dongle: controller connected\n");
1399 sony_set_leds(sc);
f2f47c38
RC		 1400
1401 spin_lock_irqsave(&sc->lock, flags);
1402 sc->ds4_dongle_state = DONGLE_CALIBRATING;
1403 spin_unlock_irqrestore(&sc->lock, flags);
1404
1405 sony_schedule_work(sc, SONY_WORKER_HOTPLUG);
1406
1407 /* Don't process the report since we don't have
1408 * calibration data, but let hidraw have it anyway.
1409 */
1410 return 0;
1411 } else if ((dongle_state == DONGLE_CONNECTED ||
1412 dongle_state == DONGLE_DISABLED) && !connected) {
35f436c3 1413 hid_info(sc->hdev, "DualShock 4 USB dongle: controller disconnected\n");
f2f47c38
RC		 1414
1415 spin_lock_irqsave(&sc->lock, flags);
1416 sc->ds4_dongle_state = DONGLE_DISCONNECTED;
1417 spin_unlock_irqrestore(&sc->lock, flags);
1418
35f436c3
RC		 1419 /* Return 0, so hidraw can get the report. */
1420 return 0;
f2f47c38
RC		 1421 } else if (dongle_state == DONGLE_CALIBRATING ||
1422 dongle_state == DONGLE_DISABLED ||
1423 dongle_state == DONGLE_DISCONNECTED) {
35f436c3
RC		 1424 /* Return 0, so hidraw can get the report. */
1425 return 0;
405182c2
RC		 1426 }
1427
d902f472 1428 dualshock4_parse_report(sc, rd, size);
b7289cb1
TK		 1429
1430 } else if ((sc->quirks & NSG_MRXU_REMOTE) && rd[0] == 0x02) {
1431 nsg_mrxu_parse_report(sc, rd, size);
1432 return 1;
c9e4d877
SW		 1433 }
1434
2a242932
FP		 1435 if (sc->defer_initialization) {
1436 sc->defer_initialization = 0;
b5322736 1437 sony_schedule_work(sc, SONY_WORKER_STATE);
2a242932
FP		 1438 }
1439
c9e4d877
SW		 1440 return 0;
1441}
1442
f04d5140
CL		 1443static int sony_mapping(struct hid_device *hdev, struct hid_input *hi,
1444 struct hid_field *field, struct hid_usage *usage,
1445 unsigned long **bit, int *max)
1446{
1447 struct sony_sc *sc = hid_get_drvdata(hdev);
1448
1449 if (sc->quirks & BUZZ_CONTROLLER) {
1450 unsigned int key = usage->hid & HID_USAGE;
1451
1452 if ((usage->hid & HID_USAGE_PAGE) != HID_UP_BUTTON)
1453 return -1;
1454
1455 switch (usage->collection_index) {
1456 case 1:
1457 if (key >= ARRAY_SIZE(buzz_keymap))
1458 return -1;
1459
1460 key = buzz_keymap[key];
1461 if (!key)
1462 return -1;
1463 break;
1464 default:
1465 return -1;
1466 }
1467
1468 hid_map_usage_clear(hi, usage, bit, max, EV_KEY, key);
1469 return 1;
1470 }
1471
078328da
JK		 1472 if (sc->quirks & PS3REMOTE)
1473 return ps3remote_mapping(hdev, hi, field, usage, bit, max);
1474
b8f0970d
RC		 1475 if (sc->quirks & NAVIGATION_CONTROLLER)
1476 return navigation_mapping(hdev, hi, field, usage, bit, max);
1477
e19a267b
RC		 1478 if (sc->quirks & SIXAXIS_CONTROLLER)
1479 return sixaxis_mapping(hdev, hi, field, usage, bit, max);
9131f8cc
RC		 1480
1481 if (sc->quirks & DUALSHOCK4_CONTROLLER)
1482 return ds4_mapping(hdev, hi, field, usage, bit, max);
1483
32e411d0 1484 if (sc->quirks & GH_GUITAR_CONTROLLER)
cc894ac5 1485 return guitar_mapping(hdev, hi, field, usage, bit, max);
e19a267b 1486
6f498018
BT		 1487 /* Let hid-core decide for the others */
1488 return 0;
f04d5140
CL		 1489}
1490
ac797b95 1491static int sony_register_touchpad(struct sony_sc *sc, int touch_count,
b7289cb1 1492 int w, int h, int touch_major, int touch_minor, int orientation)
ce8efc3b 1493{
ac797b95
RC		 1494 size_t name_sz;
1495 char *name;
ce8efc3b
FP		 1496 int ret;
1497
cc070a84 1498 sc->touchpad = devm_input_allocate_device(&sc->hdev->dev);
ac797b95
RC		 1499 if (!sc->touchpad)
1500 return -ENOMEM;
1501
1502 input_set_drvdata(sc->touchpad, sc);
1503 sc->touchpad->dev.parent = &sc->hdev->dev;
1504 sc->touchpad->phys = sc->hdev->phys;
1505 sc->touchpad->uniq = sc->hdev->uniq;
1506 sc->touchpad->id.bustype = sc->hdev->bus;
1507 sc->touchpad->id.vendor = sc->hdev->vendor;
1508 sc->touchpad->id.product = sc->hdev->product;
1509 sc->touchpad->id.version = sc->hdev->version;
1510
1511 /* Append a suffix to the controller name as there are various
1512 * DS4 compatible non-Sony devices with different names.
1513 */
1514 name_sz = strlen(sc->hdev->name) + sizeof(DS4_TOUCHPAD_SUFFIX);
cc070a84
HZ		 1515 name = devm_kzalloc(&sc->hdev->dev, name_sz, GFP_KERNEL);
1516 if (!name)
1517 return -ENOMEM;
ac797b95
RC		 1518 snprintf(name, name_sz, "%s" DS4_TOUCHPAD_SUFFIX, sc->hdev->name);
1519 sc->touchpad->name = name;
1520
ac797b95
RC		 1521 /* We map the button underneath the touchpad to BTN_LEFT. */
1522 __set_bit(EV_KEY, sc->touchpad->evbit);
1523 __set_bit(BTN_LEFT, sc->touchpad->keybit);
1524 __set_bit(INPUT_PROP_BUTTONPAD, sc->touchpad->propbit);
ce8efc3b 1525
ac797b95
RC		 1526 input_set_abs_params(sc->touchpad, ABS_MT_POSITION_X, 0, w, 0, 0);
1527 input_set_abs_params(sc->touchpad, ABS_MT_POSITION_Y, 0, h, 0, 0);
1528
b7289cb1
TK		 1529 if (touch_major > 0) {
1530 input_set_abs_params(sc->touchpad, ABS_MT_TOUCH_MAJOR,
1531 0, touch_major, 0, 0);
1532 if (touch_minor > 0)
1533 input_set_abs_params(sc->touchpad, ABS_MT_TOUCH_MINOR,
1534 0, touch_minor, 0, 0);
1535 if (orientation > 0)
1536 input_set_abs_params(sc->touchpad, ABS_MT_ORIENTATION,
1537 0, orientation, 0, 0);
1538 }
1539
1540 if (sc->quirks & NSG_MRXU_REMOTE) {
1541 __set_bit(EV_REL, sc->touchpad->evbit);
1542 }
1543
1544 ret = input_mt_init_slots(sc->touchpad, touch_count, INPUT_MT_POINTER);
1545 if (ret < 0)
cc070a84 1546 return ret;
b7289cb1 1547
ac797b95
RC		 1548 ret = input_register_device(sc->touchpad);
1549 if (ret < 0)
cc070a84 1550 return ret;
ce8efc3b
FP		 1551
1552 return 0;
ac797b95 1553}
ce8efc3b 1554
227c011b
RC		 1555static int sony_register_sensors(struct sony_sc *sc)
1556{
1557 size_t name_sz;
1558 char *name;
1559 int ret;
55a07d62 1560 int range;
227c011b 1561
ea4a5fdc 1562 sc->sensor_dev = devm_input_allocate_device(&sc->hdev->dev);
227c011b
RC		 1563 if (!sc->sensor_dev)
1564 return -ENOMEM;
1565
1566 input_set_drvdata(sc->sensor_dev, sc);
1567 sc->sensor_dev->dev.parent = &sc->hdev->dev;
1568 sc->sensor_dev->phys = sc->hdev->phys;
1569 sc->sensor_dev->uniq = sc->hdev->uniq;
1570 sc->sensor_dev->id.bustype = sc->hdev->bus;
1571 sc->sensor_dev->id.vendor = sc->hdev->vendor;
1572 sc->sensor_dev->id.product = sc->hdev->product;
1573 sc->sensor_dev->id.version = sc->hdev->version;
1574
1575 /* Append a suffix to the controller name as there are various
1576 * DS4 compatible non-Sony devices with different names.
1577 */
510c8b7c 1578 name_sz = strlen(sc->hdev->name) + sizeof(SENSOR_SUFFIX);
ea4a5fdc
HZ		 1579 name = devm_kzalloc(&sc->hdev->dev, name_sz, GFP_KERNEL);
1580 if (!name)
1581 return -ENOMEM;
510c8b7c 1582 snprintf(name, name_sz, "%s" SENSOR_SUFFIX, sc->hdev->name);
227c011b
RC		 1583 sc->sensor_dev->name = name;
1584
510c8b7c
RC		 1585 if (sc->quirks & SIXAXIS_CONTROLLER) {
1586 /* For the DS3 we only support the accelerometer, which works
1587 * quite well even without calibration. The device also has
1588 * a 1-axis gyro, but it is very difficult to manage from within
1589 * the driver even to get data, the sensor is inaccurate and
1590 * the behavior is very different between hardware revisions.
1591 */
1592 input_set_abs_params(sc->sensor_dev, ABS_X, -512, 511, 4, 0);
1593 input_set_abs_params(sc->sensor_dev, ABS_Y, -512, 511, 4, 0);
1594 input_set_abs_params(sc->sensor_dev, ABS_Z, -512, 511, 4, 0);
1595 input_abs_set_res(sc->sensor_dev, ABS_X, SIXAXIS_ACC_RES_PER_G);
1596 input_abs_set_res(sc->sensor_dev, ABS_Y, SIXAXIS_ACC_RES_PER_G);
1597 input_abs_set_res(sc->sensor_dev, ABS_Z, SIXAXIS_ACC_RES_PER_G);
1598 } else if (sc->quirks & DUALSHOCK4_CONTROLLER) {
1599 range = DS4_ACC_RES_PER_G*4;
1600 input_set_abs_params(sc->sensor_dev, ABS_X, -range, range, 16, 0);
1601 input_set_abs_params(sc->sensor_dev, ABS_Y, -range, range, 16, 0);
1602 input_set_abs_params(sc->sensor_dev, ABS_Z, -range, range, 16, 0);
1603 input_abs_set_res(sc->sensor_dev, ABS_X, DS4_ACC_RES_PER_G);
1604 input_abs_set_res(sc->sensor_dev, ABS_Y, DS4_ACC_RES_PER_G);
1605 input_abs_set_res(sc->sensor_dev, ABS_Z, DS4_ACC_RES_PER_G);
1606
1607 range = DS4_GYRO_RES_PER_DEG_S*2048;
1608 input_set_abs_params(sc->sensor_dev, ABS_RX, -range, range, 16, 0);
1609 input_set_abs_params(sc->sensor_dev, ABS_RY, -range, range, 16, 0);
1610 input_set_abs_params(sc->sensor_dev, ABS_RZ, -range, range, 16, 0);
1611 input_abs_set_res(sc->sensor_dev, ABS_RX, DS4_GYRO_RES_PER_DEG_S);
1612 input_abs_set_res(sc->sensor_dev, ABS_RY, DS4_GYRO_RES_PER_DEG_S);
1613 input_abs_set_res(sc->sensor_dev, ABS_RZ, DS4_GYRO_RES_PER_DEG_S);
1614
1615 __set_bit(EV_MSC, sc->sensor_dev->evbit);
1616 __set_bit(MSC_TIMESTAMP, sc->sensor_dev->mscbit);
1617 }
1618
227c011b
RC		 1619 __set_bit(INPUT_PROP_ACCELEROMETER, sc->sensor_dev->propbit);
1620
1621 ret = input_register_device(sc->sensor_dev);
1622 if (ret < 0)
ea4a5fdc 1623 return ret;
227c011b
RC		 1624
1625 return 0;
227c011b
RC		 1626}
1627
bd28ce00
JS		 1628/*
1629 * Sending HID_REQ_GET_REPORT changes the operation mode of the ps3 controller
1630 * to "operational". Without this, the ps3 controller will not report any
1631 * events.
1632 */
816651a7 1633static int sixaxis_set_operational_usb(struct hid_device *hdev)
bd28ce00 1634{
69481059 1635 struct sony_sc *sc = hid_get_drvdata(hdev);
a85d67b5
AO		 1636 const int buf_size =
1637 max(SIXAXIS_REPORT_0xF2_SIZE, SIXAXIS_REPORT_0xF5_SIZE);
1adf904e 1638 u8 *buf;
bd28ce00 1639 int ret;
bd28ce00 1640
2e701a35 1641 buf = kmalloc(buf_size, GFP_KERNEL);
bd28ce00
JS		 1642 if (!buf)
1643 return -ENOMEM;
1644
a85d67b5
AO		 1645 ret = hid_hw_raw_request(hdev, 0xf2, buf, SIXAXIS_REPORT_0xF2_SIZE,
1646 HID_FEATURE_REPORT, HID_REQ_GET_REPORT);
a7de9b86
LK		 1647 if (ret < 0) {
1648 hid_err(hdev, "can't set operational mode: step 1\n");
1649 goto out;
1650 }
f204828a 1651
a7de9b86
LK		 1652 /*
1653 * Some compatible controllers like the Speedlink Strike FX and
1654 * Gasia need another query plus an USB interrupt to get operational.
1655 */
a85d67b5
AO		 1656 ret = hid_hw_raw_request(hdev, 0xf5, buf, SIXAXIS_REPORT_0xF5_SIZE,
1657 HID_FEATURE_REPORT, HID_REQ_GET_REPORT);
a7de9b86
LK		 1658 if (ret < 0) {
1659 hid_err(hdev, "can't set operational mode: step 2\n");
1660 goto out;
1661 }
f204828a 1662
492ca83c
BN		 1663 /*
1664 * But the USB interrupt would cause SHANWAN controllers to
69481059 1665 * start rumbling non-stop, so skip step 3 for these controllers.
492ca83c 1666 */
69481059
HY		 1667 if (sc->quirks & SHANWAN_GAMEPAD)
1668 goto out;
1669
1670 ret = hid_hw_output_report(hdev, buf, 1);
1671 if (ret < 0) {
1672 hid_info(hdev, "can't set operational mode: step 3, ignoring\n");
1673 ret = 0;
19f4c2ba 1674 }
bd28ce00 1675
a7de9b86 1676out:
bd28ce00
JS		 1677 kfree(buf);
1678
1679 return ret;
1680}
1681
816651a7 1682static int sixaxis_set_operational_bt(struct hid_device *hdev)
f9ce7c28 1683{
1adf904e
PM		 1684 static const u8 report[] = { 0xf4, 0x42, 0x03, 0x00, 0x00 };
1685 u8 *buf;
9b2b5c9a
FP		 1686 int ret;
1687
1688 buf = kmemdup(report, sizeof(report), GFP_KERNEL);
1689 if (!buf)
1690 return -ENOMEM;
1691
1692 ret = hid_hw_raw_request(hdev, buf[0], buf, sizeof(report),
b0dd72aa 1693 HID_FEATURE_REPORT, HID_REQ_SET_REPORT);
9b2b5c9a
FP		 1694
1695 kfree(buf);
1696
1697 return ret;
f9ce7c28
BN		 1698}
1699
ad142b9e 1700/*
55a07d62
RC		 1701 * Request DS4 calibration data for the motion sensors.
1702 * For Bluetooth this also affects the operating mode (see below).
68330d83 1703 */
55a07d62 1704static int dualshock4_get_calibration_data(struct sony_sc *sc)
68330d83 1705{
1adf904e 1706 u8 *buf;
9b2b5c9a 1707 int ret;
55a07d62
RC		 1708 short gyro_pitch_bias, gyro_pitch_plus, gyro_pitch_minus;
1709 short gyro_yaw_bias, gyro_yaw_plus, gyro_yaw_minus;
1710 short gyro_roll_bias, gyro_roll_plus, gyro_roll_minus;
1711 short gyro_speed_plus, gyro_speed_minus;
1712 short acc_x_plus, acc_x_minus;
1713 short acc_y_plus, acc_y_minus;
1714 short acc_z_plus, acc_z_minus;
1715 int speed_2x;
1716 int range_2g;
1717
1718 /* For Bluetooth we use a different request, which supports CRC.
1719 * Note: in Bluetooth mode feature report 0x02 also changes the state
1720 * of the controller, so that it sends input reports of type 0x11.
1721 */
35f436c3 1722 if (sc->quirks & (DUALSHOCK4_CONTROLLER_USB | DUALSHOCK4_DONGLE)) {
f5dc93b7
RC		 1723 int retries;
1724
55a07d62
RC		 1725 buf = kmalloc(DS4_FEATURE_REPORT_0x02_SIZE, GFP_KERNEL);
1726 if (!buf)
1727 return -ENOMEM;
68330d83 1728
f5dc93b7
RC		 1729 /* We should normally receive the feature report data we asked
1730 * for, but hidraw applications such as Steam can issue feature
1731 * reports as well. In particular for Dongle reconnects, Steam
1732 * and this function are competing resulting in often receiving
1733 * data for a different HID report, so retry a few times.
1734 */
1735 for (retries = 0; retries < 3; retries++) {
1736 ret = hid_hw_raw_request(sc->hdev, 0x02, buf,
1737 DS4_FEATURE_REPORT_0x02_SIZE,
1738 HID_FEATURE_REPORT,
1739 HID_REQ_GET_REPORT);
1740 if (ret < 0)
1741 goto err_stop;
1742
1743 if (buf[0] != 0x02) {
1744 if (retries < 2) {
1745 hid_warn(sc->hdev, "Retrying DualShock 4 get calibration report (0x02) request\n");
1746 continue;
1747 } else {
1748 ret = -EILSEQ;
1749 goto err_stop;
1750 }
1751 } else {
1752 break;
1753 }
1754 }
55a07d62
RC		 1755 } else {
1756 u8 bthdr = 0xA3;
1757 u32 crc;
1758 u32 report_crc;
1759 int retries;
9b2b5c9a 1760
55a07d62
RC		 1761 buf = kmalloc(DS4_FEATURE_REPORT_0x05_SIZE, GFP_KERNEL);
1762 if (!buf)
1763 return -ENOMEM;
9b2b5c9a 1764
55a07d62
RC		 1765 for (retries = 0; retries < 3; retries++) {
1766 ret = hid_hw_raw_request(sc->hdev, 0x05, buf,
1767 DS4_FEATURE_REPORT_0x05_SIZE,
1768 HID_FEATURE_REPORT,
1769 HID_REQ_GET_REPORT);
1770 if (ret < 0)
1771 goto err_stop;
9b2b5c9a 1772
55a07d62
RC		 1773 /* CRC check */
1774 crc = crc32_le(0xFFFFFFFF, &bthdr, 1);
1775 crc = ~crc32_le(crc, buf, DS4_FEATURE_REPORT_0x05_SIZE-4);
1776 report_crc = get_unaligned_le32(&buf[DS4_FEATURE_REPORT_0x05_SIZE-4]);
1777 if (crc != report_crc) {
1778 hid_warn(sc->hdev, "DualShock 4 calibration report's CRC check failed, received crc 0x%0x != 0x%0x\n",
1779 report_crc, crc);
1780 if (retries < 2) {
1781 hid_warn(sc->hdev, "Retrying DualShock 4 get calibration report request\n");
1782 continue;
1783 } else {
1784 ret = -EILSEQ;
1785 goto err_stop;
1786 }
1787 } else {
1788 break;
1789 }
1790 }
1791 }
9b2b5c9a 1792
55a07d62
RC		 1793 gyro_pitch_bias = get_unaligned_le16(&buf[1]);
1794 gyro_yaw_bias = get_unaligned_le16(&buf[3]);
1795 gyro_roll_bias = get_unaligned_le16(&buf[5]);
1796 if (sc->quirks & DUALSHOCK4_CONTROLLER_USB) {
1797 gyro_pitch_plus = get_unaligned_le16(&buf[7]);
1798 gyro_pitch_minus = get_unaligned_le16(&buf[9]);
1799 gyro_yaw_plus = get_unaligned_le16(&buf[11]);
1800 gyro_yaw_minus = get_unaligned_le16(&buf[13]);
1801 gyro_roll_plus = get_unaligned_le16(&buf[15]);
1802 gyro_roll_minus = get_unaligned_le16(&buf[17]);
1803 } else {
35f436c3 1804 /* BT + Dongle */
55a07d62
RC		 1805 gyro_pitch_plus = get_unaligned_le16(&buf[7]);
1806 gyro_yaw_plus = get_unaligned_le16(&buf[9]);
1807 gyro_roll_plus = get_unaligned_le16(&buf[11]);
1808 gyro_pitch_minus = get_unaligned_le16(&buf[13]);
1809 gyro_yaw_minus = get_unaligned_le16(&buf[15]);
1810 gyro_roll_minus = get_unaligned_le16(&buf[17]);
1811 }
1812 gyro_speed_plus = get_unaligned_le16(&buf[19]);
1813 gyro_speed_minus = get_unaligned_le16(&buf[21]);
1814 acc_x_plus = get_unaligned_le16(&buf[23]);
1815 acc_x_minus = get_unaligned_le16(&buf[25]);
1816 acc_y_plus = get_unaligned_le16(&buf[27]);
1817 acc_y_minus = get_unaligned_le16(&buf[29]);
1818 acc_z_plus = get_unaligned_le16(&buf[31]);
1819 acc_z_minus = get_unaligned_le16(&buf[33]);
1820
1821 /* Set gyroscope calibration and normalization parameters.
1822 * Data values will be normalized to 1/DS4_GYRO_RES_PER_DEG_S degree/s.
1823 */
1824 speed_2x = (gyro_speed_plus + gyro_speed_minus);
1825 sc->ds4_calib_data[0].abs_code = ABS_RX;
1826 sc->ds4_calib_data[0].bias = gyro_pitch_bias;
1827 sc->ds4_calib_data[0].sens_numer = speed_2x*DS4_GYRO_RES_PER_DEG_S;
1828 sc->ds4_calib_data[0].sens_denom = gyro_pitch_plus - gyro_pitch_minus;
1829
1830 sc->ds4_calib_data[1].abs_code = ABS_RY;
1831 sc->ds4_calib_data[1].bias = gyro_yaw_bias;
1832 sc->ds4_calib_data[1].sens_numer = speed_2x*DS4_GYRO_RES_PER_DEG_S;
1833 sc->ds4_calib_data[1].sens_denom = gyro_yaw_plus - gyro_yaw_minus;
1834
1835 sc->ds4_calib_data[2].abs_code = ABS_RZ;
1836 sc->ds4_calib_data[2].bias = gyro_roll_bias;
1837 sc->ds4_calib_data[2].sens_numer = speed_2x*DS4_GYRO_RES_PER_DEG_S;
1838 sc->ds4_calib_data[2].sens_denom = gyro_roll_plus - gyro_roll_minus;
1839
1840 /* Set accelerometer calibration and normalization parameters.
1841 * Data values will be normalized to 1/DS4_ACC_RES_PER_G G.
1842 */
1843 range_2g = acc_x_plus - acc_x_minus;
1844 sc->ds4_calib_data[3].abs_code = ABS_X;
1845 sc->ds4_calib_data[3].bias = acc_x_plus - range_2g / 2;
1846 sc->ds4_calib_data[3].sens_numer = 2*DS4_ACC_RES_PER_G;
1847 sc->ds4_calib_data[3].sens_denom = range_2g;
1848
1849 range_2g = acc_y_plus - acc_y_minus;
1850 sc->ds4_calib_data[4].abs_code = ABS_Y;
1851 sc->ds4_calib_data[4].bias = acc_y_plus - range_2g / 2;
1852 sc->ds4_calib_data[4].sens_numer = 2*DS4_ACC_RES_PER_G;
1853 sc->ds4_calib_data[4].sens_denom = range_2g;
1854
1855 range_2g = acc_z_plus - acc_z_minus;
1856 sc->ds4_calib_data[5].abs_code = ABS_Z;
1857 sc->ds4_calib_data[5].bias = acc_z_plus - range_2g / 2;
1858 sc->ds4_calib_data[5].sens_numer = 2*DS4_ACC_RES_PER_G;
1859 sc->ds4_calib_data[5].sens_denom = range_2g;
1860
1861err_stop:
1862 kfree(buf);
9b2b5c9a 1863 return ret;
f9ce7c28
BN		 1864}
1865
f2f47c38
RC		 1866static void dualshock4_calibration_work(struct work_struct *work)
1867{
1868 struct sony_sc *sc = container_of(work, struct sony_sc, hotplug_worker);
1869 unsigned long flags;
1870 enum ds4_dongle_state dongle_state;
1871 int ret;
1872
1873 ret = dualshock4_get_calibration_data(sc);
1874 if (ret < 0) {
1875 /* This call is very unlikely to fail for the dongle. When it
1876 * fails we are probably in a very bad state, so mark the
1877 * dongle as disabled. We will re-enable the dongle if a new
1878 * DS4 hotplug is detect from sony_raw_event as any issues
1879 * are likely resolved then (the dongle is quite stupid).
1880 */
1881 hid_err(sc->hdev, "DualShock 4 USB dongle: calibration failed, disabling device\n");
1882 dongle_state = DONGLE_DISABLED;
1883 } else {
1884 hid_info(sc->hdev, "DualShock 4 USB dongle: calibration completed\n");
1885 dongle_state = DONGLE_CONNECTED;
1886 }
1887
1888 spin_lock_irqsave(&sc->lock, flags);
1889 sc->ds4_dongle_state = dongle_state;
1890 spin_unlock_irqrestore(&sc->lock, flags);
1891}
1892
169f15ab
RC		 1893static int dualshock4_get_version_info(struct sony_sc *sc)
1894{
1895 u8 *buf;
1896 int ret;
1897
1898 buf = kmalloc(DS4_FEATURE_REPORT_0xA3_SIZE, GFP_KERNEL);
1899 if (!buf)
1900 return -ENOMEM;
1901
1902 ret = hid_hw_raw_request(sc->hdev, 0xA3, buf,
1903 DS4_FEATURE_REPORT_0xA3_SIZE,
1904 HID_FEATURE_REPORT,
1905 HID_REQ_GET_REPORT);
1906 if (ret < 0) {
1907 kfree(buf);
1908 return ret;
1909 }
1910
1911 sc->hw_version = get_unaligned_le16(&buf[35]);
1912 sc->fw_version = get_unaligned_le16(&buf[41]);
1913
1914 kfree(buf);
1915 return 0;
1916}
1917
221399b3 1918static void sixaxis_set_leds_from_id(struct sony_sc *sc)
8025087a 1919{
1adf904e 1920 static const u8 sixaxis_leds[10][4] = {
8025087a
FP		 1921 { 0x01, 0x00, 0x00, 0x00 },
1922 { 0x00, 0x01, 0x00, 0x00 },
1923 { 0x00, 0x00, 0x01, 0x00 },
1924 { 0x00, 0x00, 0x00, 0x01 },
1925 { 0x01, 0x00, 0x00, 0x01 },
1926 { 0x00, 0x01, 0x00, 0x01 },
1927 { 0x00, 0x00, 0x01, 0x01 },
1928 { 0x01, 0x00, 0x01, 0x01 },
1929 { 0x00, 0x01, 0x01, 0x01 },
1930 { 0x01, 0x01, 0x01, 0x01 }
1931 };
1932
221399b3
FP		 1933 int id = sc->device_id;
1934
1935 BUILD_BUG_ON(MAX_LEDS < ARRAY_SIZE(sixaxis_leds[0]));
8025087a
FP		 1936
1937 if (id < 0)
1938 return;
1939
1940 id %= 10;
221399b3 1941 memcpy(sc->led_state, sixaxis_leds[id], sizeof(sixaxis_leds[id]));
8025087a
FP		 1942}
1943
221399b3 1944static void dualshock4_set_leds_from_id(struct sony_sc *sc)
8025087a
FP		 1945{
1946 /* The first 4 color/index entries match what the PS4 assigns */
1adf904e 1947 static const u8 color_code[7][3] = {
39254a13
RC		 1948 /* Blue */ { 0x00, 0x00, 0x40 },
1949 /* Red */ { 0x40, 0x00, 0x00 },
1950 /* Green */ { 0x00, 0x40, 0x00 },
1951 /* Pink */ { 0x20, 0x00, 0x20 },
8025087a
FP		 1952 /* Orange */ { 0x02, 0x01, 0x00 },
1953 /* Teal */ { 0x00, 0x01, 0x01 },
1954 /* White */ { 0x01, 0x01, 0x01 }
1955 };
1956
221399b3
FP		 1957 int id = sc->device_id;
1958
1959 BUILD_BUG_ON(MAX_LEDS < ARRAY_SIZE(color_code[0]));
8025087a
FP		 1960
1961 if (id < 0)
1962 return;
1963
1964 id %= 7;
221399b3 1965 memcpy(sc->led_state, color_code[id], sizeof(color_code[id]));
8025087a
FP		 1966}
1967
221399b3 1968static void buzz_set_leds(struct sony_sc *sc)
f04d5140 1969{
221399b3 1970 struct hid_device *hdev = sc->hdev;
f04d5140
CL		 1971 struct list_head *report_list =
1972 &hdev->report_enum[HID_OUTPUT_REPORT].report_list;
1973 struct hid_report *report = list_entry(report_list->next,
1974 struct hid_report, list);
1adf904e 1975 s32 *value = report->field[0]->value;
f04d5140 1976
221399b3
FP		 1977 BUILD_BUG_ON(MAX_LEDS < 4);
1978
f04d5140 1979 value[0] = 0x00;
221399b3
FP		 1980 value[1] = sc->led_state[0] ? 0xff : 0x00;
1981 value[2] = sc->led_state[1] ? 0xff : 0x00;
1982 value[3] = sc->led_state[2] ? 0xff : 0x00;
1983 value[4] = sc->led_state[3] ? 0xff : 0x00;
f04d5140
CL		 1984 value[5] = 0x00;
1985 value[6] = 0x00;
1986 hid_hw_request(hdev, report, HID_REQ_SET_REPORT);
1987}
1988
221399b3 1989static void sony_set_leds(struct sony_sc *sc)
0a286ef2 1990{
221399b3 1991 if (!(sc->quirks & BUZZ_CONTROLLER))
b5322736 1992 sony_schedule_work(sc, SONY_WORKER_STATE);
221399b3
FP		 1993 else
1994 buzz_set_leds(sc);
0a286ef2
SE		 1995}
1996
c5382519 1997static void sony_led_set_brightness(struct led_classdev *led,
f04d5140
CL		 1998 enum led_brightness value)
1999{
2000 struct device *dev = led->dev->parent;
ee79a8f8 2001 struct hid_device *hdev = to_hid_device(dev);
f04d5140 2002 struct sony_sc *drv_data;
f04d5140
CL		 2003
2004 int n;
b3ed458c 2005 int force_update;
f04d5140
CL		 2006
2007 drv_data = hid_get_drvdata(hdev);
2251b85f 2008 if (!drv_data) {
f04d5140
CL		 2009 hid_err(hdev, "No device data\n");
2010 return;
2011 }
f04d5140 2012
b3ed458c
FP		 2013 /*
2014 * The Sixaxis on USB will override any LED settings sent to it
2015 * and keep flashing all of the LEDs until the PS button is pressed.
2016 * Updates, even if redundant, must be always be sent to the
2017 * controller to avoid having to toggle the state of an LED just to
2018 * stop the flashing later on.
2019 */
2020 force_update = !!(drv_data->quirks & SIXAXIS_CONTROLLER_USB);
2021
60781cf4 2022 for (n = 0; n < drv_data->led_count; n++) {
b3ed458c
FP		 2023 if (led == drv_data->leds[n] && (force_update ||
2024 (value != drv_data->led_state[n] ||
2025 drv_data->led_delay_on[n] ||
2026 drv_data->led_delay_off[n]))) {
2027
2028 drv_data->led_state[n] = value;
2029
2030 /* Setting the brightness stops the blinking */
2031 drv_data->led_delay_on[n] = 0;
2032 drv_data->led_delay_off[n] = 0;
2033
221399b3 2034 sony_set_leds(drv_data);
f04d5140
CL		 2035 break;
2036 }
2037 }
2038}
2039
c5382519 2040static enum led_brightness sony_led_get_brightness(struct led_classdev *led)
f04d5140
CL		 2041{
2042 struct device *dev = led->dev->parent;
ee79a8f8 2043 struct hid_device *hdev = to_hid_device(dev);
f04d5140 2044 struct sony_sc *drv_data;
f04d5140
CL		 2045
2046 int n;
f04d5140
CL		 2047
2048 drv_data = hid_get_drvdata(hdev);
2251b85f 2049 if (!drv_data) {
f04d5140
CL		 2050 hid_err(hdev, "No device data\n");
2051 return LED_OFF;
2052 }
f04d5140 2053
60781cf4 2054 for (n = 0; n < drv_data->led_count; n++) {
7db7504a
SW		 2055 if (led == drv_data->leds[n])
2056 return drv_data->led_state[n];
f04d5140
CL		 2057 }
2058
7db7504a 2059 return LED_OFF;
f04d5140 2060}
f04d5140 2061
b3ed458c
FP		 2062static int sony_led_blink_set(struct led_classdev *led, unsigned long *delay_on,
2063 unsigned long *delay_off)
2064{
2065 struct device *dev = led->dev->parent;
ee79a8f8 2066 struct hid_device *hdev = to_hid_device(dev);
b3ed458c
FP		 2067 struct sony_sc *drv_data = hid_get_drvdata(hdev);
2068 int n;
1adf904e 2069 u8 new_on, new_off;
b3ed458c
FP		 2070
2071 if (!drv_data) {
2072 hid_err(hdev, "No device data\n");
2073 return -EINVAL;
2074 }
2075
2076 /* Max delay is 255 deciseconds or 2550 milliseconds */
2077 if (*delay_on > 2550)
2078 *delay_on = 2550;
2079 if (*delay_off > 2550)
2080 *delay_off = 2550;
2081
2082 /* Blink at 1 Hz if both values are zero */
2083 if (!*delay_on && !*delay_off)
2084 *delay_on = *delay_off = 500;
2085
2086 new_on = *delay_on / 10;
2087 new_off = *delay_off / 10;
2088
2089 for (n = 0; n < drv_data->led_count; n++) {
2090 if (led == drv_data->leds[n])
2091 break;
2092 }
2093
2094 /* This LED is not registered on this device */
2095 if (n >= drv_data->led_count)
2096 return -EINVAL;
2097
2098 /* Don't schedule work if the values didn't change */
2099 if (new_on != drv_data->led_delay_on[n] ||
2100 new_off != drv_data->led_delay_off[n]) {
2101 drv_data->led_delay_on[n] = new_on;
2102 drv_data->led_delay_off[n] = new_off;
b5322736 2103 sony_schedule_work(drv_data, SONY_WORKER_STATE);
b3ed458c
FP		 2104 }
2105
2106 return 0;
2107}
2108
fa57a810 2109static int sony_leds_init(struct sony_sc *sc)
f04d5140 2110{
fa57a810 2111 struct hid_device *hdev = sc->hdev;
40e32ee6 2112 int n, ret = 0;
b3ed458c 2113 int use_ds4_names;
40e32ee6
JK		 2114 struct led_classdev *led;
2115 size_t name_sz;
2116 char *name;
0a286ef2
SE		 2117 size_t name_len;
2118 const char *name_fmt;
b3ed458c
FP		 2119 static const char * const ds4_name_str[] = { "red", "green", "blue",
2120 "global" };
1adf904e
PM		 2121 u8 max_brightness[MAX_LEDS] = { [0 ... (MAX_LEDS - 1)] = 1 };
2122 u8 use_hw_blink[MAX_LEDS] = { 0 };
f04d5140 2123
fa57a810 2124 BUG_ON(!(sc->quirks & SONY_LED_SUPPORT));
0a286ef2 2125
fa57a810
FP		 2126 if (sc->quirks & BUZZ_CONTROLLER) {
2127 sc->led_count = 4;
b3ed458c 2128 use_ds4_names = 0;
0a286ef2
SE		 2129 name_len = strlen("::buzz#");
2130 name_fmt = "%s::buzz%d";
2131 /* Validate expected report characteristics. */
2132 if (!hid_validate_values(hdev, HID_OUTPUT_REPORT, 0, 0, 7))
2133 return -ENODEV;
fa57a810 2134 } else if (sc->quirks & DUALSHOCK4_CONTROLLER) {
221399b3
FP		 2135 dualshock4_set_leds_from_id(sc);
2136 sc->led_state[3] = 1;
b3ed458c
FP		 2137 sc->led_count = 4;
2138 memset(max_brightness, 255, 3);
2139 use_hw_blink[3] = 1;
2140 use_ds4_names = 1;
61ebca93
FP		 2141 name_len = 0;
2142 name_fmt = "%s:%s";
c5e0c1c4
FP		 2143 } else if (sc->quirks & MOTION_CONTROLLER) {
2144 sc->led_count = 3;
2145 memset(max_brightness, 255, 3);
2146 use_ds4_names = 1;
2147 name_len = 0;
2148 name_fmt = "%s:%s";
4545ee0a 2149 } else if (sc->quirks & NAVIGATION_CONTROLLER) {
1adf904e 2150 static const u8 navigation_leds[4] = {0x01, 0x00, 0x00, 0x00};
4545ee0a
SW		 2151
2152 memcpy(sc->led_state, navigation_leds, sizeof(navigation_leds));
2153 sc->led_count = 1;
2154 memset(use_hw_blink, 1, 4);
2155 use_ds4_names = 0;
2156 name_len = strlen("::sony#");
2157 name_fmt = "%s::sony%d";
60781cf4 2158 } else {
221399b3 2159 sixaxis_set_leds_from_id(sc);
fa57a810 2160 sc->led_count = 4;
b3ed458c
FP		 2161 memset(use_hw_blink, 1, 4);
2162 use_ds4_names = 0;
61ebca93
FP		 2163 name_len = strlen("::sony#");
2164 name_fmt = "%s::sony%d";
60781cf4
FP		 2165 }
2166
ad142b9e
FP		 2167 /*
2168 * Clear LEDs as we have no way of reading their initial state. This is
f04d5140 2169 * only relevant if the driver is loaded after somebody actively set the
ad142b9e
FP		 2170 * LEDs to on
2171 */
221399b3 2172 sony_set_leds(sc);
f04d5140 2173
0a286ef2 2174 name_sz = strlen(dev_name(&hdev->dev)) + name_len + 1;
f04d5140 2175
fa57a810 2176 for (n = 0; n < sc->led_count; n++) {
61ebca93 2177
b3ed458c
FP		 2178 if (use_ds4_names)
2179 name_sz = strlen(dev_name(&hdev->dev)) + strlen(ds4_name_str[n]) + 2;
61ebca93 2180
f2d98e2c 2181 led = devm_kzalloc(&hdev->dev, sizeof(struct led_classdev) + name_sz, GFP_KERNEL);
40e32ee6
JK		 2182 if (!led) {
2183 hid_err(hdev, "Couldn't allocate memory for LED %d\n", n);
f2d98e2c 2184 return -ENOMEM;
40e32ee6 2185 }
f04d5140 2186
40e32ee6 2187 name = (void *)(&led[1]);
b3ed458c
FP		 2188 if (use_ds4_names)
2189 snprintf(name, name_sz, name_fmt, dev_name(&hdev->dev),
2190 ds4_name_str[n]);
61ebca93
FP		 2191 else
2192 snprintf(name, name_sz, name_fmt, dev_name(&hdev->dev), n + 1);
40e32ee6 2193 led->name = name;
221399b3 2194 led->brightness = sc->led_state[n];
b3ed458c 2195 led->max_brightness = max_brightness[n];
765a1077 2196 led->flags = LED_CORE_SUSPENDRESUME;
c5382519
SE		 2197 led->brightness_get = sony_led_get_brightness;
2198 led->brightness_set = sony_led_set_brightness;
f04d5140 2199
b3ed458c
FP		 2200 if (use_hw_blink[n])
2201 led->blink_set = sony_led_blink_set;
2202
8025087a
FP		 2203 sc->leds[n] = led;
2204
f2d98e2c 2205 ret = devm_led_classdev_register(&hdev->dev, led);
8cd5fcda 2206 if (ret) {
40e32ee6 2207 hid_err(hdev, "Failed to register LED %d\n", n);
f2d98e2c 2208 return ret;
f04d5140
CL		 2209 }
2210 }
f04d5140 2211
f2d98e2c 2212 return 0;
f04d5140
CL		 2213}
2214
d8aaccda 2215static void sixaxis_send_output_report(struct sony_sc *sc)
a08c22c0 2216{
9b2b5c9a 2217 static const union sixaxis_output_report_01 default_report = {
55d3b664
FP		 2218 .buf = {
2219 0x01,
ad07b7a6 2220 0x01, 0xff, 0x00, 0xff, 0x00,
55d3b664
FP		 2221 0x00, 0x00, 0x00, 0x00, 0x00,
2222 0xff, 0x27, 0x10, 0x00, 0x32,
2223 0xff, 0x27, 0x10, 0x00, 0x32,
2224 0xff, 0x27, 0x10, 0x00, 0x32,
2225 0xff, 0x27, 0x10, 0x00, 0x32,
2226 0x00, 0x00, 0x00, 0x00, 0x00
2227 }
a08c22c0 2228 };
9b2b5c9a
FP		 2229 struct sixaxis_output_report *report =
2230 (struct sixaxis_output_report *)sc->output_report_dmabuf;
2231 int n;
2232
2233 /* Initialize the report with default values */
2234 memcpy(report, &default_report, sizeof(struct sixaxis_output_report));
9f323b68 2235
0a286ef2 2236#ifdef CONFIG_SONY_FF
9b2b5c9a
FP		 2237 report->rumble.right_motor_on = sc->right ? 1 : 0;
2238 report->rumble.left_motor_force = sc->left;
0a286ef2
SE		 2239#endif
2240
9b2b5c9a
FP		 2241 report->leds_bitmap |= sc->led_state[0] << 1;
2242 report->leds_bitmap |= sc->led_state[1] << 2;
2243 report->leds_bitmap |= sc->led_state[2] << 3;
2244 report->leds_bitmap |= sc->led_state[3] << 4;
9f323b68 2245
88f6576f 2246 /* Set flag for all leds off, required for 3rd party INTEC controller */
9b2b5c9a
FP		 2247 if ((report->leds_bitmap & 0x1E) == 0)
2248 report->leds_bitmap |= 0x20;
88f6576f 2249
b3ed458c
FP		 2250 /*
2251 * The LEDs in the report are indexed in reverse order to their
2252 * corresponding light on the controller.
2253 * Index 0 = LED 4, index 1 = LED 3, etc...
2254 *
2255 * In the case of both delay values being zero (blinking disabled) the
2256 * default report values should be used or the controller LED will be
2257 * always off.
2258 */
2259 for (n = 0; n < 4; n++) {
2260 if (sc->led_delay_on[n] || sc->led_delay_off[n]) {
9b2b5c9a
FP		 2261 report->led[3 - n].duty_off = sc->led_delay_off[n];
2262 report->led[3 - n].duty_on = sc->led_delay_on[n];
b3ed458c
FP		 2263 }
2264 }
2265
d03213f1
HY		 2266 /* SHANWAN controllers require output reports via intr channel */
2267 if (sc->quirks & SHANWAN_GAMEPAD)
2268 hid_hw_output_report(sc->hdev, (u8 *)report,
2269 sizeof(struct sixaxis_output_report));
2270 else
2271 hid_hw_raw_request(sc->hdev, report->report_id, (u8 *)report,
2272 sizeof(struct sixaxis_output_report),
2273 HID_OUTPUT_REPORT, HID_REQ_SET_REPORT);
9f323b68
SE		 2274}
2275
d8aaccda 2276static void dualshock4_send_output_report(struct sony_sc *sc)
0bd88dd3 2277{
0da8ea65 2278 struct hid_device *hdev = sc->hdev;
1adf904e 2279 u8 *buf = sc->output_report_dmabuf;
48220237
FP		 2280 int offset;
2281
c4425c8f 2282 /*
77b499e7
RC		 2283 * NOTE: The lower 6 bits of buf[1] field of the Bluetooth report
2284 * control the interval at which Dualshock 4 reports data:
2285 * 0x00 - 1ms
2286 * 0x01 - 1ms
2287 * 0x02 - 2ms
2288 * 0x3E - 62ms
2289 * 0x3F - disabled
c4425c8f 2290 */
35f436c3 2291 if (sc->quirks & (DUALSHOCK4_CONTROLLER_USB | DUALSHOCK4_DONGLE)) {
2c159de0 2292 memset(buf, 0, DS4_OUTPUT_REPORT_0x05_SIZE);
fdcf105d 2293 buf[0] = 0x05;
5caceb06 2294 buf[1] = 0x07; /* blink + LEDs + motor */
fdcf105d
FP		 2295 offset = 4;
2296 } else {
2c159de0 2297 memset(buf, 0, DS4_OUTPUT_REPORT_0x11_SIZE);
fdcf105d 2298 buf[0] = 0x11;
77b499e7 2299 buf[1] = 0xC0 /* HID + CRC */ | sc->ds4_bt_poll_interval;
5caceb06 2300 buf[3] = 0x07; /* blink + LEDs + motor */
fdcf105d
FP		 2301 offset = 6;
2302 }
0bd88dd3
FP		 2303
2304#ifdef CONFIG_SONY_FF
48220237
FP		 2305 buf[offset++] = sc->right;
2306 buf[offset++] = sc->left;
2307#else
2308 offset += 2;
0bd88dd3
FP		 2309#endif
2310
b3ed458c
FP		 2311 /* LED 3 is the global control */
2312 if (sc->led_state[3]) {
2313 buf[offset++] = sc->led_state[0];
2314 buf[offset++] = sc->led_state[1];
2315 buf[offset++] = sc->led_state[2];
2316 } else {
2317 offset += 3;
2318 }
2319
2320 /* If both delay values are zero the DualShock 4 disables blinking. */
2321 buf[offset++] = sc->led_delay_on[3];
2322 buf[offset++] = sc->led_delay_off[3];
60781cf4 2323
35f436c3 2324 if (sc->quirks & (DUALSHOCK4_CONTROLLER_USB | DUALSHOCK4_DONGLE))
2c159de0 2325 hid_hw_output_report(hdev, buf, DS4_OUTPUT_REPORT_0x05_SIZE);
e7ef53ad
RC		 2326 else {
2327 /* CRC generation */
2328 u8 bthdr = 0xA2;
2329 u32 crc;
2330
2331 crc = crc32_le(0xFFFFFFFF, &bthdr, 1);
2332 crc = ~crc32_le(crc, buf, DS4_OUTPUT_REPORT_0x11_SIZE-4);
2333 put_unaligned_le32(crc, &buf[74]);
2334 hid_hw_output_report(hdev, buf, DS4_OUTPUT_REPORT_0x11_SIZE);
2335 }
0bd88dd3
FP		 2336}
2337
d8aaccda 2338static void motion_send_output_report(struct sony_sc *sc)
c5e0c1c4 2339{
c5e0c1c4
FP		 2340 struct hid_device *hdev = sc->hdev;
2341 struct motion_output_report_02 *report =
2342 (struct motion_output_report_02 *)sc->output_report_dmabuf;
2343
41d2d425 2344 memset(report, 0, MOTION_REPORT_0x02_SIZE);
c5e0c1c4
FP		 2345
2346 report->type = 0x02; /* set leds */
2347 report->r = sc->led_state[0];
2348 report->g = sc->led_state[1];
2349 report->b = sc->led_state[2];
2350
2351#ifdef CONFIG_SONY_FF
2352 report->rumble = max(sc->right, sc->left);
2353#endif
2354
1adf904e 2355 hid_hw_output_report(hdev, (u8 *)report, MOTION_REPORT_0x02_SIZE);
c5e0c1c4
FP		 2356}
2357
decd946c
FP		 2358static inline void sony_send_output_report(struct sony_sc *sc)
2359{
2360 if (sc->send_output_report)
2361 sc->send_output_report(sc);
2362}
2363
d8aaccda
FP		 2364static void sony_state_worker(struct work_struct *work)
2365{
2366 struct sony_sc *sc = container_of(work, struct sony_sc, state_worker);
ef916ef5 2367
d8aaccda
FP		 2368 sc->send_output_report(sc);
2369}
2370
9b2b5c9a
FP		 2371static int sony_allocate_output_report(struct sony_sc *sc)
2372{
4545ee0a
SW		 2373 if ((sc->quirks & SIXAXIS_CONTROLLER) ||
2374 (sc->quirks & NAVIGATION_CONTROLLER))
9b2b5c9a 2375 sc->output_report_dmabuf =
ea58c33d
HZ		 2376 devm_kmalloc(&sc->hdev->dev,
2377 sizeof(union sixaxis_output_report_01),
9b2b5c9a
FP		 2378 GFP_KERNEL);
2379 else if (sc->quirks & DUALSHOCK4_CONTROLLER_BT)
ea58c33d
HZ		 2380 sc->output_report_dmabuf = devm_kmalloc(&sc->hdev->dev,
2381 DS4_OUTPUT_REPORT_0x11_SIZE,
9b2b5c9a 2382 GFP_KERNEL);
35f436c3 2383 else if (sc->quirks & (DUALSHOCK4_CONTROLLER_USB | DUALSHOCK4_DONGLE))
ea58c33d
HZ		 2384 sc->output_report_dmabuf = devm_kmalloc(&sc->hdev->dev,
2385 DS4_OUTPUT_REPORT_0x05_SIZE,
9b2b5c9a 2386 GFP_KERNEL);
c5e0c1c4 2387 else if (sc->quirks & MOTION_CONTROLLER)
ea58c33d
HZ		 2388 sc->output_report_dmabuf = devm_kmalloc(&sc->hdev->dev,
2389 MOTION_REPORT_0x02_SIZE,
41d2d425 2390 GFP_KERNEL);
9b2b5c9a
FP		 2391 else
2392 return 0;
2393
2394 if (!sc->output_report_dmabuf)
2395 return -ENOMEM;
2396
2397 return 0;
2398}
2399
0a286ef2 2400#ifdef CONFIG_SONY_FF
9f323b68
SE		 2401static int sony_play_effect(struct input_dev *dev, void *data,
2402 struct ff_effect *effect)
2403{
a08c22c0 2404 struct hid_device *hid = input_get_drvdata(dev);
9f323b68 2405 struct sony_sc *sc = hid_get_drvdata(hid);
a08c22c0
SE		 2406
2407 if (effect->type != FF_RUMBLE)
2408 return 0;
2409
9f323b68 2410 sc->left = effect->u.rumble.strong_magnitude / 256;
0bd88dd3 2411 sc->right = effect->u.rumble.weak_magnitude / 256;
a08c22c0 2412
b5322736 2413 sony_schedule_work(sc, SONY_WORKER_STATE);
9f323b68 2414 return 0;
a08c22c0
SE		 2415}
2416
fa57a810 2417static int sony_init_ff(struct sony_sc *sc)
a08c22c0 2418{
d9d4b1e4
AS		 2419 struct hid_input *hidinput;
2420 struct input_dev *input_dev;
2421
2422 if (list_empty(&sc->hdev->inputs)) {
2423 hid_err(sc->hdev, "no inputs found\n");
2424 return -ENODEV;
2425 }
2426 hidinput = list_entry(sc->hdev->inputs.next, struct hid_input, list);
2427 input_dev = hidinput->input;
a08c22c0
SE		 2428
2429 input_set_capability(input_dev, EV_FF, FF_RUMBLE);
2430 return input_ff_create_memless(input_dev, NULL, sony_play_effect);
2431}
2432
2433#else
fa57a810 2434static int sony_init_ff(struct sony_sc *sc)
a08c22c0
SE		 2435{
2436 return 0;
2437}
9f323b68 2438
a08c22c0
SE		 2439#endif
2440
d902f472
FP		 2441static int sony_battery_get_property(struct power_supply *psy,
2442 enum power_supply_property psp,
2443 union power_supply_propval *val)
2444{
297d716f 2445 struct sony_sc *sc = power_supply_get_drvdata(psy);
d902f472
FP		 2446 unsigned long flags;
2447 int ret = 0;
a76a6c18
RC		 2448 u8 battery_capacity;
2449 int battery_status;
d902f472
FP		 2450
2451 spin_lock_irqsave(&sc->lock, flags);
d902f472 2452 battery_capacity = sc->battery_capacity;
a76a6c18 2453 battery_status = sc->battery_status;
d902f472
FP		 2454 spin_unlock_irqrestore(&sc->lock, flags);
2455
2456 switch (psp) {
2457 case POWER_SUPPLY_PROP_PRESENT:
2458 val->intval = 1;
2459 break;
2460 case POWER_SUPPLY_PROP_SCOPE:
2461 val->intval = POWER_SUPPLY_SCOPE_DEVICE;
2462 break;
2463 case POWER_SUPPLY_PROP_CAPACITY:
2464 val->intval = battery_capacity;
2465 break;
2466 case POWER_SUPPLY_PROP_STATUS:
a76a6c18 2467 val->intval = battery_status;
d902f472
FP		 2468 break;
2469 default:
2470 ret = -EINVAL;
2471 break;
2472 }
2473 return ret;
9f323b68
SE		 2474}
2475
0f398230 2476static int sony_battery_probe(struct sony_sc *sc, int append_dev_id)
c4e1ddf2 2477{
0f398230
FP		 2478 const char *battery_str_fmt = append_dev_id ?
2479 "sony_controller_battery_%pMR_%i" :
2480 "sony_controller_battery_%pMR";
297d716f 2481 struct power_supply_config psy_cfg = { .drv_data = sc, };
c4e1ddf2 2482 struct hid_device *hdev = sc->hdev;
d902f472 2483 int ret;
c4e1ddf2 2484
ad142b9e
FP		 2485 /*
2486 * Set the default battery level to 100% to avoid low battery warnings
d9a293a9
FP		 2487 * if the battery is polled before the first device report is received.
2488 */
2489 sc->battery_capacity = 100;
2490
297d716f
KK		 2491 sc->battery_desc.properties = sony_battery_props;
2492 sc->battery_desc.num_properties = ARRAY_SIZE(sony_battery_props);
2493 sc->battery_desc.get_property = sony_battery_get_property;
2494 sc->battery_desc.type = POWER_SUPPLY_TYPE_BATTERY;
2495 sc->battery_desc.use_for_apm = 0;
8082d3f0
HZ		 2496 sc->battery_desc.name = devm_kasprintf(&hdev->dev, GFP_KERNEL,
2497 battery_str_fmt, sc->mac_address, sc->device_id);
297d716f 2498 if (!sc->battery_desc.name)
d902f472 2499 return -ENOMEM;
c4e1ddf2 2500
8082d3f0 2501 sc->battery = devm_power_supply_register(&hdev->dev, &sc->battery_desc,
297d716f
KK		 2502 &psy_cfg);
2503 if (IS_ERR(sc->battery)) {
2504 ret = PTR_ERR(sc->battery);
d902f472 2505 hid_err(hdev, "Unable to register battery device\n");
8082d3f0 2506 return ret;
d902f472 2507 }
c4e1ddf2 2508
297d716f 2509 power_supply_powers(sc->battery, &hdev->dev);
a08c22c0 2510 return 0;
9f323b68 2511}
a08c22c0 2512
d2d782fc
FP		 2513/*
2514 * If a controller is plugged in via USB while already connected via Bluetooth
2515 * it will show up as two devices. A global list of connected controllers and
2516 * their MAC addresses is maintained to ensure that a device is only connected
2517 * once.
0f398230
FP		 2518 *
2519 * Some USB-only devices masquerade as Sixaxis controllers and all have the
2520 * same dummy Bluetooth address, so a comparison of the connection type is
2521 * required. Devices are only rejected in the case where two devices have
2522 * matching Bluetooth addresses on different bus types.
d2d782fc 2523 */
0f398230
FP		 2524static inline int sony_compare_connection_type(struct sony_sc *sc0,
2525 struct sony_sc *sc1)
2526{
2527 const int sc0_not_bt = !(sc0->quirks & SONY_BT_DEVICE);
2528 const int sc1_not_bt = !(sc1->quirks & SONY_BT_DEVICE);
2529
2530 return sc0_not_bt == sc1_not_bt;
2531}
2532
d2d782fc
FP		 2533static int sony_check_add_dev_list(struct sony_sc *sc)
2534{
2535 struct sony_sc *entry;
2536 unsigned long flags;
2537 int ret;
2538
2539 spin_lock_irqsave(&sony_dev_list_lock, flags);
2540
2541 list_for_each_entry(entry, &sony_device_list, list_node) {
2542 ret = memcmp(sc->mac_address, entry->mac_address,
2543 sizeof(sc->mac_address));
2544 if (!ret) {
0f398230
FP		 2545 if (sony_compare_connection_type(sc, entry)) {
2546 ret = 1;
2547 } else {
2548 ret = -EEXIST;
2549 hid_info(sc->hdev,
2550 "controller with MAC address %pMR already connected\n",
d2d782fc 2551 sc->mac_address);
0f398230 2552 }
d2d782fc 2553 goto unlock;
c4e1ddf2
FP		 2554 }
2555 }
2556
d2d782fc
FP		 2557 ret = 0;
2558 list_add(&(sc->list_node), &sony_device_list);
c4e1ddf2 2559
d2d782fc
FP		 2560unlock:
2561 spin_unlock_irqrestore(&sony_dev_list_lock, flags);
2562 return ret;
2563}
2564
2565static void sony_remove_dev_list(struct sony_sc *sc)
2566{
2567 unsigned long flags;
c4e1ddf2 2568
d2d782fc
FP		 2569 if (sc->list_node.next) {
2570 spin_lock_irqsave(&sony_dev_list_lock, flags);
2571 list_del(&(sc->list_node));
2572 spin_unlock_irqrestore(&sony_dev_list_lock, flags);
2573 }
c4e1ddf2
FP		 2574}
2575
d2d782fc
FP		 2576static int sony_get_bt_devaddr(struct sony_sc *sc)
2577{
2578 int ret;
2579
2580 /* HIDP stores the device MAC address as a string in the uniq field. */
2581 ret = strlen(sc->hdev->uniq);
2582 if (ret != 17)
2583 return -EINVAL;
2584
2585 ret = sscanf(sc->hdev->uniq,
2586 "%02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx",
2587 &sc->mac_address[5], &sc->mac_address[4], &sc->mac_address[3],
2588 &sc->mac_address[2], &sc->mac_address[1], &sc->mac_address[0]);
2589
2590 if (ret != 6)
2591 return -EINVAL;
2592
2593 return 0;
2594}
2595
2596static int sony_check_add(struct sony_sc *sc)
2597{
1adf904e 2598 u8 *buf = NULL;
d2d782fc
FP		 2599 int n, ret;
2600
2601 if ((sc->quirks & DUALSHOCK4_CONTROLLER_BT) ||
12e9a6d7 2602 (sc->quirks & MOTION_CONTROLLER_BT) ||
4545ee0a 2603 (sc->quirks & NAVIGATION_CONTROLLER_BT) ||
d2d782fc
FP		 2604 (sc->quirks & SIXAXIS_CONTROLLER_BT)) {
2605 /*
2606 * sony_get_bt_devaddr() attempts to parse the Bluetooth MAC
2607 * address from the uniq string where HIDP stores it.
2608 * As uniq cannot be guaranteed to be a MAC address in all cases
2609 * a failure of this function should not prevent the connection.
2610 */
2611 if (sony_get_bt_devaddr(sc) < 0) {
2612 hid_warn(sc->hdev, "UNIQ does not contain a MAC address; duplicate check skipped\n");
2613 return 0;
2614 }
35f436c3 2615 } else if (sc->quirks & (DUALSHOCK4_CONTROLLER_USB | DUALSHOCK4_DONGLE)) {
2c159de0 2616 buf = kmalloc(DS4_FEATURE_REPORT_0x81_SIZE, GFP_KERNEL);
9b2b5c9a
FP		 2617 if (!buf)
2618 return -ENOMEM;
d2d782fc
FP		 2619
2620 /*
2621 * The MAC address of a DS4 controller connected via USB can be
2622 * retrieved with feature report 0x81. The address begins at
2623 * offset 1.
2624 */
9b2b5c9a 2625 ret = hid_hw_raw_request(sc->hdev, 0x81, buf,
2c159de0 2626 DS4_FEATURE_REPORT_0x81_SIZE, HID_FEATURE_REPORT,
9b2b5c9a 2627 HID_REQ_GET_REPORT);
d2d782fc 2628
2c159de0 2629 if (ret != DS4_FEATURE_REPORT_0x81_SIZE) {
d2d782fc 2630 hid_err(sc->hdev, "failed to retrieve feature report 0x81 with the DualShock 4 MAC address\n");
9b2b5c9a
FP		 2631 ret = ret < 0 ? ret : -EINVAL;
2632 goto out_free;
d2d782fc
FP		 2633 }
2634
2635 memcpy(sc->mac_address, &buf[1], sizeof(sc->mac_address));
c70d5f70
RC		 2636
2637 snprintf(sc->hdev->uniq, sizeof(sc->hdev->uniq),
648d4932 2638 "%pMR", sc->mac_address);
4545ee0a
SW		 2639 } else if ((sc->quirks & SIXAXIS_CONTROLLER_USB) ||
2640 (sc->quirks & NAVIGATION_CONTROLLER_USB)) {
9b2b5c9a
FP		 2641 buf = kmalloc(SIXAXIS_REPORT_0xF2_SIZE, GFP_KERNEL);
2642 if (!buf)
2643 return -ENOMEM;
d2d782fc
FP		 2644
2645 /*
2646 * The MAC address of a Sixaxis controller connected via USB can
2647 * be retrieved with feature report 0xf2. The address begins at
2648 * offset 4.
2649 */
9b2b5c9a
FP		 2650 ret = hid_hw_raw_request(sc->hdev, 0xf2, buf,
2651 SIXAXIS_REPORT_0xF2_SIZE, HID_FEATURE_REPORT,
2652 HID_REQ_GET_REPORT);
d2d782fc 2653
9b2b5c9a 2654 if (ret != SIXAXIS_REPORT_0xF2_SIZE) {
d2d782fc 2655 hid_err(sc->hdev, "failed to retrieve feature report 0xf2 with the Sixaxis MAC address\n");
9b2b5c9a
FP		 2656 ret = ret < 0 ? ret : -EINVAL;
2657 goto out_free;
d2d782fc
FP		 2658 }
2659
2660 /*
2661 * The Sixaxis device MAC in the report is big-endian and must
2662 * be byte-swapped.
2663 */
2664 for (n = 0; n < 6; n++)
2665 sc->mac_address[5-n] = buf[4+n];
5a144be3
RC		 2666
2667 snprintf(sc->hdev->uniq, sizeof(sc->hdev->uniq),
648d4932 2668 "%pMR", sc->mac_address);
d2d782fc
FP		 2669 } else {
2670 return 0;
2671 }
2672
9b2b5c9a
FP		 2673 ret = sony_check_add_dev_list(sc);
2674
2675out_free:
2676
2677 kfree(buf);
2678
2679 return ret;
d2d782fc
FP		 2680}
2681
8025087a
FP		 2682static int sony_set_device_id(struct sony_sc *sc)
2683{
2684 int ret;
2685
2686 /*
2687 * Only DualShock 4 or Sixaxis controllers get an id.
2688 * All others are set to -1.
2689 */
2690 if ((sc->quirks & SIXAXIS_CONTROLLER) ||
2691 (sc->quirks & DUALSHOCK4_CONTROLLER)) {
2692 ret = ida_simple_get(&sony_device_id_allocator, 0, 0,
2693 GFP_KERNEL);
2694 if (ret < 0) {
2695 sc->device_id = -1;
2696 return ret;
2697 }
2698 sc->device_id = ret;
2699 } else {
2700 sc->device_id = -1;
2701 }
2702
2703 return 0;
2704}
2705
2706static void sony_release_device_id(struct sony_sc *sc)
2707{
2708 if (sc->device_id >= 0) {
2709 ida_simple_remove(&sony_device_id_allocator, sc->device_id);
2710 sc->device_id = -1;
2711 }
2712}
2713
d8aaccda 2714static inline void sony_init_output_report(struct sony_sc *sc,
09593e38 2715 void (*send_output_report)(struct sony_sc *))
46262047 2716{
d8aaccda
FP		 2717 sc->send_output_report = send_output_report;
2718
b5322736 2719 if (!sc->state_worker_initialized)
d8aaccda 2720 INIT_WORK(&sc->state_worker, sony_state_worker);
46262047 2721
b5322736 2722 sc->state_worker_initialized = 1;
46262047
FP		 2723}
2724
2725static inline void sony_cancel_work_sync(struct sony_sc *sc)
2726{
e0f6974a
RC		 2727 unsigned long flags;
2728
f2f47c38
RC		 2729 if (sc->hotplug_worker_initialized)
2730 cancel_work_sync(&sc->hotplug_worker);
e0f6974a
RC		 2731 if (sc->state_worker_initialized) {
2732 spin_lock_irqsave(&sc->lock, flags);
2733 sc->state_worker_initialized = 0;
2734 spin_unlock_irqrestore(&sc->lock, flags);
46262047 2735 cancel_work_sync(&sc->state_worker);
e0f6974a 2736 }
46262047 2737}
d2d782fc 2738
e1bc84d0
RC		 2739static int sony_input_configured(struct hid_device *hdev,
2740 struct hid_input *hidinput)
bd28ce00 2741{
e1bc84d0 2742 struct sony_sc *sc = hid_get_drvdata(hdev);
0f398230 2743 int append_dev_id;
e1bc84d0 2744 int ret;
bd28ce00 2745
131a8a9a 2746 ret = sony_set_device_id(sc);
9b2b5c9a 2747 if (ret < 0) {
131a8a9a 2748 hid_err(hdev, "failed to allocate the device id\n");
9b2b5c9a
FP		 2749 goto err_stop;
2750 }
2751
df848bc0
RC		 2752 ret = append_dev_id = sony_check_add(sc);
2753 if (ret < 0)
2754 goto err_stop;
2755
131a8a9a 2756 ret = sony_allocate_output_report(sc);
8025087a 2757 if (ret < 0) {
131a8a9a 2758 hid_err(hdev, "failed to allocate the output report buffer\n");
8025087a
FP		 2759 goto err_stop;
2760 }
2761
510c8b7c 2762 if (sc->quirks & NAVIGATION_CONTROLLER_USB) {
e534a935
BT		 2763 /*
2764 * The Sony Sixaxis does not handle HID Output Reports on the
2765 * Interrupt EP like it could, so we need to force HID Output
2766 * Reports to use HID_REQ_SET_REPORT on the Control EP.
2767 *
2768 * There is also another issue about HID Output Reports via USB,
2769 * the Sixaxis does not want the report_id as part of the data
2770 * packet, so we have to discard buf[0] when sending the actual
2771 * control message, even for numbered reports, humpf!
2a242932
FP		 2772 *
2773 * Additionally, the Sixaxis on USB isn't properly initialized
2774 * until the PS logo button is pressed and as such won't retain
2775 * any state set by an output report, so the initial
2776 * configuration report is deferred until the first input
2777 * report arrives.
e534a935
BT		 2778 */
2779 hdev->quirks |= HID_QUIRK_NO_OUTPUT_REPORTS_ON_INTR_EP;
2780 hdev->quirks |= HID_QUIRK_SKIP_OUTPUT_REPORT_ID;
2a242932 2781 sc->defer_initialization = 1;
80ecc48c 2782
816651a7 2783 ret = sixaxis_set_operational_usb(hdev);
80ecc48c
RC		 2784 if (ret < 0) {
2785 hid_err(hdev, "Failed to set controller into operational mode\n");
2786 goto err_stop;
2787 }
2788
d8aaccda 2789 sony_init_output_report(sc, sixaxis_send_output_report);
510c8b7c
RC		 2790 } else if (sc->quirks & NAVIGATION_CONTROLLER_BT) {
2791 /*
2792 * The Navigation controller wants output reports sent on the ctrl
2793 * endpoint when connected via Bluetooth.
2794 */
2795 hdev->quirks |= HID_QUIRK_NO_OUTPUT_REPORTS_ON_INTR_EP;
2796
2797 ret = sixaxis_set_operational_bt(hdev);
2798 if (ret < 0) {
2799 hid_err(hdev, "Failed to set controller into operational mode\n");
2800 goto err_stop;
2801 }
2802
d8aaccda 2803 sony_init_output_report(sc, sixaxis_send_output_report);
510c8b7c
RC		 2804 } else if (sc->quirks & SIXAXIS_CONTROLLER_USB) {
2805 /*
2806 * The Sony Sixaxis does not handle HID Output Reports on the
2807 * Interrupt EP and the device only becomes active when the
2808 * PS button is pressed. See comment for Navigation controller
2809 * above for more details.
2810 */
2811 hdev->quirks |= HID_QUIRK_NO_OUTPUT_REPORTS_ON_INTR_EP;
2812 hdev->quirks |= HID_QUIRK_SKIP_OUTPUT_REPORT_ID;
2813 sc->defer_initialization = 1;
2814
2815 ret = sixaxis_set_operational_usb(hdev);
2816 if (ret < 0) {
2817 hid_err(hdev, "Failed to set controller into operational mode\n");
2818 goto err_stop;
2819 }
2820
2821 ret = sony_register_sensors(sc);
2822 if (ret) {
2823 hid_err(sc->hdev,
2824 "Unable to initialize motion sensors: %d\n", ret);
2825 goto err_stop;
2826 }
2827
2828 sony_init_output_report(sc, sixaxis_send_output_report);
2829 } else if (sc->quirks & SIXAXIS_CONTROLLER_BT) {
2078b9bb
FP		 2830 /*
2831 * The Sixaxis wants output reports sent on the ctrl endpoint
2832 * when connected via Bluetooth.
2833 */
2834 hdev->quirks |= HID_QUIRK_NO_OUTPUT_REPORTS_ON_INTR_EP;
80ecc48c 2835
816651a7 2836 ret = sixaxis_set_operational_bt(hdev);
80ecc48c
RC		 2837 if (ret < 0) {
2838 hid_err(hdev, "Failed to set controller into operational mode\n");
2839 goto err_stop;
2840 }
2841
510c8b7c
RC		 2842 ret = sony_register_sensors(sc);
2843 if (ret) {
2844 hid_err(sc->hdev,
2845 "Unable to initialize motion sensors: %d\n", ret);
2846 goto err_stop;
2847 }
2848
d8aaccda 2849 sony_init_output_report(sc, sixaxis_send_output_report);
fee4e2d5 2850 } else if (sc->quirks & DUALSHOCK4_CONTROLLER) {
55a07d62
RC		 2851 ret = dualshock4_get_calibration_data(sc);
2852 if (ret < 0) {
2853 hid_err(hdev, "Failed to get calibration data from Dualshock 4\n");
2854 goto err_stop;
68330d83 2855 }
c4e1ddf2 2856
169f15ab
RC		 2857 ret = dualshock4_get_version_info(sc);
2858 if (ret < 0) {
2859 hid_err(sc->hdev, "Failed to get version data from Dualshock 4\n");
2860 goto err_stop;
2861 }
2862
2863 ret = device_create_file(&sc->hdev->dev, &dev_attr_firmware_version);
2864 if (ret) {
169f15ab
RC		 2865 hid_err(sc->hdev, "can't create sysfs firmware_version attribute err: %d\n", ret);
2866 goto err_stop;
2867 }
1a8212e8 2868 sc->fw_version_created = true;
169f15ab
RC		 2869
2870 ret = device_create_file(&sc->hdev->dev, &dev_attr_hardware_version);
2871 if (ret) {
169f15ab
RC		 2872 hid_err(sc->hdev, "can't create sysfs hardware_version attribute err: %d\n", ret);
2873 goto err_stop;
2874 }
1a8212e8 2875 sc->hw_version_created = true;
169f15ab 2876
e1bc84d0
RC		 2877 /*
2878 * The Dualshock 4 touchpad supports 2 touches and has a
2879 * resolution of 1920x942 (44.86 dots/mm).
2880 */
b7289cb1 2881 ret = sony_register_touchpad(sc, 2, 1920, 942, 0, 0, 0);
e1bc84d0
RC		 2882 if (ret) {
2883 hid_err(sc->hdev,
2884 "Unable to initialize multi-touch slots: %d\n",
2885 ret);
2b6579d4 2886 goto err_stop;
e1bc84d0
RC		 2887 }
2888
227c011b
RC		 2889 ret = sony_register_sensors(sc);
2890 if (ret) {
2891 hid_err(sc->hdev,
2892 "Unable to initialize motion sensors: %d\n", ret);
2893 goto err_stop;
2894 }
2895
77b499e7
RC		 2896 if (sc->quirks & DUALSHOCK4_CONTROLLER_BT) {
2897 sc->ds4_bt_poll_interval = DS4_BT_DEFAULT_POLL_INTERVAL_MS;
2898 ret = device_create_file(&sc->hdev->dev, &dev_attr_bt_poll_interval);
2899 if (ret)
2900 hid_warn(sc->hdev,
2901 "can't create sysfs bt_poll_interval attribute err: %d\n",
2902 ret);
2903 }
2904
f2f47c38
RC		 2905 if (sc->quirks & DUALSHOCK4_DONGLE) {
2906 INIT_WORK(&sc->hotplug_worker, dualshock4_calibration_work);
2907 sc->hotplug_worker_initialized = 1;
2908 sc->ds4_dongle_state = DONGLE_DISCONNECTED;
2909 }
2910
d8aaccda 2911 sony_init_output_report(sc, dualshock4_send_output_report);
b7289cb1
TK		 2912 } else if (sc->quirks & NSG_MRXU_REMOTE) {
2913 /*
2914 * The NSG-MRxU touchpad supports 2 touches and has a
2915 * resolution of 1667x1868
2916 */
2917 ret = sony_register_touchpad(sc, 2,
2918 NSG_MRXU_MAX_X, NSG_MRXU_MAX_Y, 15, 15, 1);
2919 if (ret) {
2920 hid_err(sc->hdev,
2921 "Unable to initialize multi-touch slots: %d\n",
2922 ret);
2923 goto err_stop;
2924 }
2925
c5e0c1c4 2926 } else if (sc->quirks & MOTION_CONTROLLER) {
d8aaccda 2927 sony_init_output_report(sc, motion_send_output_report);
0bd88dd3
FP		 2928 } else {
2929 ret = 0;
2930 }
f9ce7c28 2931
0a286ef2 2932 if (sc->quirks & SONY_LED_SUPPORT) {
fa57a810 2933 ret = sony_leds_init(sc);
0a286ef2
SE		 2934 if (ret < 0)
2935 goto err_stop;
2936 }
2937
d902f472 2938 if (sc->quirks & SONY_BATTERY_SUPPORT) {
0f398230 2939 ret = sony_battery_probe(sc, append_dev_id);
d902f472
FP		 2940 if (ret < 0)
2941 goto err_stop;
2942
2943 /* Open the device to receive reports with battery info */
2944 ret = hid_hw_open(hdev);
2945 if (ret < 0) {
2946 hid_err(hdev, "hw open failed\n");
2947 goto err_stop;
2948 }
2949 }
2950
c8de9dbb 2951 if (sc->quirks & SONY_FF_SUPPORT) {
fa57a810 2952 ret = sony_init_ff(sc);
c8de9dbb
FP		 2953 if (ret < 0)
2954 goto err_close;
5f5750d2 2955 }
a08c22c0 2956
bd28ce00 2957 return 0;
d902f472
FP		 2958err_close:
2959 hid_hw_close(hdev);
bd28ce00 2960err_stop:
77b499e7
RC		 2961 /* Piggy back on the default ds4_bt_ poll_interval to determine
2962 * if we need to remove the file as we don't know for sure if we
2963 * executed that logic.
2964 */
2965 if (sc->ds4_bt_poll_interval)
2966 device_remove_file(&sc->hdev->dev, &dev_attr_bt_poll_interval);
1a8212e8 2967 if (sc->fw_version_created)
169f15ab 2968 device_remove_file(&sc->hdev->dev, &dev_attr_firmware_version);
1a8212e8 2969 if (sc->hw_version_created)
169f15ab 2970 device_remove_file(&sc->hdev->dev, &dev_attr_hardware_version);
46262047 2971 sony_cancel_work_sync(sc);
d2d782fc 2972 sony_remove_dev_list(sc);
8025087a 2973 sony_release_device_id(sc);
bd28ce00
JS		 2974 return ret;
2975}
2976
e1bc84d0
RC		 2977static int sony_probe(struct hid_device *hdev, const struct hid_device_id *id)
2978{
2979 int ret;
2980 unsigned long quirks = id->driver_data;
2981 struct sony_sc *sc;
fb1a79a6 2982 struct usb_device *usbdev;
e1bc84d0
RC		 2983 unsigned int connect_mask = HID_CONNECT_DEFAULT;
2984
2985 if (!strcmp(hdev->name, "FutureMax Dance Mat"))
2986 quirks |= FUTUREMAX_DANCE_MAT;
2987
bab94e97
US		 2988 if (!strcmp(hdev->name, "SHANWAN PS3 GamePad") ||
2989 !strcmp(hdev->name, "ShanWan PS(R) Ga`epad"))
69481059
HY		 2990 quirks |= SHANWAN_GAMEPAD;
2991
e1bc84d0
RC		 2992 sc = devm_kzalloc(&hdev->dev, sizeof(*sc), GFP_KERNEL);
2993 if (sc == NULL) {
2994 hid_err(hdev, "can't alloc sony descriptor\n");
2995 return -ENOMEM;
2996 }
2997
2998 spin_lock_init(&sc->lock);
2999
3000 sc->quirks = quirks;
3001 hid_set_drvdata(hdev, sc);
3002 sc->hdev = hdev;
fb1a79a6 3003 usbdev = to_usb_device(sc->hdev->dev.parent->parent);
e1bc84d0
RC		 3004
3005 ret = hid_parse(hdev);
3006 if (ret) {
3007 hid_err(hdev, "parse failed\n");
3008 return ret;
3009 }
3010
3011 if (sc->quirks & VAIO_RDESC_CONSTANT)
3012 connect_mask |= HID_CONNECT_HIDDEV_FORCE;
3013 else if (sc->quirks & SIXAXIS_CONTROLLER)
3014 connect_mask |= HID_CONNECT_HIDDEV_FORCE;
3015
e19a267b 3016 /* Patch the hw version on DS3/4 compatible devices, so applications can
9131f8cc
RC		 3017 * distinguish between the default HID mappings and the mappings defined
3018 * by the Linux game controller spec. This is important for the SDL2
3019 * library, which has a game controller database, which uses device ids
3020 * in combination with version as a key.
3021 */
e19a267b 3022 if (sc->quirks & (SIXAXIS_CONTROLLER | DUALSHOCK4_CONTROLLER))
9131f8cc
RC		 3023 hdev->version |= 0x8000;
3024
e1bc84d0
RC		 3025 ret = hid_hw_start(hdev, connect_mask);
3026 if (ret) {
3027 hid_err(hdev, "hw start failed\n");
3028 return ret;
3029 }
3030
4f967f6d
RC		 3031 /* sony_input_configured can fail, but this doesn't result
3032 * in hid_hw_start failures (intended). Check whether
3033 * the HID layer claimed the device else fail.
3034 * We don't know the actual reason for the failure, most
3035 * likely it is due to EEXIST in case of double connection
3036 * of USB and Bluetooth, but could have been due to ENOMEM
3037 * or other reasons as well.
3038 */
3039 if (!(hdev->claimed & HID_CLAIMED_INPUT)) {
3040 hid_err(hdev, "failed to claim input\n");
2bcdacb7 3041 hid_hw_stop(hdev);
4f967f6d
RC		 3042 return -ENODEV;
3043 }
3044
a4bfe13f 3045 if (sc->quirks & (GHL_GUITAR_PS3WIIU | GHL_GUITAR_PS4)) {
fb1a79a6
PG		 3046 sc->ghl_urb = usb_alloc_urb(0, GFP_ATOMIC);
3047 if (!sc->ghl_urb)
3048 return -ENOMEM;
a4bfe13f
DN		 3049
3050 if (sc->quirks & GHL_GUITAR_PS3WIIU)
3051 ret = ghl_init_urb(sc, usbdev, ghl_ps3wiiu_magic_data,
3052 ARRAY_SIZE(ghl_ps3wiiu_magic_data));
3053 else if (sc->quirks & GHL_GUITAR_PS4)
3054 ret = ghl_init_urb(sc, usbdev, ghl_ps4_magic_data,
3055 ARRAY_SIZE(ghl_ps4_magic_data));
fb1a79a6
PG		 3056 if (ret) {
3057 hid_err(hdev, "error preparing URB\n");
3058 return ret;
3059 }
3060
cc894ac5
PG		 3061 timer_setup(&sc->ghl_poke_timer, ghl_magic_poke, 0);
3062 mod_timer(&sc->ghl_poke_timer,
3063 jiffies + GHL_GUITAR_POKE_INTERVAL*HZ);
3064 }
3065
e1bc84d0
RC		 3066 return ret;
3067}
3068
cc6e0bbb
JK		 3069static void sony_remove(struct hid_device *hdev)
3070{
f04d5140
CL		 3071 struct sony_sc *sc = hid_get_drvdata(hdev);
3072
a4bfe13f 3073 if (sc->quirks & (GHL_GUITAR_PS3WIIU | GHL_GUITAR_PS4)) {
cc894ac5 3074 del_timer_sync(&sc->ghl_poke_timer);
fb1a79a6
PG		 3075 usb_free_urb(sc->ghl_urb);
3076 }
cc894ac5 3077
ac797b95
RC		 3078 hid_hw_close(hdev);
3079
77b499e7
RC		 3080 if (sc->quirks & DUALSHOCK4_CONTROLLER_BT)
3081 device_remove_file(&sc->hdev->dev, &dev_attr_bt_poll_interval);
3082
1a8212e8 3083 if (sc->fw_version_created)
169f15ab
RC		 3084 device_remove_file(&sc->hdev->dev, &dev_attr_firmware_version);
3085
1a8212e8 3086 if (sc->hw_version_created)
169f15ab
RC		 3087 device_remove_file(&sc->hdev->dev, &dev_attr_hardware_version);
3088
46262047 3089 sony_cancel_work_sync(sc);
9f323b68 3090
d2d782fc 3091 sony_remove_dev_list(sc);
9f323b68 3092
8025087a
FP		 3093 sony_release_device_id(sc);
3094
cc6e0bbb 3095 hid_hw_stop(hdev);
cc6e0bbb
JK		 3096}
3097
decd946c
FP		 3098#ifdef CONFIG_PM
3099
3100static int sony_suspend(struct hid_device *hdev, pm_message_t message)
3101{
decd946c 3102#ifdef CONFIG_SONY_FF
decd946c 3103
765a1077
FP		 3104 /* On suspend stop any running force-feedback events */
3105 if (SONY_FF_SUPPORT) {
3106 struct sony_sc *sc = hid_get_drvdata(hdev);
decd946c 3107
765a1077 3108 sc->left = sc->right = 0;
decd946c
FP		 3109 sony_send_output_report(sc);
3110 }
3111
765a1077 3112#endif
decd946c
FP		 3113 return 0;
3114}
3115
3116static int sony_resume(struct hid_device *hdev)
3117{
765a1077 3118 struct sony_sc *sc = hid_get_drvdata(hdev);
decd946c 3119
765a1077
FP		 3120 /*
3121 * The Sixaxis and navigation controllers on USB need to be
3122 * reinitialized on resume or they won't behave properly.
3123 */
3124 if ((sc->quirks & SIXAXIS_CONTROLLER_USB) ||
3125 (sc->quirks & NAVIGATION_CONTROLLER_USB)) {
3126 sixaxis_set_operational_usb(sc->hdev);
3127 sc->defer_initialization = 1;
decd946c
FP		 3128 }
3129
3130 return 0;
3131}
3132
3133#endif
3134
bd28ce00 3135static const struct hid_device_id sony_devices[] = {
816651a7
AO		 3136 { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS3_CONTROLLER),
3137 .driver_data = SIXAXIS_CONTROLLER_USB },
35dca5b4 3138 { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_NAVIGATION_CONTROLLER),
4545ee0a 3139 .driver_data = NAVIGATION_CONTROLLER_USB },
6eabaaa0 3140 { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_NAVIGATION_CONTROLLER),
4545ee0a 3141 .driver_data = NAVIGATION_CONTROLLER_BT },
c5e0c1c4 3142 { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_MOTION_CONTROLLER),
b3bca326 3143 .driver_data = MOTION_CONTROLLER_USB },
a4afa854 3144 { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_MOTION_CONTROLLER),
b3bca326 3145 .driver_data = MOTION_CONTROLLER_BT },
816651a7
AO		 3146 { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS3_CONTROLLER),
3147 .driver_data = SIXAXIS_CONTROLLER_BT },
cc6e0bbb
JK		 3148 { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_VAIO_VGX_MOUSE),
3149 .driver_data = VAIO_RDESC_CONSTANT },
a4649184
FLVC		 3150 { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_VAIO_VGP_MOUSE),
3151 .driver_data = VAIO_RDESC_CONSTANT },
ef916ef5
AO		 3152 /*
3153 * Wired Buzz Controller. Reported as Sony Hub from its USB ID and as
3154 * Logitech joystick from the device descriptor.
3155 */
f04d5140
CL		 3156 { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_BUZZ_CONTROLLER),
3157 .driver_data = BUZZ_CONTROLLER },
3158 { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_WIRELESS_BUZZ_CONTROLLER),
3159 .driver_data = BUZZ_CONTROLLER },
078328da
JK		 3160 /* PS3 BD Remote Control */
3161 { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS3_BDREMOTE),
3162 .driver_data = PS3REMOTE },
3163 /* Logitech Harmony Adapter for PS3 */
3164 { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_HARMONY_PS3),
3165 .driver_data = PS3REMOTE },
68a49e51
FP		 3166 /* SMK-Link PS3 BD Remote Control */
3167 { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_SMK, USB_DEVICE_ID_SMK_PS3_BDREMOTE),
3168 .driver_data = PS3REMOTE },
0bd88dd3
FP		 3169 /* Sony Dualshock 4 controllers for PS4 */
3170 { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS4_CONTROLLER),
8ab1676b 3171 .driver_data = DUALSHOCK4_CONTROLLER_USB },
0bd88dd3 3172 { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS4_CONTROLLER),
8ab1676b 3173 .driver_data = DUALSHOCK4_CONTROLLER_BT },
cf1015d6
RC		 3174 { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS4_CONTROLLER_2),
3175 .driver_data = DUALSHOCK4_CONTROLLER_USB },
3176 { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS4_CONTROLLER_2),
3177 .driver_data = DUALSHOCK4_CONTROLLER_BT },
de66a1a0 3178 { HID_USB_DEVICE(USB_VENDOR_ID_SONY, USB_DEVICE_ID_SONY_PS4_CONTROLLER_DONGLE),
35f436c3 3179 .driver_data = DUALSHOCK4_DONGLE },
74500cc8
SM		 3180 /* Nyko Core Controller for PS3 */
3181 { HID_USB_DEVICE(USB_VENDOR_ID_SINO_LITE, USB_DEVICE_ID_SINO_LITE_CONTROLLER),
3182 .driver_data = SIXAXIS_CONTROLLER_USB | SINO_LITE_CONTROLLER },
b7289cb1
TK		 3183 /* SMK-Link NSG-MR5U Remote Control */
3184 { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_SMK, USB_DEVICE_ID_SMK_NSG_MR5U_REMOTE),
3185 .driver_data = NSG_MR5U_REMOTE_BT },
3186 /* SMK-Link NSG-MR7U Remote Control */
3187 { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_SMK, USB_DEVICE_ID_SMK_NSG_MR7U_REMOTE),
3188 .driver_data = NSG_MR7U_REMOTE_BT },
cc894ac5 3189 /* Guitar Hero Live PS3 and Wii U guitar dongles */
32e411d0
SG		 3190 { HID_USB_DEVICE(USB_VENDOR_ID_SONY_RHYTHM, USB_DEVICE_ID_SONY_PS3WIIU_GHLIVE_DONGLE),
3191 .driver_data = GHL_GUITAR_PS3WIIU | GH_GUITAR_CONTROLLER },
3192 /* Guitar Hero PC Guitar Dongle */
a4bfe13f 3193 { HID_USB_DEVICE(USB_VENDOR_ID_REDOCTANE, USB_DEVICE_ID_REDOCTANE_GUITAR_DONGLE),
32e411d0
SG		 3194 .driver_data = GH_GUITAR_CONTROLLER },
3195 /* Guitar Hero PS3 World Tour Guitar Dongle */
3196 { HID_USB_DEVICE(USB_VENDOR_ID_SONY_RHYTHM, USB_DEVICE_ID_SONY_PS3_GUITAR_DONGLE),
3197 .driver_data = GH_GUITAR_CONTROLLER },
a4bfe13f
DN		 3198 /* Guitar Hero Live PS4 guitar dongles */
3199 { HID_USB_DEVICE(USB_VENDOR_ID_REDOCTANE, USB_DEVICE_ID_REDOCTANE_PS4_GHLIVE_DONGLE),
3200 .driver_data = GHL_GUITAR_PS4 | GH_GUITAR_CONTROLLER },
bd28ce00
JS		 3201 { }
3202};
3203MODULE_DEVICE_TABLE(hid, sony_devices);
3204
3205static struct hid_driver sony_driver = {
ce8efc3b
FP		 3206 .name = "sony",
3207 .id_table = sony_devices,
3208 .input_mapping = sony_mapping,
3209 .input_configured = sony_input_configured,
3210 .probe = sony_probe,
3211 .remove = sony_remove,
3212 .report_fixup = sony_report_fixup,
decd946c
FP		 3213 .raw_event = sony_raw_event,
3214
3215#ifdef CONFIG_PM
3216 .suspend = sony_suspend,
3217 .resume = sony_resume,
3218 .reset_resume = sony_resume,
3219#endif
bd28ce00 3220};
8025087a
FP		 3221
3222static int __init sony_init(void)
3223{
3224 dbg_hid("Sony:%s\n", __func__);
3225
3226 return hid_register_driver(&sony_driver);
3227}
3228
3229static void __exit sony_exit(void)
3230{
3231 dbg_hid("Sony:%s\n", __func__);
3232
8025087a 3233 hid_unregister_driver(&sony_driver);
6c40065f 3234 ida_destroy(&sony_device_id_allocator);
8025087a
FP		 3235}
3236module_init(sony_init);
3237module_exit(sony_exit);
bd28ce00 3238
bd28ce00 3239MODULE_LICENSE("GPL");
Linux 6.x block layer and io_uring tree(s)