• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
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 <asm/unaligned.h>
30 #include "hid-ids.h"
31 #include "hid-logitech-dj.h"
32 
33 /* Keyboard descriptor (1) */
34 static const char kbd_descriptor[] = {
35 	0x05, 0x01,		/* USAGE_PAGE (generic Desktop)     */
36 	0x09, 0x06,		/* USAGE (Keyboard)         */
37 	0xA1, 0x01,		/* COLLECTION (Application)     */
38 	0x85, 0x01,		/* REPORT_ID (1)            */
39 	0x95, 0x08,		/*   REPORT_COUNT (8)           */
40 	0x75, 0x01,		/*   REPORT_SIZE (1)            */
41 	0x15, 0x00,		/*   LOGICAL_MINIMUM (0)        */
42 	0x25, 0x01,		/*   LOGICAL_MAXIMUM (1)        */
43 	0x05, 0x07,		/*   USAGE_PAGE (Keyboard)      */
44 	0x19, 0xE0,		/*   USAGE_MINIMUM (Left Control)   */
45 	0x29, 0xE7,		/*   USAGE_MAXIMUM (Right GUI)      */
46 	0x81, 0x02,		/*   INPUT (Data,Var,Abs)       */
47 	0x95, 0x05,		/*   REPORT COUNT (5)           */
48 	0x05, 0x08,		/*   USAGE PAGE (LED page)      */
49 	0x19, 0x01,		/*   USAGE MINIMUM (1)          */
50 	0x29, 0x05,		/*   USAGE MAXIMUM (5)          */
51 	0x91, 0x02,		/*   OUTPUT (Data, Variable, Absolute)  */
52 	0x95, 0x01,		/*   REPORT COUNT (1)           */
53 	0x75, 0x03,		/*   REPORT SIZE (3)            */
54 	0x91, 0x01,		/*   OUTPUT (Constant)          */
55 	0x95, 0x06,		/*   REPORT_COUNT (6)           */
56 	0x75, 0x08,		/*   REPORT_SIZE (8)            */
57 	0x15, 0x00,		/*   LOGICAL_MINIMUM (0)        */
58 	0x26, 0xFF, 0x00,	/*   LOGICAL_MAXIMUM (255)      */
59 	0x05, 0x07,		/*   USAGE_PAGE (Keyboard)      */
60 	0x19, 0x00,		/*   USAGE_MINIMUM (no event)       */
61 	0x2A, 0xFF, 0x00,	/*   USAGE_MAXIMUM (reserved)       */
62 	0x81, 0x00,		/*   INPUT (Data,Ary,Abs)       */
63 	0xC0
64 };
65 
66 /* Mouse descriptor (2)     */
67 static const char mse_descriptor[] = {
68 	0x05, 0x01,		/*  USAGE_PAGE (Generic Desktop)        */
69 	0x09, 0x02,		/*  USAGE (Mouse)                       */
70 	0xA1, 0x01,		/*  COLLECTION (Application)            */
71 	0x85, 0x02,		/*    REPORT_ID = 2                     */
72 	0x09, 0x01,		/*    USAGE (pointer)                   */
73 	0xA1, 0x00,		/*    COLLECTION (physical)             */
74 	0x05, 0x09,		/*      USAGE_PAGE (buttons)            */
75 	0x19, 0x01,		/*      USAGE_MIN (1)                   */
76 	0x29, 0x10,		/*      USAGE_MAX (16)                  */
77 	0x15, 0x00,		/*      LOGICAL_MIN (0)                 */
78 	0x25, 0x01,		/*      LOGICAL_MAX (1)                 */
79 	0x95, 0x10,		/*      REPORT_COUNT (16)               */
80 	0x75, 0x01,		/*      REPORT_SIZE (1)                 */
81 	0x81, 0x02,		/*      INPUT (data var abs)            */
82 	0x05, 0x01,		/*      USAGE_PAGE (generic desktop)    */
83 	0x16, 0x01, 0xF8,	/*      LOGICAL_MIN (-2047)             */
84 	0x26, 0xFF, 0x07,	/*      LOGICAL_MAX (2047)              */
85 	0x75, 0x0C,		/*      REPORT_SIZE (12)                */
86 	0x95, 0x02,		/*      REPORT_COUNT (2)                */
87 	0x09, 0x30,		/*      USAGE (X)                       */
88 	0x09, 0x31,		/*      USAGE (Y)                       */
89 	0x81, 0x06,		/*      INPUT                           */
90 	0x15, 0x81,		/*      LOGICAL_MIN (-127)              */
91 	0x25, 0x7F,		/*      LOGICAL_MAX (127)               */
92 	0x75, 0x08,		/*      REPORT_SIZE (8)                 */
93 	0x95, 0x01,		/*      REPORT_COUNT (1)                */
94 	0x09, 0x38,		/*      USAGE (wheel)                   */
95 	0x81, 0x06,		/*      INPUT                           */
96 	0x05, 0x0C,		/*      USAGE_PAGE(consumer)            */
97 	0x0A, 0x38, 0x02,	/*      USAGE(AC Pan)                   */
98 	0x95, 0x01,		/*      REPORT_COUNT (1)                */
99 	0x81, 0x06,		/*      INPUT                           */
100 	0xC0,			/*    END_COLLECTION                    */
101 	0xC0,			/*  END_COLLECTION                      */
102 };
103 
104 /* Consumer Control descriptor (3) */
105 static const char consumer_descriptor[] = {
106 	0x05, 0x0C,		/* USAGE_PAGE (Consumer Devices)       */
107 	0x09, 0x01,		/* USAGE (Consumer Control)            */
108 	0xA1, 0x01,		/* COLLECTION (Application)            */
109 	0x85, 0x03,		/* REPORT_ID = 3                       */
110 	0x75, 0x10,		/* REPORT_SIZE (16)                    */
111 	0x95, 0x02,		/* REPORT_COUNT (2)                    */
112 	0x15, 0x01,		/* LOGICAL_MIN (1)                     */
113 	0x26, 0x8C, 0x02,	/* LOGICAL_MAX (652)                   */
114 	0x19, 0x01,		/* USAGE_MIN (1)                       */
115 	0x2A, 0x8C, 0x02,	/* USAGE_MAX (652)                     */
116 	0x81, 0x00,		/* INPUT (Data Ary Abs)                */
117 	0xC0,			/* END_COLLECTION                      */
118 };				/*                                     */
119 
120 /* System control descriptor (4) */
121 static const char syscontrol_descriptor[] = {
122 	0x05, 0x01,		/*   USAGE_PAGE (Generic Desktop)      */
123 	0x09, 0x80,		/*   USAGE (System Control)            */
124 	0xA1, 0x01,		/*   COLLECTION (Application)          */
125 	0x85, 0x04,		/*   REPORT_ID = 4                     */
126 	0x75, 0x02,		/*   REPORT_SIZE (2)                   */
127 	0x95, 0x01,		/*   REPORT_COUNT (1)                  */
128 	0x15, 0x01,		/*   LOGICAL_MIN (1)                   */
129 	0x25, 0x03,		/*   LOGICAL_MAX (3)                   */
130 	0x09, 0x82,		/*   USAGE (System Sleep)              */
131 	0x09, 0x81,		/*   USAGE (System Power Down)         */
132 	0x09, 0x83,		/*   USAGE (System Wake Up)            */
133 	0x81, 0x60,		/*   INPUT (Data Ary Abs NPrf Null)    */
134 	0x75, 0x06,		/*   REPORT_SIZE (6)                   */
135 	0x81, 0x03,		/*   INPUT (Cnst Var Abs)              */
136 	0xC0,			/*   END_COLLECTION                    */
137 };
138 
139 /* Media descriptor (8) */
140 static const char media_descriptor[] = {
141 	0x06, 0xbc, 0xff,	/* Usage Page 0xffbc                   */
142 	0x09, 0x88,		/* Usage 0x0088                        */
143 	0xa1, 0x01,		/* BeginCollection                     */
144 	0x85, 0x08,		/*   Report ID 8                       */
145 	0x19, 0x01,		/*   Usage Min 0x0001                  */
146 	0x29, 0xff,		/*   Usage Max 0x00ff                  */
147 	0x15, 0x01,		/*   Logical Min 1                     */
148 	0x26, 0xff, 0x00,	/*   Logical Max 255                   */
149 	0x75, 0x08,		/*   Report Size 8                     */
150 	0x95, 0x01,		/*   Report Count 1                    */
151 	0x81, 0x00,		/*   Input                             */
152 	0xc0,			/* EndCollection                       */
153 };				/*                                     */
154 
155 /* Maximum size of all defined hid reports in bytes (including report id) */
156 #define MAX_REPORT_SIZE 8
157 
158 /* Make sure all descriptors are present here */
159 #define MAX_RDESC_SIZE				\
160 	(sizeof(kbd_descriptor) +		\
161 	 sizeof(mse_descriptor) +		\
162 	 sizeof(consumer_descriptor) +		\
163 	 sizeof(syscontrol_descriptor) +	\
164 	 sizeof(media_descriptor))
165 
166 /* Number of possible hid report types that can be created by this driver.
167  *
168  * Right now, RF report types have the same report types (or report id's)
169  * than the hid report created from those RF reports. In the future
170  * this doesnt have to be true.
171  *
172  * For instance, RF report type 0x01 which has a size of 8 bytes, corresponds
173  * to hid report id 0x01, this is standard keyboard. Same thing applies to mice
174  * reports and consumer control, etc. If a new RF report is created, it doesn't
175  * has to have the same report id as its corresponding hid report, so an
176  * translation may have to take place for future report types.
177  */
178 #define NUMBER_OF_HID_REPORTS 32
179 static const u8 hid_reportid_size_map[NUMBER_OF_HID_REPORTS] = {
180 	[1] = 8,		/* Standard keyboard */
181 	[2] = 8,		/* Standard mouse */
182 	[3] = 5,		/* Consumer control */
183 	[4] = 2,		/* System control */
184 	[8] = 2,		/* Media Center */
185 };
186 
187 
188 #define LOGITECH_DJ_INTERFACE_NUMBER 0x02
189 
190 static struct hid_ll_driver logi_dj_ll_driver;
191 
192 static int logi_dj_output_hidraw_report(struct hid_device *hid, u8 * buf,
193 					size_t count,
194 					unsigned char report_type);
195 
logi_dj_recv_destroy_djhid_device(struct dj_receiver_dev * djrcv_dev,struct dj_report * dj_report)196 static void logi_dj_recv_destroy_djhid_device(struct dj_receiver_dev *djrcv_dev,
197 						struct dj_report *dj_report)
198 {
199 	/* Called in delayed work context */
200 	struct dj_device *dj_dev;
201 	unsigned long flags;
202 
203 	spin_lock_irqsave(&djrcv_dev->lock, flags);
204 	dj_dev = djrcv_dev->paired_dj_devices[dj_report->device_index];
205 	djrcv_dev->paired_dj_devices[dj_report->device_index] = NULL;
206 	spin_unlock_irqrestore(&djrcv_dev->lock, flags);
207 
208 	if (dj_dev != NULL) {
209 		hid_destroy_device(dj_dev->hdev);
210 		kfree(dj_dev);
211 	} else {
212 		dev_err(&djrcv_dev->hdev->dev, "%s: can't destroy a NULL device\n",
213 			__func__);
214 	}
215 }
216 
logi_dj_recv_add_djhid_device(struct dj_receiver_dev * djrcv_dev,struct dj_report * dj_report)217 static void logi_dj_recv_add_djhid_device(struct dj_receiver_dev *djrcv_dev,
218 					  struct dj_report *dj_report)
219 {
220 	/* Called in delayed work context */
221 	struct hid_device *djrcv_hdev = djrcv_dev->hdev;
222 	struct usb_interface *intf = to_usb_interface(djrcv_hdev->dev.parent);
223 	struct usb_device *usbdev = interface_to_usbdev(intf);
224 	struct hid_device *dj_hiddev;
225 	struct dj_device *dj_dev;
226 
227 	/* Device index goes from 1 to 6, we need 3 bytes to store the
228 	 * semicolon, the index, and a null terminator
229 	 */
230 	unsigned char tmpstr[3];
231 
232 	if (dj_report->report_params[DEVICE_PAIRED_PARAM_SPFUNCTION] &
233 	    SPFUNCTION_DEVICE_LIST_EMPTY) {
234 		dbg_hid("%s: device list is empty\n", __func__);
235 		return;
236 	}
237 
238 	if ((dj_report->device_index < DJ_DEVICE_INDEX_MIN) ||
239 	    (dj_report->device_index > DJ_DEVICE_INDEX_MAX)) {
240 		dev_err(&djrcv_hdev->dev, "%s: invalid device index:%d\n",
241 			__func__, dj_report->device_index);
242 		return;
243 	}
244 
245 	dj_hiddev = hid_allocate_device();
246 	if (IS_ERR(dj_hiddev)) {
247 		dev_err(&djrcv_hdev->dev, "%s: hid_allocate_device failed\n",
248 			__func__);
249 		return;
250 	}
251 
252 	dj_hiddev->ll_driver = &logi_dj_ll_driver;
253 	dj_hiddev->hid_output_raw_report = logi_dj_output_hidraw_report;
254 
255 	dj_hiddev->dev.parent = &djrcv_hdev->dev;
256 	dj_hiddev->bus = BUS_USB;
257 	dj_hiddev->vendor = le16_to_cpu(usbdev->descriptor.idVendor);
258 	dj_hiddev->product = le16_to_cpu(usbdev->descriptor.idProduct);
259 	snprintf(dj_hiddev->name, sizeof(dj_hiddev->name),
260 		"Logitech Unifying Device. Wireless PID:%02x%02x",
261 		dj_report->report_params[DEVICE_PAIRED_PARAM_EQUAD_ID_MSB],
262 		dj_report->report_params[DEVICE_PAIRED_PARAM_EQUAD_ID_LSB]);
263 
264 	usb_make_path(usbdev, dj_hiddev->phys, sizeof(dj_hiddev->phys));
265 	snprintf(tmpstr, sizeof(tmpstr), ":%d", dj_report->device_index);
266 	strlcat(dj_hiddev->phys, tmpstr, sizeof(dj_hiddev->phys));
267 
268 	dj_dev = kzalloc(sizeof(struct dj_device), GFP_KERNEL);
269 
270 	if (!dj_dev) {
271 		dev_err(&djrcv_hdev->dev, "%s: failed allocating dj_device\n",
272 			__func__);
273 		goto dj_device_allocate_fail;
274 	}
275 
276 	dj_dev->reports_supported = get_unaligned_le32(
277 		dj_report->report_params + DEVICE_PAIRED_RF_REPORT_TYPE);
278 	dj_dev->hdev = dj_hiddev;
279 	dj_dev->dj_receiver_dev = djrcv_dev;
280 	dj_dev->device_index = dj_report->device_index;
281 	dj_hiddev->driver_data = dj_dev;
282 
283 	djrcv_dev->paired_dj_devices[dj_report->device_index] = dj_dev;
284 
285 	if (hid_add_device(dj_hiddev)) {
286 		dev_err(&djrcv_hdev->dev, "%s: failed adding dj_device\n",
287 			__func__);
288 		goto hid_add_device_fail;
289 	}
290 
291 	return;
292 
293 hid_add_device_fail:
294 	djrcv_dev->paired_dj_devices[dj_report->device_index] = NULL;
295 	kfree(dj_dev);
296 dj_device_allocate_fail:
297 	hid_destroy_device(dj_hiddev);
298 }
299 
delayedwork_callback(struct work_struct * work)300 static void delayedwork_callback(struct work_struct *work)
301 {
302 	struct dj_receiver_dev *djrcv_dev =
303 		container_of(work, struct dj_receiver_dev, work);
304 
305 	struct dj_report dj_report;
306 	unsigned long flags;
307 	int count;
308 
309 	dbg_hid("%s\n", __func__);
310 
311 	spin_lock_irqsave(&djrcv_dev->lock, flags);
312 
313 	count = kfifo_out(&djrcv_dev->notif_fifo, &dj_report,
314 				sizeof(struct dj_report));
315 
316 	if (count != sizeof(struct dj_report)) {
317 		dev_err(&djrcv_dev->hdev->dev, "%s: workitem triggered without "
318 			"notifications available\n", __func__);
319 		spin_unlock_irqrestore(&djrcv_dev->lock, flags);
320 		return;
321 	}
322 
323 	if (!kfifo_is_empty(&djrcv_dev->notif_fifo)) {
324 		if (schedule_work(&djrcv_dev->work) == 0) {
325 			dbg_hid("%s: did not schedule the work item, was "
326 				"already queued\n", __func__);
327 		}
328 	}
329 
330 	spin_unlock_irqrestore(&djrcv_dev->lock, flags);
331 
332 	switch (dj_report.report_type) {
333 	case REPORT_TYPE_NOTIF_DEVICE_PAIRED:
334 		logi_dj_recv_add_djhid_device(djrcv_dev, &dj_report);
335 		break;
336 	case REPORT_TYPE_NOTIF_DEVICE_UNPAIRED:
337 		logi_dj_recv_destroy_djhid_device(djrcv_dev, &dj_report);
338 		break;
339 	default:
340 		dbg_hid("%s: unexpected report type\n", __func__);
341 	}
342 }
343 
logi_dj_recv_queue_notification(struct dj_receiver_dev * djrcv_dev,struct dj_report * dj_report)344 static void logi_dj_recv_queue_notification(struct dj_receiver_dev *djrcv_dev,
345 					   struct dj_report *dj_report)
346 {
347 	/* We are called from atomic context (tasklet && djrcv->lock held) */
348 
349 	kfifo_in(&djrcv_dev->notif_fifo, dj_report, sizeof(struct dj_report));
350 
351 	if (schedule_work(&djrcv_dev->work) == 0) {
352 		dbg_hid("%s: did not schedule the work item, was already "
353 			"queued\n", __func__);
354 	}
355 }
356 
logi_dj_recv_forward_null_report(struct dj_receiver_dev * djrcv_dev,struct dj_report * dj_report)357 static void logi_dj_recv_forward_null_report(struct dj_receiver_dev *djrcv_dev,
358 					     struct dj_report *dj_report)
359 {
360 	/* We are called from atomic context (tasklet && djrcv->lock held) */
361 	unsigned int i;
362 	u8 reportbuffer[MAX_REPORT_SIZE];
363 	struct dj_device *djdev;
364 
365 	djdev = djrcv_dev->paired_dj_devices[dj_report->device_index];
366 
367 	if (!djdev) {
368 		dbg_hid("djrcv_dev->paired_dj_devices[dj_report->device_index]"
369 			" is NULL, index %d\n", dj_report->device_index);
370 		return;
371 	}
372 
373 	memset(reportbuffer, 0, sizeof(reportbuffer));
374 
375 	for (i = 0; i < NUMBER_OF_HID_REPORTS; i++) {
376 		if (djdev->reports_supported & (1 << i)) {
377 			reportbuffer[0] = i;
378 			if (hid_input_report(djdev->hdev,
379 					     HID_INPUT_REPORT,
380 					     reportbuffer,
381 					     hid_reportid_size_map[i], 1)) {
382 				dbg_hid("hid_input_report error sending null "
383 					"report\n");
384 			}
385 		}
386 	}
387 }
388 
logi_dj_recv_forward_report(struct dj_receiver_dev * djrcv_dev,struct dj_report * dj_report)389 static void logi_dj_recv_forward_report(struct dj_receiver_dev *djrcv_dev,
390 					struct dj_report *dj_report)
391 {
392 	/* We are called from atomic context (tasklet && djrcv->lock held) */
393 	struct dj_device *dj_device;
394 
395 	dj_device = djrcv_dev->paired_dj_devices[dj_report->device_index];
396 
397 	if (dj_device == NULL) {
398 		dbg_hid("djrcv_dev->paired_dj_devices[dj_report->device_index]"
399 			" is NULL, index %d\n", dj_report->device_index);
400 		return;
401 	}
402 
403 	if ((dj_report->report_type > ARRAY_SIZE(hid_reportid_size_map) - 1) ||
404 	    (hid_reportid_size_map[dj_report->report_type] == 0)) {
405 		dbg_hid("invalid report type:%x\n", dj_report->report_type);
406 		return;
407 	}
408 
409 	if (hid_input_report(dj_device->hdev,
410 			HID_INPUT_REPORT, &dj_report->report_type,
411 			hid_reportid_size_map[dj_report->report_type], 1)) {
412 		dbg_hid("hid_input_report error\n");
413 	}
414 }
415 
416 
logi_dj_recv_send_report(struct dj_receiver_dev * djrcv_dev,struct dj_report * dj_report)417 static int logi_dj_recv_send_report(struct dj_receiver_dev *djrcv_dev,
418 				    struct dj_report *dj_report)
419 {
420 	struct hid_device *hdev = djrcv_dev->hdev;
421 	struct hid_report *report;
422 	struct hid_report_enum *output_report_enum;
423 	u8 *data = (u8 *)(&dj_report->device_index);
424 	unsigned int i;
425 
426 	output_report_enum = &hdev->report_enum[HID_OUTPUT_REPORT];
427 	report = output_report_enum->report_id_hash[REPORT_ID_DJ_SHORT];
428 
429 	if (!report) {
430 		dev_err(&hdev->dev, "%s: unable to find dj report\n", __func__);
431 		return -ENODEV;
432 	}
433 
434 	for (i = 0; i < DJREPORT_SHORT_LENGTH - 1; i++)
435 		report->field[0]->value[i] = data[i];
436 
437 	hid_hw_request(hdev, report, HID_REQ_SET_REPORT);
438 
439 	return 0;
440 }
441 
logi_dj_recv_query_paired_devices(struct dj_receiver_dev * djrcv_dev)442 static int logi_dj_recv_query_paired_devices(struct dj_receiver_dev *djrcv_dev)
443 {
444 	struct dj_report *dj_report;
445 	int retval;
446 
447 	dj_report = kzalloc(sizeof(struct dj_report), GFP_KERNEL);
448 	if (!dj_report)
449 		return -ENOMEM;
450 	dj_report->report_id = REPORT_ID_DJ_SHORT;
451 	dj_report->device_index = 0xFF;
452 	dj_report->report_type = REPORT_TYPE_CMD_GET_PAIRED_DEVICES;
453 	retval = logi_dj_recv_send_report(djrcv_dev, dj_report);
454 	kfree(dj_report);
455 	return retval;
456 }
457 
logi_dj_recv_switch_to_dj_mode(struct dj_receiver_dev * djrcv_dev,unsigned timeout)458 static int logi_dj_recv_switch_to_dj_mode(struct dj_receiver_dev *djrcv_dev,
459 					  unsigned timeout)
460 {
461 	struct dj_report *dj_report;
462 	int retval;
463 
464 	dj_report = kzalloc(sizeof(struct dj_report), GFP_KERNEL);
465 	if (!dj_report)
466 		return -ENOMEM;
467 	dj_report->report_id = REPORT_ID_DJ_SHORT;
468 	dj_report->device_index = 0xFF;
469 	dj_report->report_type = REPORT_TYPE_CMD_SWITCH;
470 	dj_report->report_params[CMD_SWITCH_PARAM_DEVBITFIELD] = 0x3F;
471 	dj_report->report_params[CMD_SWITCH_PARAM_TIMEOUT_SECONDS] = (u8)timeout;
472 	retval = logi_dj_recv_send_report(djrcv_dev, dj_report);
473 	kfree(dj_report);
474 	return retval;
475 }
476 
477 
logi_dj_ll_open(struct hid_device * hid)478 static int logi_dj_ll_open(struct hid_device *hid)
479 {
480 	dbg_hid("%s:%s\n", __func__, hid->phys);
481 	return 0;
482 
483 }
484 
logi_dj_ll_close(struct hid_device * hid)485 static void logi_dj_ll_close(struct hid_device *hid)
486 {
487 	dbg_hid("%s:%s\n", __func__, hid->phys);
488 }
489 
logi_dj_output_hidraw_report(struct hid_device * hid,u8 * buf,size_t count,unsigned char report_type)490 static int logi_dj_output_hidraw_report(struct hid_device *hid, u8 * buf,
491 					size_t count,
492 					unsigned char report_type)
493 {
494 	/* Called by hid raw to send data */
495 	dbg_hid("%s\n", __func__);
496 
497 	return 0;
498 }
499 
rdcat(char ** rdesc,unsigned int * rsize,const char * data,unsigned int size)500 static void rdcat(char **rdesc, unsigned int *rsize, const char *data, unsigned int size)
501 {
502 	memcpy(*rdesc + *rsize, data, size);
503 	*rsize += size;
504 }
505 
logi_dj_ll_parse(struct hid_device * hid)506 static int logi_dj_ll_parse(struct hid_device *hid)
507 {
508 	struct dj_device *djdev = hid->driver_data;
509 	unsigned int rsize = 0;
510 	char *rdesc;
511 	int retval;
512 
513 	dbg_hid("%s\n", __func__);
514 
515 	djdev->hdev->version = 0x0111;
516 	djdev->hdev->country = 0x00;
517 
518 	rdesc = kmalloc(MAX_RDESC_SIZE, GFP_KERNEL);
519 	if (!rdesc)
520 		return -ENOMEM;
521 
522 	if (djdev->reports_supported & STD_KEYBOARD) {
523 		dbg_hid("%s: sending a kbd descriptor, reports_supported: %x\n",
524 			__func__, djdev->reports_supported);
525 		rdcat(&rdesc, &rsize, kbd_descriptor, sizeof(kbd_descriptor));
526 	}
527 
528 	if (djdev->reports_supported & STD_MOUSE) {
529 		dbg_hid("%s: sending a mouse descriptor, reports_supported: "
530 			"%x\n", __func__, djdev->reports_supported);
531 		rdcat(&rdesc, &rsize, mse_descriptor, sizeof(mse_descriptor));
532 	}
533 
534 	if (djdev->reports_supported & MULTIMEDIA) {
535 		dbg_hid("%s: sending a multimedia report descriptor: %x\n",
536 			__func__, djdev->reports_supported);
537 		rdcat(&rdesc, &rsize, consumer_descriptor, sizeof(consumer_descriptor));
538 	}
539 
540 	if (djdev->reports_supported & POWER_KEYS) {
541 		dbg_hid("%s: sending a power keys report descriptor: %x\n",
542 			__func__, djdev->reports_supported);
543 		rdcat(&rdesc, &rsize, syscontrol_descriptor, sizeof(syscontrol_descriptor));
544 	}
545 
546 	if (djdev->reports_supported & MEDIA_CENTER) {
547 		dbg_hid("%s: sending a media center report descriptor: %x\n",
548 			__func__, djdev->reports_supported);
549 		rdcat(&rdesc, &rsize, media_descriptor, sizeof(media_descriptor));
550 	}
551 
552 	if (djdev->reports_supported & KBD_LEDS) {
553 		dbg_hid("%s: need to send kbd leds report descriptor: %x\n",
554 			__func__, djdev->reports_supported);
555 	}
556 
557 	retval = hid_parse_report(hid, rdesc, rsize);
558 	kfree(rdesc);
559 
560 	return retval;
561 }
562 
logi_dj_ll_input_event(struct input_dev * dev,unsigned int type,unsigned int code,int value)563 static int logi_dj_ll_input_event(struct input_dev *dev, unsigned int type,
564 				  unsigned int code, int value)
565 {
566 	/* Sent by the input layer to handle leds and Force Feedback */
567 	struct hid_device *dj_hiddev = input_get_drvdata(dev);
568 	struct dj_device *dj_dev = dj_hiddev->driver_data;
569 
570 	struct dj_receiver_dev *djrcv_dev =
571 	    dev_get_drvdata(dj_hiddev->dev.parent);
572 	struct hid_device *dj_rcv_hiddev = djrcv_dev->hdev;
573 	struct hid_report_enum *output_report_enum;
574 
575 	struct hid_field *field;
576 	struct hid_report *report;
577 	unsigned char data[8];
578 	int offset;
579 
580 	dbg_hid("%s: %s, type:%d | code:%d | value:%d\n",
581 		__func__, dev->phys, type, code, value);
582 
583 	if (type != EV_LED)
584 		return -1;
585 
586 	offset = hidinput_find_field(dj_hiddev, type, code, &field);
587 
588 	if (offset == -1) {
589 		dev_warn(&dev->dev, "event field not found\n");
590 		return -1;
591 	}
592 	hid_set_field(field, offset, value);
593 	hid_output_report(field->report, &data[0]);
594 
595 	output_report_enum = &dj_rcv_hiddev->report_enum[HID_OUTPUT_REPORT];
596 	report = output_report_enum->report_id_hash[REPORT_ID_DJ_SHORT];
597 	hid_set_field(report->field[0], 0, dj_dev->device_index);
598 	hid_set_field(report->field[0], 1, REPORT_TYPE_LEDS);
599 	hid_set_field(report->field[0], 2, data[1]);
600 
601 	hid_hw_request(dj_rcv_hiddev, report, HID_REQ_SET_REPORT);
602 
603 	return 0;
604 
605 }
606 
logi_dj_ll_start(struct hid_device * hid)607 static int logi_dj_ll_start(struct hid_device *hid)
608 {
609 	dbg_hid("%s\n", __func__);
610 	return 0;
611 }
612 
logi_dj_ll_stop(struct hid_device * hid)613 static void logi_dj_ll_stop(struct hid_device *hid)
614 {
615 	dbg_hid("%s\n", __func__);
616 }
617 
618 
619 static struct hid_ll_driver logi_dj_ll_driver = {
620 	.parse = logi_dj_ll_parse,
621 	.start = logi_dj_ll_start,
622 	.stop = logi_dj_ll_stop,
623 	.open = logi_dj_ll_open,
624 	.close = logi_dj_ll_close,
625 	.hidinput_input_event = logi_dj_ll_input_event,
626 };
627 
628 
logi_dj_raw_event(struct hid_device * hdev,struct hid_report * report,u8 * data,int size)629 static int logi_dj_raw_event(struct hid_device *hdev,
630 			     struct hid_report *report, u8 *data,
631 			     int size)
632 {
633 	struct dj_receiver_dev *djrcv_dev = hid_get_drvdata(hdev);
634 	struct dj_report *dj_report = (struct dj_report *) data;
635 	unsigned long flags;
636 	bool report_processed = false;
637 
638 	dbg_hid("%s, size:%d\n", __func__, size);
639 
640 	/* Here we receive all data coming from iface 2, there are 4 cases:
641 	 *
642 	 * 1) Data should continue its normal processing i.e. data does not
643 	 * come from the DJ collection, in which case we do nothing and
644 	 * return 0, so hid-core can continue normal processing (will forward
645 	 * to associated hidraw device)
646 	 *
647 	 * 2) Data is from DJ collection, and is intended for this driver i. e.
648 	 * data contains arrival, departure, etc notifications, in which case
649 	 * we queue them for delayed processing by the work queue. We return 1
650 	 * to hid-core as no further processing is required from it.
651 	 *
652 	 * 3) Data is from DJ collection, and informs a connection change,
653 	 * if the change means rf link loss, then we must send a null report
654 	 * to the upper layer to discard potentially pressed keys that may be
655 	 * repeated forever by the input layer. Return 1 to hid-core as no
656 	 * further processing is required.
657 	 *
658 	 * 4) Data is from DJ collection and is an actual input event from
659 	 * a paired DJ device in which case we forward it to the correct hid
660 	 * device (via hid_input_report() ) and return 1 so hid-core does not do
661 	 * anything else with it.
662 	 */
663 
664 	spin_lock_irqsave(&djrcv_dev->lock, flags);
665 	if (dj_report->report_id == REPORT_ID_DJ_SHORT) {
666 		switch (dj_report->report_type) {
667 		case REPORT_TYPE_NOTIF_DEVICE_PAIRED:
668 		case REPORT_TYPE_NOTIF_DEVICE_UNPAIRED:
669 			logi_dj_recv_queue_notification(djrcv_dev, dj_report);
670 			break;
671 		case REPORT_TYPE_NOTIF_CONNECTION_STATUS:
672 			if (dj_report->report_params[CONNECTION_STATUS_PARAM_STATUS] ==
673 			    STATUS_LINKLOSS) {
674 				logi_dj_recv_forward_null_report(djrcv_dev, dj_report);
675 			}
676 			break;
677 		default:
678 			logi_dj_recv_forward_report(djrcv_dev, dj_report);
679 		}
680 		report_processed = true;
681 	}
682 	spin_unlock_irqrestore(&djrcv_dev->lock, flags);
683 
684 	return report_processed;
685 }
686 
logi_dj_probe(struct hid_device * hdev,const struct hid_device_id * id)687 static int logi_dj_probe(struct hid_device *hdev,
688 			 const struct hid_device_id *id)
689 {
690 	struct usb_interface *intf = to_usb_interface(hdev->dev.parent);
691 	struct dj_receiver_dev *djrcv_dev;
692 	int retval;
693 
694 	if (is_dj_device((struct dj_device *)hdev->driver_data))
695 		return -ENODEV;
696 
697 	dbg_hid("%s called for ifnum %d\n", __func__,
698 		intf->cur_altsetting->desc.bInterfaceNumber);
699 
700 	/* Ignore interfaces 0 and 1, they will not carry any data, dont create
701 	 * any hid_device for them */
702 	if (intf->cur_altsetting->desc.bInterfaceNumber !=
703 	    LOGITECH_DJ_INTERFACE_NUMBER) {
704 		dbg_hid("%s: ignoring ifnum %d\n", __func__,
705 			intf->cur_altsetting->desc.bInterfaceNumber);
706 		return -ENODEV;
707 	}
708 
709 	/* Treat interface 2 */
710 
711 	djrcv_dev = kzalloc(sizeof(struct dj_receiver_dev), GFP_KERNEL);
712 	if (!djrcv_dev) {
713 		dev_err(&hdev->dev,
714 			"%s:failed allocating dj_receiver_dev\n", __func__);
715 		return -ENOMEM;
716 	}
717 	djrcv_dev->hdev = hdev;
718 	INIT_WORK(&djrcv_dev->work, delayedwork_callback);
719 	spin_lock_init(&djrcv_dev->lock);
720 	if (kfifo_alloc(&djrcv_dev->notif_fifo,
721 			DJ_MAX_NUMBER_NOTIFICATIONS * sizeof(struct dj_report),
722 			GFP_KERNEL)) {
723 		dev_err(&hdev->dev,
724 			"%s:failed allocating notif_fifo\n", __func__);
725 		kfree(djrcv_dev);
726 		return -ENOMEM;
727 	}
728 	hid_set_drvdata(hdev, djrcv_dev);
729 
730 	/* Call  to usbhid to fetch the HID descriptors of interface 2 and
731 	 * subsequently call to the hid/hid-core to parse the fetched
732 	 * descriptors, this will in turn create the hidraw and hiddev nodes
733 	 * for interface 2 of the receiver */
734 	retval = hid_parse(hdev);
735 	if (retval) {
736 		dev_err(&hdev->dev,
737 			"%s:parse of interface 2 failed\n", __func__);
738 		goto hid_parse_fail;
739 	}
740 
741 	if (!hid_validate_values(hdev, HID_OUTPUT_REPORT, REPORT_ID_DJ_SHORT,
742 				 0, DJREPORT_SHORT_LENGTH - 1)) {
743 		retval = -ENODEV;
744 		goto hid_parse_fail;
745 	}
746 
747 	/* Starts the usb device and connects to upper interfaces hiddev and
748 	 * hidraw */
749 	retval = hid_hw_start(hdev, HID_CONNECT_DEFAULT);
750 	if (retval) {
751 		dev_err(&hdev->dev,
752 			"%s:hid_hw_start returned error\n", __func__);
753 		goto hid_hw_start_fail;
754 	}
755 
756 	retval = logi_dj_recv_switch_to_dj_mode(djrcv_dev, 0);
757 	if (retval < 0) {
758 		dev_err(&hdev->dev,
759 			"%s:logi_dj_recv_switch_to_dj_mode returned error:%d\n",
760 			__func__, retval);
761 		goto switch_to_dj_mode_fail;
762 	}
763 
764 	/* This is enabling the polling urb on the IN endpoint */
765 	retval = hdev->ll_driver->open(hdev);
766 	if (retval < 0) {
767 		dev_err(&hdev->dev, "%s:hdev->ll_driver->open returned "
768 			"error:%d\n", __func__, retval);
769 		goto llopen_failed;
770 	}
771 
772 	/* Allow incoming packets to arrive: */
773 	hid_device_io_start(hdev);
774 
775 	retval = logi_dj_recv_query_paired_devices(djrcv_dev);
776 	if (retval < 0) {
777 		dev_err(&hdev->dev, "%s:logi_dj_recv_query_paired_devices "
778 			"error:%d\n", __func__, retval);
779 		goto logi_dj_recv_query_paired_devices_failed;
780 	}
781 
782 	return retval;
783 
784 logi_dj_recv_query_paired_devices_failed:
785 	hdev->ll_driver->close(hdev);
786 
787 llopen_failed:
788 switch_to_dj_mode_fail:
789 	hid_hw_stop(hdev);
790 
791 hid_hw_start_fail:
792 hid_parse_fail:
793 	kfifo_free(&djrcv_dev->notif_fifo);
794 	kfree(djrcv_dev);
795 	hid_set_drvdata(hdev, NULL);
796 	return retval;
797 
798 }
799 
800 #ifdef CONFIG_PM
logi_dj_reset_resume(struct hid_device * hdev)801 static int logi_dj_reset_resume(struct hid_device *hdev)
802 {
803 	int retval;
804 	struct dj_receiver_dev *djrcv_dev = hid_get_drvdata(hdev);
805 
806 	retval = logi_dj_recv_switch_to_dj_mode(djrcv_dev, 0);
807 	if (retval < 0) {
808 		dev_err(&hdev->dev,
809 			"%s:logi_dj_recv_switch_to_dj_mode returned error:%d\n",
810 			__func__, retval);
811 	}
812 
813 	return 0;
814 }
815 #endif
816 
logi_dj_remove(struct hid_device * hdev)817 static void logi_dj_remove(struct hid_device *hdev)
818 {
819 	struct dj_receiver_dev *djrcv_dev = hid_get_drvdata(hdev);
820 	struct dj_device *dj_dev;
821 	int i;
822 
823 	dbg_hid("%s\n", __func__);
824 
825 	cancel_work_sync(&djrcv_dev->work);
826 
827 	hdev->ll_driver->close(hdev);
828 	hid_hw_stop(hdev);
829 
830 	/* I suppose that at this point the only context that can access
831 	 * the djrecv_data is this thread as the work item is guaranteed to
832 	 * have finished and no more raw_event callbacks should arrive after
833 	 * the remove callback was triggered so no locks are put around the
834 	 * code below */
835 	for (i = 0; i < (DJ_MAX_PAIRED_DEVICES + DJ_DEVICE_INDEX_MIN); i++) {
836 		dj_dev = djrcv_dev->paired_dj_devices[i];
837 		if (dj_dev != NULL) {
838 			hid_destroy_device(dj_dev->hdev);
839 			kfree(dj_dev);
840 			djrcv_dev->paired_dj_devices[i] = NULL;
841 		}
842 	}
843 
844 	kfifo_free(&djrcv_dev->notif_fifo);
845 	kfree(djrcv_dev);
846 	hid_set_drvdata(hdev, NULL);
847 }
848 
logi_djdevice_probe(struct hid_device * hdev,const struct hid_device_id * id)849 static int logi_djdevice_probe(struct hid_device *hdev,
850 			 const struct hid_device_id *id)
851 {
852 	int ret;
853 	struct dj_device *dj_dev = hdev->driver_data;
854 
855 	if (!is_dj_device(dj_dev))
856 		return -ENODEV;
857 
858 	ret = hid_parse(hdev);
859 	if (!ret)
860 		ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT);
861 
862 	return ret;
863 }
864 
865 static const struct hid_device_id logi_dj_receivers[] = {
866 	{HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH,
867 		USB_DEVICE_ID_LOGITECH_UNIFYING_RECEIVER)},
868 	{HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH,
869 		USB_DEVICE_ID_LOGITECH_UNIFYING_RECEIVER_2)},
870 	{}
871 };
872 
873 MODULE_DEVICE_TABLE(hid, logi_dj_receivers);
874 
875 static struct hid_driver logi_djreceiver_driver = {
876 	.name = "logitech-djreceiver",
877 	.id_table = logi_dj_receivers,
878 	.probe = logi_dj_probe,
879 	.remove = logi_dj_remove,
880 	.raw_event = logi_dj_raw_event,
881 #ifdef CONFIG_PM
882 	.reset_resume = logi_dj_reset_resume,
883 #endif
884 };
885 
886 
887 static const struct hid_device_id logi_dj_devices[] = {
888 	{HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH,
889 		USB_DEVICE_ID_LOGITECH_UNIFYING_RECEIVER)},
890 	{HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH,
891 		USB_DEVICE_ID_LOGITECH_UNIFYING_RECEIVER_2)},
892 	{}
893 };
894 
895 static struct hid_driver logi_djdevice_driver = {
896 	.name = "logitech-djdevice",
897 	.id_table = logi_dj_devices,
898 	.probe = logi_djdevice_probe,
899 };
900 
901 
logi_dj_init(void)902 static int __init logi_dj_init(void)
903 {
904 	int retval;
905 
906 	dbg_hid("Logitech-DJ:%s\n", __func__);
907 
908 	retval = hid_register_driver(&logi_djreceiver_driver);
909 	if (retval)
910 		return retval;
911 
912 	retval = hid_register_driver(&logi_djdevice_driver);
913 	if (retval)
914 		hid_unregister_driver(&logi_djreceiver_driver);
915 
916 	return retval;
917 
918 }
919 
logi_dj_exit(void)920 static void __exit logi_dj_exit(void)
921 {
922 	dbg_hid("Logitech-DJ:%s\n", __func__);
923 
924 	hid_unregister_driver(&logi_djdevice_driver);
925 	hid_unregister_driver(&logi_djreceiver_driver);
926 
927 }
928 
929 module_init(logi_dj_init);
930 module_exit(logi_dj_exit);
931 MODULE_LICENSE("GPL");
932 MODULE_AUTHOR("Logitech");
933 MODULE_AUTHOR("Nestor Lopez Casado");
934 MODULE_AUTHOR("nlopezcasad@logitech.com");
935