xref: /openbmc/linux/drivers/hid/hid-logitech-dj.c (revision 2c684d89)
1 /*
2  *  HID driver for Logitech Unifying receivers
3  *
4  *  Copyright (c) 2011 Logitech
5  */
6 
7 /*
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License version 2 as
10  * published by the Free Software Foundation.
11 
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  * GNU General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21  *
22  */
23 
24 
25 #include <linux/device.h>
26 #include <linux/hid.h>
27 #include <linux/module.h>
28 #include <linux/usb.h>
29 #include <linux/kfifo.h>
30 #include <asm/unaligned.h>
31 #include "hid-ids.h"
32 
33 #define DJ_MAX_PAIRED_DEVICES			6
34 #define DJ_MAX_NUMBER_NOTIFICATIONS		8
35 #define DJ_RECEIVER_INDEX			0
36 #define DJ_DEVICE_INDEX_MIN			1
37 #define DJ_DEVICE_INDEX_MAX			6
38 
39 #define DJREPORT_SHORT_LENGTH			15
40 #define DJREPORT_LONG_LENGTH			32
41 
42 #define REPORT_ID_DJ_SHORT			0x20
43 #define REPORT_ID_DJ_LONG			0x21
44 
45 #define REPORT_ID_HIDPP_SHORT			0x10
46 #define REPORT_ID_HIDPP_LONG			0x11
47 
48 #define HIDPP_REPORT_SHORT_LENGTH		7
49 #define HIDPP_REPORT_LONG_LENGTH		20
50 
51 #define HIDPP_RECEIVER_INDEX			0xff
52 
53 #define REPORT_TYPE_RFREPORT_FIRST		0x01
54 #define REPORT_TYPE_RFREPORT_LAST		0x1F
55 
56 /* Command Switch to DJ mode */
57 #define REPORT_TYPE_CMD_SWITCH			0x80
58 #define CMD_SWITCH_PARAM_DEVBITFIELD		0x00
59 #define CMD_SWITCH_PARAM_TIMEOUT_SECONDS	0x01
60 #define TIMEOUT_NO_KEEPALIVE			0x00
61 
62 /* Command to Get the list of Paired devices */
63 #define REPORT_TYPE_CMD_GET_PAIRED_DEVICES	0x81
64 
65 /* Device Paired Notification */
66 #define REPORT_TYPE_NOTIF_DEVICE_PAIRED		0x41
67 #define SPFUNCTION_MORE_NOTIF_EXPECTED		0x01
68 #define SPFUNCTION_DEVICE_LIST_EMPTY		0x02
69 #define DEVICE_PAIRED_PARAM_SPFUNCTION		0x00
70 #define DEVICE_PAIRED_PARAM_EQUAD_ID_LSB	0x01
71 #define DEVICE_PAIRED_PARAM_EQUAD_ID_MSB	0x02
72 #define DEVICE_PAIRED_RF_REPORT_TYPE		0x03
73 
74 /* Device Un-Paired Notification */
75 #define REPORT_TYPE_NOTIF_DEVICE_UNPAIRED	0x40
76 
77 
78 /* Connection Status Notification */
79 #define REPORT_TYPE_NOTIF_CONNECTION_STATUS	0x42
80 #define CONNECTION_STATUS_PARAM_STATUS		0x00
81 #define STATUS_LINKLOSS				0x01
82 
83 /* Error Notification */
84 #define REPORT_TYPE_NOTIF_ERROR			0x7F
85 #define NOTIF_ERROR_PARAM_ETYPE			0x00
86 #define ETYPE_KEEPALIVE_TIMEOUT			0x01
87 
88 /* supported DJ HID && RF report types */
89 #define REPORT_TYPE_KEYBOARD			0x01
90 #define REPORT_TYPE_MOUSE			0x02
91 #define REPORT_TYPE_CONSUMER_CONTROL		0x03
92 #define REPORT_TYPE_SYSTEM_CONTROL		0x04
93 #define REPORT_TYPE_MEDIA_CENTER		0x08
94 #define REPORT_TYPE_LEDS			0x0E
95 
96 /* RF Report types bitfield */
97 #define STD_KEYBOARD				0x00000002
98 #define STD_MOUSE				0x00000004
99 #define MULTIMEDIA				0x00000008
100 #define POWER_KEYS				0x00000010
101 #define MEDIA_CENTER				0x00000100
102 #define KBD_LEDS				0x00004000
103 
104 struct dj_report {
105 	u8 report_id;
106 	u8 device_index;
107 	u8 report_type;
108 	u8 report_params[DJREPORT_SHORT_LENGTH - 3];
109 };
110 
111 struct dj_receiver_dev {
112 	struct hid_device *hdev;
113 	struct dj_device *paired_dj_devices[DJ_MAX_PAIRED_DEVICES +
114 					    DJ_DEVICE_INDEX_MIN];
115 	struct work_struct work;
116 	struct kfifo notif_fifo;
117 	spinlock_t lock;
118 	bool querying_devices;
119 };
120 
121 struct dj_device {
122 	struct hid_device *hdev;
123 	struct dj_receiver_dev *dj_receiver_dev;
124 	u32 reports_supported;
125 	u8 device_index;
126 };
127 
128 /* Keyboard descriptor (1) */
129 static const char kbd_descriptor[] = {
130 	0x05, 0x01,		/* USAGE_PAGE (generic Desktop)     */
131 	0x09, 0x06,		/* USAGE (Keyboard)         */
132 	0xA1, 0x01,		/* COLLECTION (Application)     */
133 	0x85, 0x01,		/* REPORT_ID (1)            */
134 	0x95, 0x08,		/*   REPORT_COUNT (8)           */
135 	0x75, 0x01,		/*   REPORT_SIZE (1)            */
136 	0x15, 0x00,		/*   LOGICAL_MINIMUM (0)        */
137 	0x25, 0x01,		/*   LOGICAL_MAXIMUM (1)        */
138 	0x05, 0x07,		/*   USAGE_PAGE (Keyboard)      */
139 	0x19, 0xE0,		/*   USAGE_MINIMUM (Left Control)   */
140 	0x29, 0xE7,		/*   USAGE_MAXIMUM (Right GUI)      */
141 	0x81, 0x02,		/*   INPUT (Data,Var,Abs)       */
142 	0x95, 0x06,		/*   REPORT_COUNT (6)           */
143 	0x75, 0x08,		/*   REPORT_SIZE (8)            */
144 	0x15, 0x00,		/*   LOGICAL_MINIMUM (0)        */
145 	0x26, 0xFF, 0x00,	/*   LOGICAL_MAXIMUM (255)      */
146 	0x05, 0x07,		/*   USAGE_PAGE (Keyboard)      */
147 	0x19, 0x00,		/*   USAGE_MINIMUM (no event)       */
148 	0x2A, 0xFF, 0x00,	/*   USAGE_MAXIMUM (reserved)       */
149 	0x81, 0x00,		/*   INPUT (Data,Ary,Abs)       */
150 	0x85, 0x0e,		/* REPORT_ID (14)               */
151 	0x05, 0x08,		/*   USAGE PAGE (LED page)      */
152 	0x95, 0x05,		/*   REPORT COUNT (5)           */
153 	0x75, 0x01,		/*   REPORT SIZE (1)            */
154 	0x15, 0x00,		/*   LOGICAL_MINIMUM (0)        */
155 	0x25, 0x01,		/*   LOGICAL_MAXIMUM (1)        */
156 	0x19, 0x01,		/*   USAGE MINIMUM (1)          */
157 	0x29, 0x05,		/*   USAGE MAXIMUM (5)          */
158 	0x91, 0x02,		/*   OUTPUT (Data, Variable, Absolute)  */
159 	0x95, 0x01,		/*   REPORT COUNT (1)           */
160 	0x75, 0x03,		/*   REPORT SIZE (3)            */
161 	0x91, 0x01,		/*   OUTPUT (Constant)          */
162 	0xC0
163 };
164 
165 /* Mouse descriptor (2)     */
166 static const char mse_descriptor[] = {
167 	0x05, 0x01,		/*  USAGE_PAGE (Generic Desktop)        */
168 	0x09, 0x02,		/*  USAGE (Mouse)                       */
169 	0xA1, 0x01,		/*  COLLECTION (Application)            */
170 	0x85, 0x02,		/*    REPORT_ID = 2                     */
171 	0x09, 0x01,		/*    USAGE (pointer)                   */
172 	0xA1, 0x00,		/*    COLLECTION (physical)             */
173 	0x05, 0x09,		/*      USAGE_PAGE (buttons)            */
174 	0x19, 0x01,		/*      USAGE_MIN (1)                   */
175 	0x29, 0x10,		/*      USAGE_MAX (16)                  */
176 	0x15, 0x00,		/*      LOGICAL_MIN (0)                 */
177 	0x25, 0x01,		/*      LOGICAL_MAX (1)                 */
178 	0x95, 0x10,		/*      REPORT_COUNT (16)               */
179 	0x75, 0x01,		/*      REPORT_SIZE (1)                 */
180 	0x81, 0x02,		/*      INPUT (data var abs)            */
181 	0x05, 0x01,		/*      USAGE_PAGE (generic desktop)    */
182 	0x16, 0x01, 0xF8,	/*      LOGICAL_MIN (-2047)             */
183 	0x26, 0xFF, 0x07,	/*      LOGICAL_MAX (2047)              */
184 	0x75, 0x0C,		/*      REPORT_SIZE (12)                */
185 	0x95, 0x02,		/*      REPORT_COUNT (2)                */
186 	0x09, 0x30,		/*      USAGE (X)                       */
187 	0x09, 0x31,		/*      USAGE (Y)                       */
188 	0x81, 0x06,		/*      INPUT                           */
189 	0x15, 0x81,		/*      LOGICAL_MIN (-127)              */
190 	0x25, 0x7F,		/*      LOGICAL_MAX (127)               */
191 	0x75, 0x08,		/*      REPORT_SIZE (8)                 */
192 	0x95, 0x01,		/*      REPORT_COUNT (1)                */
193 	0x09, 0x38,		/*      USAGE (wheel)                   */
194 	0x81, 0x06,		/*      INPUT                           */
195 	0x05, 0x0C,		/*      USAGE_PAGE(consumer)            */
196 	0x0A, 0x38, 0x02,	/*      USAGE(AC Pan)                   */
197 	0x95, 0x01,		/*      REPORT_COUNT (1)                */
198 	0x81, 0x06,		/*      INPUT                           */
199 	0xC0,			/*    END_COLLECTION                    */
200 	0xC0,			/*  END_COLLECTION                      */
201 };
202 
203 /* Consumer Control descriptor (3) */
204 static const char consumer_descriptor[] = {
205 	0x05, 0x0C,		/* USAGE_PAGE (Consumer Devices)       */
206 	0x09, 0x01,		/* USAGE (Consumer Control)            */
207 	0xA1, 0x01,		/* COLLECTION (Application)            */
208 	0x85, 0x03,		/* REPORT_ID = 3                       */
209 	0x75, 0x10,		/* REPORT_SIZE (16)                    */
210 	0x95, 0x02,		/* REPORT_COUNT (2)                    */
211 	0x15, 0x01,		/* LOGICAL_MIN (1)                     */
212 	0x26, 0x8C, 0x02,	/* LOGICAL_MAX (652)                   */
213 	0x19, 0x01,		/* USAGE_MIN (1)                       */
214 	0x2A, 0x8C, 0x02,	/* USAGE_MAX (652)                     */
215 	0x81, 0x00,		/* INPUT (Data Ary Abs)                */
216 	0xC0,			/* END_COLLECTION                      */
217 };				/*                                     */
218 
219 /* System control descriptor (4) */
220 static const char syscontrol_descriptor[] = {
221 	0x05, 0x01,		/*   USAGE_PAGE (Generic Desktop)      */
222 	0x09, 0x80,		/*   USAGE (System Control)            */
223 	0xA1, 0x01,		/*   COLLECTION (Application)          */
224 	0x85, 0x04,		/*   REPORT_ID = 4                     */
225 	0x75, 0x02,		/*   REPORT_SIZE (2)                   */
226 	0x95, 0x01,		/*   REPORT_COUNT (1)                  */
227 	0x15, 0x01,		/*   LOGICAL_MIN (1)                   */
228 	0x25, 0x03,		/*   LOGICAL_MAX (3)                   */
229 	0x09, 0x82,		/*   USAGE (System Sleep)              */
230 	0x09, 0x81,		/*   USAGE (System Power Down)         */
231 	0x09, 0x83,		/*   USAGE (System Wake Up)            */
232 	0x81, 0x60,		/*   INPUT (Data Ary Abs NPrf Null)    */
233 	0x75, 0x06,		/*   REPORT_SIZE (6)                   */
234 	0x81, 0x03,		/*   INPUT (Cnst Var Abs)              */
235 	0xC0,			/*   END_COLLECTION                    */
236 };
237 
238 /* Media descriptor (8) */
239 static const char media_descriptor[] = {
240 	0x06, 0xbc, 0xff,	/* Usage Page 0xffbc                   */
241 	0x09, 0x88,		/* Usage 0x0088                        */
242 	0xa1, 0x01,		/* BeginCollection                     */
243 	0x85, 0x08,		/*   Report ID 8                       */
244 	0x19, 0x01,		/*   Usage Min 0x0001                  */
245 	0x29, 0xff,		/*   Usage Max 0x00ff                  */
246 	0x15, 0x01,		/*   Logical Min 1                     */
247 	0x26, 0xff, 0x00,	/*   Logical Max 255                   */
248 	0x75, 0x08,		/*   Report Size 8                     */
249 	0x95, 0x01,		/*   Report Count 1                    */
250 	0x81, 0x00,		/*   Input                             */
251 	0xc0,			/* EndCollection                       */
252 };				/*                                     */
253 
254 /* HIDPP descriptor */
255 static const char hidpp_descriptor[] = {
256 	0x06, 0x00, 0xff,	/* Usage Page (Vendor Defined Page 1)  */
257 	0x09, 0x01,		/* Usage (Vendor Usage 1)              */
258 	0xa1, 0x01,		/* Collection (Application)            */
259 	0x85, 0x10,		/*   Report ID (16)                    */
260 	0x75, 0x08,		/*   Report Size (8)                   */
261 	0x95, 0x06,		/*   Report Count (6)                  */
262 	0x15, 0x00,		/*   Logical Minimum (0)               */
263 	0x26, 0xff, 0x00,	/*   Logical Maximum (255)             */
264 	0x09, 0x01,		/*   Usage (Vendor Usage 1)            */
265 	0x81, 0x00,		/*   Input (Data,Arr,Abs)              */
266 	0x09, 0x01,		/*   Usage (Vendor Usage 1)            */
267 	0x91, 0x00,		/*   Output (Data,Arr,Abs)             */
268 	0xc0,			/* End Collection                      */
269 	0x06, 0x00, 0xff,	/* Usage Page (Vendor Defined Page 1)  */
270 	0x09, 0x02,		/* Usage (Vendor Usage 2)              */
271 	0xa1, 0x01,		/* Collection (Application)            */
272 	0x85, 0x11,		/*   Report ID (17)                    */
273 	0x75, 0x08,		/*   Report Size (8)                   */
274 	0x95, 0x13,		/*   Report Count (19)                 */
275 	0x15, 0x00,		/*   Logical Minimum (0)               */
276 	0x26, 0xff, 0x00,	/*   Logical Maximum (255)             */
277 	0x09, 0x02,		/*   Usage (Vendor Usage 2)            */
278 	0x81, 0x00,		/*   Input (Data,Arr,Abs)              */
279 	0x09, 0x02,		/*   Usage (Vendor Usage 2)            */
280 	0x91, 0x00,		/*   Output (Data,Arr,Abs)             */
281 	0xc0,			/* End Collection                      */
282 	0x06, 0x00, 0xff,	/* Usage Page (Vendor Defined Page 1)  */
283 	0x09, 0x04,		/* Usage (Vendor Usage 0x04)           */
284 	0xa1, 0x01,		/* Collection (Application)            */
285 	0x85, 0x20,		/*   Report ID (32)                    */
286 	0x75, 0x08,		/*   Report Size (8)                   */
287 	0x95, 0x0e,		/*   Report Count (14)                 */
288 	0x15, 0x00,		/*   Logical Minimum (0)               */
289 	0x26, 0xff, 0x00,	/*   Logical Maximum (255)             */
290 	0x09, 0x41,		/*   Usage (Vendor Usage 0x41)         */
291 	0x81, 0x00,		/*   Input (Data,Arr,Abs)              */
292 	0x09, 0x41,		/*   Usage (Vendor Usage 0x41)         */
293 	0x91, 0x00,		/*   Output (Data,Arr,Abs)             */
294 	0x85, 0x21,		/*   Report ID (33)                    */
295 	0x95, 0x1f,		/*   Report Count (31)                 */
296 	0x15, 0x00,		/*   Logical Minimum (0)               */
297 	0x26, 0xff, 0x00,	/*   Logical Maximum (255)             */
298 	0x09, 0x42,		/*   Usage (Vendor Usage 0x42)         */
299 	0x81, 0x00,		/*   Input (Data,Arr,Abs)              */
300 	0x09, 0x42,		/*   Usage (Vendor Usage 0x42)         */
301 	0x91, 0x00,		/*   Output (Data,Arr,Abs)             */
302 	0xc0,			/* End Collection                      */
303 };
304 
305 /* Maximum size of all defined hid reports in bytes (including report id) */
306 #define MAX_REPORT_SIZE 8
307 
308 /* Make sure all descriptors are present here */
309 #define MAX_RDESC_SIZE				\
310 	(sizeof(kbd_descriptor) +		\
311 	 sizeof(mse_descriptor) +		\
312 	 sizeof(consumer_descriptor) +		\
313 	 sizeof(syscontrol_descriptor) +	\
314 	 sizeof(media_descriptor) +	\
315 	 sizeof(hidpp_descriptor))
316 
317 /* Number of possible hid report types that can be created by this driver.
318  *
319  * Right now, RF report types have the same report types (or report id's)
320  * than the hid report created from those RF reports. In the future
321  * this doesnt have to be true.
322  *
323  * For instance, RF report type 0x01 which has a size of 8 bytes, corresponds
324  * to hid report id 0x01, this is standard keyboard. Same thing applies to mice
325  * reports and consumer control, etc. If a new RF report is created, it doesn't
326  * has to have the same report id as its corresponding hid report, so an
327  * translation may have to take place for future report types.
328  */
329 #define NUMBER_OF_HID_REPORTS 32
330 static const u8 hid_reportid_size_map[NUMBER_OF_HID_REPORTS] = {
331 	[1] = 8,		/* Standard keyboard */
332 	[2] = 8,		/* Standard mouse */
333 	[3] = 5,		/* Consumer control */
334 	[4] = 2,		/* System control */
335 	[8] = 2,		/* Media Center */
336 };
337 
338 
339 #define LOGITECH_DJ_INTERFACE_NUMBER 0x02
340 
341 static struct hid_ll_driver logi_dj_ll_driver;
342 
343 static int logi_dj_recv_query_paired_devices(struct dj_receiver_dev *djrcv_dev);
344 
345 static void logi_dj_recv_destroy_djhid_device(struct dj_receiver_dev *djrcv_dev,
346 						struct dj_report *dj_report)
347 {
348 	/* Called in delayed work context */
349 	struct dj_device *dj_dev;
350 	unsigned long flags;
351 
352 	spin_lock_irqsave(&djrcv_dev->lock, flags);
353 	dj_dev = djrcv_dev->paired_dj_devices[dj_report->device_index];
354 	djrcv_dev->paired_dj_devices[dj_report->device_index] = NULL;
355 	spin_unlock_irqrestore(&djrcv_dev->lock, flags);
356 
357 	if (dj_dev != NULL) {
358 		hid_destroy_device(dj_dev->hdev);
359 		kfree(dj_dev);
360 	} else {
361 		dev_err(&djrcv_dev->hdev->dev, "%s: can't destroy a NULL device\n",
362 			__func__);
363 	}
364 }
365 
366 static void logi_dj_recv_add_djhid_device(struct dj_receiver_dev *djrcv_dev,
367 					  struct dj_report *dj_report)
368 {
369 	/* Called in delayed work context */
370 	struct hid_device *djrcv_hdev = djrcv_dev->hdev;
371 	struct usb_interface *intf = to_usb_interface(djrcv_hdev->dev.parent);
372 	struct usb_device *usbdev = interface_to_usbdev(intf);
373 	struct hid_device *dj_hiddev;
374 	struct dj_device *dj_dev;
375 
376 	/* Device index goes from 1 to 6, we need 3 bytes to store the
377 	 * semicolon, the index, and a null terminator
378 	 */
379 	unsigned char tmpstr[3];
380 
381 	if (dj_report->report_params[DEVICE_PAIRED_PARAM_SPFUNCTION] &
382 	    SPFUNCTION_DEVICE_LIST_EMPTY) {
383 		dbg_hid("%s: device list is empty\n", __func__);
384 		djrcv_dev->querying_devices = false;
385 		return;
386 	}
387 
388 	if (djrcv_dev->paired_dj_devices[dj_report->device_index]) {
389 		/* The device is already known. No need to reallocate it. */
390 		dbg_hid("%s: device is already known\n", __func__);
391 		return;
392 	}
393 
394 	dj_hiddev = hid_allocate_device();
395 	if (IS_ERR(dj_hiddev)) {
396 		dev_err(&djrcv_hdev->dev, "%s: hid_allocate_device failed\n",
397 			__func__);
398 		return;
399 	}
400 
401 	dj_hiddev->ll_driver = &logi_dj_ll_driver;
402 
403 	dj_hiddev->dev.parent = &djrcv_hdev->dev;
404 	dj_hiddev->bus = BUS_USB;
405 	dj_hiddev->vendor = le16_to_cpu(usbdev->descriptor.idVendor);
406 	dj_hiddev->product =
407 		(dj_report->report_params[DEVICE_PAIRED_PARAM_EQUAD_ID_MSB]
408 									<< 8) |
409 		dj_report->report_params[DEVICE_PAIRED_PARAM_EQUAD_ID_LSB];
410 	snprintf(dj_hiddev->name, sizeof(dj_hiddev->name),
411 		"Logitech Unifying Device. Wireless PID:%04x",
412 		dj_hiddev->product);
413 
414 	dj_hiddev->group = HID_GROUP_LOGITECH_DJ_DEVICE;
415 
416 	usb_make_path(usbdev, dj_hiddev->phys, sizeof(dj_hiddev->phys));
417 	snprintf(tmpstr, sizeof(tmpstr), ":%d", dj_report->device_index);
418 	strlcat(dj_hiddev->phys, tmpstr, sizeof(dj_hiddev->phys));
419 
420 	dj_dev = kzalloc(sizeof(struct dj_device), GFP_KERNEL);
421 
422 	if (!dj_dev) {
423 		dev_err(&djrcv_hdev->dev, "%s: failed allocating dj_device\n",
424 			__func__);
425 		goto dj_device_allocate_fail;
426 	}
427 
428 	dj_dev->reports_supported = get_unaligned_le32(
429 		dj_report->report_params + DEVICE_PAIRED_RF_REPORT_TYPE);
430 	dj_dev->hdev = dj_hiddev;
431 	dj_dev->dj_receiver_dev = djrcv_dev;
432 	dj_dev->device_index = dj_report->device_index;
433 	dj_hiddev->driver_data = dj_dev;
434 
435 	djrcv_dev->paired_dj_devices[dj_report->device_index] = dj_dev;
436 
437 	if (hid_add_device(dj_hiddev)) {
438 		dev_err(&djrcv_hdev->dev, "%s: failed adding dj_device\n",
439 			__func__);
440 		goto hid_add_device_fail;
441 	}
442 
443 	return;
444 
445 hid_add_device_fail:
446 	djrcv_dev->paired_dj_devices[dj_report->device_index] = NULL;
447 	kfree(dj_dev);
448 dj_device_allocate_fail:
449 	hid_destroy_device(dj_hiddev);
450 }
451 
452 static void delayedwork_callback(struct work_struct *work)
453 {
454 	struct dj_receiver_dev *djrcv_dev =
455 		container_of(work, struct dj_receiver_dev, work);
456 
457 	struct dj_report dj_report;
458 	unsigned long flags;
459 	int count;
460 	int retval;
461 
462 	dbg_hid("%s\n", __func__);
463 
464 	spin_lock_irqsave(&djrcv_dev->lock, flags);
465 
466 	count = kfifo_out(&djrcv_dev->notif_fifo, &dj_report,
467 				sizeof(struct dj_report));
468 
469 	if (count != sizeof(struct dj_report)) {
470 		dev_err(&djrcv_dev->hdev->dev, "%s: workitem triggered without "
471 			"notifications available\n", __func__);
472 		spin_unlock_irqrestore(&djrcv_dev->lock, flags);
473 		return;
474 	}
475 
476 	if (!kfifo_is_empty(&djrcv_dev->notif_fifo)) {
477 		if (schedule_work(&djrcv_dev->work) == 0) {
478 			dbg_hid("%s: did not schedule the work item, was "
479 				"already queued\n", __func__);
480 		}
481 	}
482 
483 	spin_unlock_irqrestore(&djrcv_dev->lock, flags);
484 
485 	switch (dj_report.report_type) {
486 	case REPORT_TYPE_NOTIF_DEVICE_PAIRED:
487 		logi_dj_recv_add_djhid_device(djrcv_dev, &dj_report);
488 		break;
489 	case REPORT_TYPE_NOTIF_DEVICE_UNPAIRED:
490 		logi_dj_recv_destroy_djhid_device(djrcv_dev, &dj_report);
491 		break;
492 	default:
493 	/* A normal report (i. e. not belonging to a pair/unpair notification)
494 	 * arriving here, means that the report arrived but we did not have a
495 	 * paired dj_device associated to the report's device_index, this
496 	 * means that the original "device paired" notification corresponding
497 	 * to this dj_device never arrived to this driver. The reason is that
498 	 * hid-core discards all packets coming from a device while probe() is
499 	 * executing. */
500 	if (!djrcv_dev->paired_dj_devices[dj_report.device_index]) {
501 		/* ok, we don't know the device, just re-ask the
502 		 * receiver for the list of connected devices. */
503 		retval = logi_dj_recv_query_paired_devices(djrcv_dev);
504 		if (!retval) {
505 			/* everything went fine, so just leave */
506 			break;
507 		}
508 		dev_err(&djrcv_dev->hdev->dev,
509 			"%s:logi_dj_recv_query_paired_devices "
510 			"error:%d\n", __func__, retval);
511 		}
512 		dbg_hid("%s: unexpected report type\n", __func__);
513 	}
514 }
515 
516 static void logi_dj_recv_queue_notification(struct dj_receiver_dev *djrcv_dev,
517 					   struct dj_report *dj_report)
518 {
519 	/* We are called from atomic context (tasklet && djrcv->lock held) */
520 
521 	kfifo_in(&djrcv_dev->notif_fifo, dj_report, sizeof(struct dj_report));
522 
523 	if (schedule_work(&djrcv_dev->work) == 0) {
524 		dbg_hid("%s: did not schedule the work item, was already "
525 			"queued\n", __func__);
526 	}
527 }
528 
529 static void logi_dj_recv_forward_null_report(struct dj_receiver_dev *djrcv_dev,
530 					     struct dj_report *dj_report)
531 {
532 	/* We are called from atomic context (tasklet && djrcv->lock held) */
533 	unsigned int i;
534 	u8 reportbuffer[MAX_REPORT_SIZE];
535 	struct dj_device *djdev;
536 
537 	djdev = djrcv_dev->paired_dj_devices[dj_report->device_index];
538 
539 	memset(reportbuffer, 0, sizeof(reportbuffer));
540 
541 	for (i = 0; i < NUMBER_OF_HID_REPORTS; i++) {
542 		if (djdev->reports_supported & (1 << i)) {
543 			reportbuffer[0] = i;
544 			if (hid_input_report(djdev->hdev,
545 					     HID_INPUT_REPORT,
546 					     reportbuffer,
547 					     hid_reportid_size_map[i], 1)) {
548 				dbg_hid("hid_input_report error sending null "
549 					"report\n");
550 			}
551 		}
552 	}
553 }
554 
555 static void logi_dj_recv_forward_report(struct dj_receiver_dev *djrcv_dev,
556 					struct dj_report *dj_report)
557 {
558 	/* We are called from atomic context (tasklet && djrcv->lock held) */
559 	struct dj_device *dj_device;
560 
561 	dj_device = djrcv_dev->paired_dj_devices[dj_report->device_index];
562 
563 	if ((dj_report->report_type > ARRAY_SIZE(hid_reportid_size_map) - 1) ||
564 	    (hid_reportid_size_map[dj_report->report_type] == 0)) {
565 		dbg_hid("invalid report type:%x\n", dj_report->report_type);
566 		return;
567 	}
568 
569 	if (hid_input_report(dj_device->hdev,
570 			HID_INPUT_REPORT, &dj_report->report_type,
571 			hid_reportid_size_map[dj_report->report_type], 1)) {
572 		dbg_hid("hid_input_report error\n");
573 	}
574 }
575 
576 static void logi_dj_recv_forward_hidpp(struct dj_device *dj_dev, u8 *data,
577 				       int size)
578 {
579 	/* We are called from atomic context (tasklet && djrcv->lock held) */
580 	if (hid_input_report(dj_dev->hdev, HID_INPUT_REPORT, data, size, 1))
581 		dbg_hid("hid_input_report error\n");
582 }
583 
584 static int logi_dj_recv_send_report(struct dj_receiver_dev *djrcv_dev,
585 				    struct dj_report *dj_report)
586 {
587 	struct hid_device *hdev = djrcv_dev->hdev;
588 	struct hid_report *report;
589 	struct hid_report_enum *output_report_enum;
590 	u8 *data = (u8 *)(&dj_report->device_index);
591 	unsigned int i;
592 
593 	output_report_enum = &hdev->report_enum[HID_OUTPUT_REPORT];
594 	report = output_report_enum->report_id_hash[REPORT_ID_DJ_SHORT];
595 
596 	if (!report) {
597 		dev_err(&hdev->dev, "%s: unable to find dj report\n", __func__);
598 		return -ENODEV;
599 	}
600 
601 	for (i = 0; i < DJREPORT_SHORT_LENGTH - 1; i++)
602 		report->field[0]->value[i] = data[i];
603 
604 	hid_hw_request(hdev, report, HID_REQ_SET_REPORT);
605 
606 	return 0;
607 }
608 
609 static int logi_dj_recv_query_paired_devices(struct dj_receiver_dev *djrcv_dev)
610 {
611 	struct dj_report *dj_report;
612 	int retval;
613 
614 	/* no need to protect djrcv_dev->querying_devices */
615 	if (djrcv_dev->querying_devices)
616 		return 0;
617 
618 	dj_report = kzalloc(sizeof(struct dj_report), GFP_KERNEL);
619 	if (!dj_report)
620 		return -ENOMEM;
621 	dj_report->report_id = REPORT_ID_DJ_SHORT;
622 	dj_report->device_index = 0xFF;
623 	dj_report->report_type = REPORT_TYPE_CMD_GET_PAIRED_DEVICES;
624 	retval = logi_dj_recv_send_report(djrcv_dev, dj_report);
625 	kfree(dj_report);
626 	return retval;
627 }
628 
629 
630 static int logi_dj_recv_switch_to_dj_mode(struct dj_receiver_dev *djrcv_dev,
631 					  unsigned timeout)
632 {
633 	struct hid_device *hdev = djrcv_dev->hdev;
634 	struct dj_report *dj_report;
635 	u8 *buf;
636 	int retval;
637 
638 	dj_report = kzalloc(sizeof(struct dj_report), GFP_KERNEL);
639 	if (!dj_report)
640 		return -ENOMEM;
641 	dj_report->report_id = REPORT_ID_DJ_SHORT;
642 	dj_report->device_index = 0xFF;
643 	dj_report->report_type = REPORT_TYPE_CMD_SWITCH;
644 	dj_report->report_params[CMD_SWITCH_PARAM_DEVBITFIELD] = 0x3F;
645 	dj_report->report_params[CMD_SWITCH_PARAM_TIMEOUT_SECONDS] = (u8)timeout;
646 	retval = logi_dj_recv_send_report(djrcv_dev, dj_report);
647 
648 	/*
649 	 * Ugly sleep to work around a USB 3.0 bug when the receiver is still
650 	 * processing the "switch-to-dj" command while we send an other command.
651 	 * 50 msec should gives enough time to the receiver to be ready.
652 	 */
653 	msleep(50);
654 
655 	/*
656 	 * Magical bits to set up hidpp notifications when the dj devices
657 	 * are connected/disconnected.
658 	 *
659 	 * We can reuse dj_report because HIDPP_REPORT_SHORT_LENGTH is smaller
660 	 * than DJREPORT_SHORT_LENGTH.
661 	 */
662 	buf = (u8 *)dj_report;
663 
664 	memset(buf, 0, HIDPP_REPORT_SHORT_LENGTH);
665 
666 	buf[0] = REPORT_ID_HIDPP_SHORT;
667 	buf[1] = 0xFF;
668 	buf[2] = 0x80;
669 	buf[3] = 0x00;
670 	buf[4] = 0x00;
671 	buf[5] = 0x09;
672 	buf[6] = 0x00;
673 
674 	hid_hw_raw_request(hdev, REPORT_ID_HIDPP_SHORT, buf,
675 			HIDPP_REPORT_SHORT_LENGTH, HID_OUTPUT_REPORT,
676 			HID_REQ_SET_REPORT);
677 
678 	kfree(dj_report);
679 	return retval;
680 }
681 
682 
683 static int logi_dj_ll_open(struct hid_device *hid)
684 {
685 	dbg_hid("%s:%s\n", __func__, hid->phys);
686 	return 0;
687 
688 }
689 
690 static void logi_dj_ll_close(struct hid_device *hid)
691 {
692 	dbg_hid("%s:%s\n", __func__, hid->phys);
693 }
694 
695 static u8 unifying_name_query[]  = {0x10, 0xff, 0x83, 0xb5, 0x40, 0x00, 0x00};
696 static u8 unifying_name_answer[] = {0x11, 0xff, 0x83, 0xb5};
697 
698 static int logi_dj_ll_raw_request(struct hid_device *hid,
699 				  unsigned char reportnum, __u8 *buf,
700 				  size_t count, unsigned char report_type,
701 				  int reqtype)
702 {
703 	struct dj_device *djdev = hid->driver_data;
704 	struct dj_receiver_dev *djrcv_dev = djdev->dj_receiver_dev;
705 	u8 *out_buf;
706 	int ret;
707 
708 	if ((buf[0] == REPORT_ID_HIDPP_SHORT) ||
709 	    (buf[0] == REPORT_ID_HIDPP_LONG)) {
710 		if (count < 2)
711 			return -EINVAL;
712 
713 		/* special case where we should not overwrite
714 		 * the device_index */
715 		if (count == 7 && !memcmp(buf, unifying_name_query,
716 					  sizeof(unifying_name_query)))
717 			buf[4] |= djdev->device_index - 1;
718 		else
719 			buf[1] = djdev->device_index;
720 		return hid_hw_raw_request(djrcv_dev->hdev, reportnum, buf,
721 				count, report_type, reqtype);
722 	}
723 
724 	if (buf[0] != REPORT_TYPE_LEDS)
725 		return -EINVAL;
726 
727 	out_buf = kzalloc(DJREPORT_SHORT_LENGTH, GFP_ATOMIC);
728 	if (!out_buf)
729 		return -ENOMEM;
730 
731 	if (count > DJREPORT_SHORT_LENGTH - 2)
732 		count = DJREPORT_SHORT_LENGTH - 2;
733 
734 	out_buf[0] = REPORT_ID_DJ_SHORT;
735 	out_buf[1] = djdev->device_index;
736 	memcpy(out_buf + 2, buf, count);
737 
738 	ret = hid_hw_raw_request(djrcv_dev->hdev, out_buf[0], out_buf,
739 		DJREPORT_SHORT_LENGTH, report_type, reqtype);
740 
741 	kfree(out_buf);
742 	return ret;
743 }
744 
745 static void rdcat(char *rdesc, unsigned int *rsize, const char *data, unsigned int size)
746 {
747 	memcpy(rdesc + *rsize, data, size);
748 	*rsize += size;
749 }
750 
751 static int logi_dj_ll_parse(struct hid_device *hid)
752 {
753 	struct dj_device *djdev = hid->driver_data;
754 	unsigned int rsize = 0;
755 	char *rdesc;
756 	int retval;
757 
758 	dbg_hid("%s\n", __func__);
759 
760 	djdev->hdev->version = 0x0111;
761 	djdev->hdev->country = 0x00;
762 
763 	rdesc = kmalloc(MAX_RDESC_SIZE, GFP_KERNEL);
764 	if (!rdesc)
765 		return -ENOMEM;
766 
767 	if (djdev->reports_supported & STD_KEYBOARD) {
768 		dbg_hid("%s: sending a kbd descriptor, reports_supported: %x\n",
769 			__func__, djdev->reports_supported);
770 		rdcat(rdesc, &rsize, kbd_descriptor, sizeof(kbd_descriptor));
771 	}
772 
773 	if (djdev->reports_supported & STD_MOUSE) {
774 		dbg_hid("%s: sending a mouse descriptor, reports_supported: "
775 			"%x\n", __func__, djdev->reports_supported);
776 		rdcat(rdesc, &rsize, mse_descriptor, sizeof(mse_descriptor));
777 	}
778 
779 	if (djdev->reports_supported & MULTIMEDIA) {
780 		dbg_hid("%s: sending a multimedia report descriptor: %x\n",
781 			__func__, djdev->reports_supported);
782 		rdcat(rdesc, &rsize, consumer_descriptor, sizeof(consumer_descriptor));
783 	}
784 
785 	if (djdev->reports_supported & POWER_KEYS) {
786 		dbg_hid("%s: sending a power keys report descriptor: %x\n",
787 			__func__, djdev->reports_supported);
788 		rdcat(rdesc, &rsize, syscontrol_descriptor, sizeof(syscontrol_descriptor));
789 	}
790 
791 	if (djdev->reports_supported & MEDIA_CENTER) {
792 		dbg_hid("%s: sending a media center report descriptor: %x\n",
793 			__func__, djdev->reports_supported);
794 		rdcat(rdesc, &rsize, media_descriptor, sizeof(media_descriptor));
795 	}
796 
797 	if (djdev->reports_supported & KBD_LEDS) {
798 		dbg_hid("%s: need to send kbd leds report descriptor: %x\n",
799 			__func__, djdev->reports_supported);
800 	}
801 
802 	rdcat(rdesc, &rsize, hidpp_descriptor, sizeof(hidpp_descriptor));
803 
804 	retval = hid_parse_report(hid, rdesc, rsize);
805 	kfree(rdesc);
806 
807 	return retval;
808 }
809 
810 static int logi_dj_ll_start(struct hid_device *hid)
811 {
812 	dbg_hid("%s\n", __func__);
813 	return 0;
814 }
815 
816 static void logi_dj_ll_stop(struct hid_device *hid)
817 {
818 	dbg_hid("%s\n", __func__);
819 }
820 
821 
822 static struct hid_ll_driver logi_dj_ll_driver = {
823 	.parse = logi_dj_ll_parse,
824 	.start = logi_dj_ll_start,
825 	.stop = logi_dj_ll_stop,
826 	.open = logi_dj_ll_open,
827 	.close = logi_dj_ll_close,
828 	.raw_request = logi_dj_ll_raw_request,
829 };
830 
831 static int logi_dj_dj_event(struct hid_device *hdev,
832 			     struct hid_report *report, u8 *data,
833 			     int size)
834 {
835 	struct dj_receiver_dev *djrcv_dev = hid_get_drvdata(hdev);
836 	struct dj_report *dj_report = (struct dj_report *) data;
837 	unsigned long flags;
838 
839 	/*
840 	 * Here we receive all data coming from iface 2, there are 3 cases:
841 	 *
842 	 * 1) Data is intended for this driver i. e. data contains arrival,
843 	 * departure, etc notifications, in which case we queue them for delayed
844 	 * processing by the work queue. We return 1 to hid-core as no further
845 	 * processing is required from it.
846 	 *
847 	 * 2) Data informs a connection change, if the change means rf link
848 	 * loss, then we must send a null report to the upper layer to discard
849 	 * potentially pressed keys that may be repeated forever by the input
850 	 * layer. Return 1 to hid-core as no further processing is required.
851 	 *
852 	 * 3) Data is an actual input event from a paired DJ device in which
853 	 * case we forward it to the correct hid device (via hid_input_report()
854 	 * ) and return 1 so hid-core does not anything else with it.
855 	 */
856 
857 	if ((dj_report->device_index < DJ_DEVICE_INDEX_MIN) ||
858 	    (dj_report->device_index > DJ_DEVICE_INDEX_MAX)) {
859 		/*
860 		 * Device index is wrong, bail out.
861 		 * This driver can ignore safely the receiver notifications,
862 		 * so ignore those reports too.
863 		 */
864 		if (dj_report->device_index != DJ_RECEIVER_INDEX)
865 			dev_err(&hdev->dev, "%s: invalid device index:%d\n",
866 				__func__, dj_report->device_index);
867 		return false;
868 	}
869 
870 	spin_lock_irqsave(&djrcv_dev->lock, flags);
871 
872 	if (!djrcv_dev->paired_dj_devices[dj_report->device_index]) {
873 		/* received an event for an unknown device, bail out */
874 		logi_dj_recv_queue_notification(djrcv_dev, dj_report);
875 		goto out;
876 	}
877 
878 	switch (dj_report->report_type) {
879 	case REPORT_TYPE_NOTIF_DEVICE_PAIRED:
880 		/* pairing notifications are handled above the switch */
881 		break;
882 	case REPORT_TYPE_NOTIF_DEVICE_UNPAIRED:
883 		logi_dj_recv_queue_notification(djrcv_dev, dj_report);
884 		break;
885 	case REPORT_TYPE_NOTIF_CONNECTION_STATUS:
886 		if (dj_report->report_params[CONNECTION_STATUS_PARAM_STATUS] ==
887 		    STATUS_LINKLOSS) {
888 			logi_dj_recv_forward_null_report(djrcv_dev, dj_report);
889 		}
890 		break;
891 	default:
892 		logi_dj_recv_forward_report(djrcv_dev, dj_report);
893 	}
894 
895 out:
896 	spin_unlock_irqrestore(&djrcv_dev->lock, flags);
897 
898 	return true;
899 }
900 
901 static int logi_dj_hidpp_event(struct hid_device *hdev,
902 			     struct hid_report *report, u8 *data,
903 			     int size)
904 {
905 	struct dj_receiver_dev *djrcv_dev = hid_get_drvdata(hdev);
906 	struct dj_report *dj_report = (struct dj_report *) data;
907 	unsigned long flags;
908 	u8 device_index = dj_report->device_index;
909 
910 	if (device_index == HIDPP_RECEIVER_INDEX) {
911 		/* special case were the device wants to know its unifying
912 		 * name */
913 		if (size == HIDPP_REPORT_LONG_LENGTH &&
914 		    !memcmp(data, unifying_name_answer,
915 			    sizeof(unifying_name_answer)) &&
916 		    ((data[4] & 0xF0) == 0x40))
917 			device_index = (data[4] & 0x0F) + 1;
918 		else
919 			return false;
920 	}
921 
922 	/*
923 	 * Data is from the HID++ collection, in this case, we forward the
924 	 * data to the corresponding child dj device and return 0 to hid-core
925 	 * so he data also goes to the hidraw device of the receiver. This
926 	 * allows a user space application to implement the full HID++ routing
927 	 * via the receiver.
928 	 */
929 
930 	if ((device_index < DJ_DEVICE_INDEX_MIN) ||
931 	    (device_index > DJ_DEVICE_INDEX_MAX)) {
932 		/*
933 		 * Device index is wrong, bail out.
934 		 * This driver can ignore safely the receiver notifications,
935 		 * so ignore those reports too.
936 		 */
937 		dev_err(&hdev->dev, "%s: invalid device index:%d\n",
938 				__func__, dj_report->device_index);
939 		return false;
940 	}
941 
942 	spin_lock_irqsave(&djrcv_dev->lock, flags);
943 
944 	if (!djrcv_dev->paired_dj_devices[device_index])
945 		/* received an event for an unknown device, bail out */
946 		goto out;
947 
948 	logi_dj_recv_forward_hidpp(djrcv_dev->paired_dj_devices[device_index],
949 				   data, size);
950 
951 out:
952 	spin_unlock_irqrestore(&djrcv_dev->lock, flags);
953 
954 	return false;
955 }
956 
957 static int logi_dj_raw_event(struct hid_device *hdev,
958 			     struct hid_report *report, u8 *data,
959 			     int size)
960 {
961 	dbg_hid("%s, size:%d\n", __func__, size);
962 
963 	switch (data[0]) {
964 	case REPORT_ID_DJ_SHORT:
965 		if (size != DJREPORT_SHORT_LENGTH) {
966 			dev_err(&hdev->dev, "DJ report of bad size (%d)", size);
967 			return false;
968 		}
969 		return logi_dj_dj_event(hdev, report, data, size);
970 	case REPORT_ID_HIDPP_SHORT:
971 		if (size != HIDPP_REPORT_SHORT_LENGTH) {
972 			dev_err(&hdev->dev,
973 				"Short HID++ report of bad size (%d)", size);
974 			return false;
975 		}
976 		return logi_dj_hidpp_event(hdev, report, data, size);
977 	case REPORT_ID_HIDPP_LONG:
978 		if (size != HIDPP_REPORT_LONG_LENGTH) {
979 			dev_err(&hdev->dev,
980 				"Long HID++ report of bad size (%d)", size);
981 			return false;
982 		}
983 		return logi_dj_hidpp_event(hdev, report, data, size);
984 	}
985 
986 	return false;
987 }
988 
989 static int logi_dj_probe(struct hid_device *hdev,
990 			 const struct hid_device_id *id)
991 {
992 	struct usb_interface *intf = to_usb_interface(hdev->dev.parent);
993 	struct dj_receiver_dev *djrcv_dev;
994 	int retval;
995 
996 	dbg_hid("%s called for ifnum %d\n", __func__,
997 		intf->cur_altsetting->desc.bInterfaceNumber);
998 
999 	/* Ignore interfaces 0 and 1, they will not carry any data, dont create
1000 	 * any hid_device for them */
1001 	if (intf->cur_altsetting->desc.bInterfaceNumber !=
1002 	    LOGITECH_DJ_INTERFACE_NUMBER) {
1003 		dbg_hid("%s: ignoring ifnum %d\n", __func__,
1004 			intf->cur_altsetting->desc.bInterfaceNumber);
1005 		return -ENODEV;
1006 	}
1007 
1008 	/* Treat interface 2 */
1009 
1010 	djrcv_dev = kzalloc(sizeof(struct dj_receiver_dev), GFP_KERNEL);
1011 	if (!djrcv_dev) {
1012 		dev_err(&hdev->dev,
1013 			"%s:failed allocating dj_receiver_dev\n", __func__);
1014 		return -ENOMEM;
1015 	}
1016 	djrcv_dev->hdev = hdev;
1017 	INIT_WORK(&djrcv_dev->work, delayedwork_callback);
1018 	spin_lock_init(&djrcv_dev->lock);
1019 	if (kfifo_alloc(&djrcv_dev->notif_fifo,
1020 			DJ_MAX_NUMBER_NOTIFICATIONS * sizeof(struct dj_report),
1021 			GFP_KERNEL)) {
1022 		dev_err(&hdev->dev,
1023 			"%s:failed allocating notif_fifo\n", __func__);
1024 		kfree(djrcv_dev);
1025 		return -ENOMEM;
1026 	}
1027 	hid_set_drvdata(hdev, djrcv_dev);
1028 
1029 	/* Call  to usbhid to fetch the HID descriptors of interface 2 and
1030 	 * subsequently call to the hid/hid-core to parse the fetched
1031 	 * descriptors, this will in turn create the hidraw and hiddev nodes
1032 	 * for interface 2 of the receiver */
1033 	retval = hid_parse(hdev);
1034 	if (retval) {
1035 		dev_err(&hdev->dev,
1036 			"%s:parse of interface 2 failed\n", __func__);
1037 		goto hid_parse_fail;
1038 	}
1039 
1040 	if (!hid_validate_values(hdev, HID_OUTPUT_REPORT, REPORT_ID_DJ_SHORT,
1041 				 0, DJREPORT_SHORT_LENGTH - 1)) {
1042 		retval = -ENODEV;
1043 		goto hid_parse_fail;
1044 	}
1045 
1046 	/* Starts the usb device and connects to upper interfaces hiddev and
1047 	 * hidraw */
1048 	retval = hid_hw_start(hdev, HID_CONNECT_DEFAULT);
1049 	if (retval) {
1050 		dev_err(&hdev->dev,
1051 			"%s:hid_hw_start returned error\n", __func__);
1052 		goto hid_hw_start_fail;
1053 	}
1054 
1055 	retval = logi_dj_recv_switch_to_dj_mode(djrcv_dev, 0);
1056 	if (retval < 0) {
1057 		dev_err(&hdev->dev,
1058 			"%s:logi_dj_recv_switch_to_dj_mode returned error:%d\n",
1059 			__func__, retval);
1060 		goto switch_to_dj_mode_fail;
1061 	}
1062 
1063 	/* This is enabling the polling urb on the IN endpoint */
1064 	retval = hid_hw_open(hdev);
1065 	if (retval < 0) {
1066 		dev_err(&hdev->dev, "%s:hid_hw_open returned error:%d\n",
1067 			__func__, retval);
1068 		goto llopen_failed;
1069 	}
1070 
1071 	/* Allow incoming packets to arrive: */
1072 	hid_device_io_start(hdev);
1073 
1074 	retval = logi_dj_recv_query_paired_devices(djrcv_dev);
1075 	if (retval < 0) {
1076 		dev_err(&hdev->dev, "%s:logi_dj_recv_query_paired_devices "
1077 			"error:%d\n", __func__, retval);
1078 		goto logi_dj_recv_query_paired_devices_failed;
1079 	}
1080 
1081 	return retval;
1082 
1083 logi_dj_recv_query_paired_devices_failed:
1084 	hid_hw_close(hdev);
1085 
1086 llopen_failed:
1087 switch_to_dj_mode_fail:
1088 	hid_hw_stop(hdev);
1089 
1090 hid_hw_start_fail:
1091 hid_parse_fail:
1092 	kfifo_free(&djrcv_dev->notif_fifo);
1093 	kfree(djrcv_dev);
1094 	hid_set_drvdata(hdev, NULL);
1095 	return retval;
1096 
1097 }
1098 
1099 #ifdef CONFIG_PM
1100 static int logi_dj_reset_resume(struct hid_device *hdev)
1101 {
1102 	int retval;
1103 	struct dj_receiver_dev *djrcv_dev = hid_get_drvdata(hdev);
1104 
1105 	retval = logi_dj_recv_switch_to_dj_mode(djrcv_dev, 0);
1106 	if (retval < 0) {
1107 		dev_err(&hdev->dev,
1108 			"%s:logi_dj_recv_switch_to_dj_mode returned error:%d\n",
1109 			__func__, retval);
1110 	}
1111 
1112 	return 0;
1113 }
1114 #endif
1115 
1116 static void logi_dj_remove(struct hid_device *hdev)
1117 {
1118 	struct dj_receiver_dev *djrcv_dev = hid_get_drvdata(hdev);
1119 	struct dj_device *dj_dev;
1120 	int i;
1121 
1122 	dbg_hid("%s\n", __func__);
1123 
1124 	cancel_work_sync(&djrcv_dev->work);
1125 
1126 	hid_hw_close(hdev);
1127 	hid_hw_stop(hdev);
1128 
1129 	/* I suppose that at this point the only context that can access
1130 	 * the djrecv_data is this thread as the work item is guaranteed to
1131 	 * have finished and no more raw_event callbacks should arrive after
1132 	 * the remove callback was triggered so no locks are put around the
1133 	 * code below */
1134 	for (i = 0; i < (DJ_MAX_PAIRED_DEVICES + DJ_DEVICE_INDEX_MIN); i++) {
1135 		dj_dev = djrcv_dev->paired_dj_devices[i];
1136 		if (dj_dev != NULL) {
1137 			hid_destroy_device(dj_dev->hdev);
1138 			kfree(dj_dev);
1139 			djrcv_dev->paired_dj_devices[i] = NULL;
1140 		}
1141 	}
1142 
1143 	kfifo_free(&djrcv_dev->notif_fifo);
1144 	kfree(djrcv_dev);
1145 	hid_set_drvdata(hdev, NULL);
1146 }
1147 
1148 static const struct hid_device_id logi_dj_receivers[] = {
1149 	{HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH,
1150 		USB_DEVICE_ID_LOGITECH_UNIFYING_RECEIVER)},
1151 	{HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH,
1152 		USB_DEVICE_ID_LOGITECH_UNIFYING_RECEIVER_2)},
1153 	{}
1154 };
1155 
1156 MODULE_DEVICE_TABLE(hid, logi_dj_receivers);
1157 
1158 static struct hid_driver logi_djreceiver_driver = {
1159 	.name = "logitech-djreceiver",
1160 	.id_table = logi_dj_receivers,
1161 	.probe = logi_dj_probe,
1162 	.remove = logi_dj_remove,
1163 	.raw_event = logi_dj_raw_event,
1164 #ifdef CONFIG_PM
1165 	.reset_resume = logi_dj_reset_resume,
1166 #endif
1167 };
1168 
1169 module_hid_driver(logi_djreceiver_driver);
1170 
1171 MODULE_LICENSE("GPL");
1172 MODULE_AUTHOR("Logitech");
1173 MODULE_AUTHOR("Nestor Lopez Casado");
1174 MODULE_AUTHOR("nlopezcasad@logitech.com");
1175