2 * HIDPP protocol for Logitech Unifying receivers
4 * Copyright (c) 2011 Logitech (c)
5 * Copyright (c) 2012-2013 Google (c)
6 * Copyright (c) 2013-2014 Red Hat Inc.
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License as published by the Free
12 * Software Foundation; version 2 of the License.
15 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
17 #include <linux/device.h>
18 #include <linux/input.h>
19 #include <linux/usb.h>
20 #include <linux/hid.h>
21 #include <linux/module.h>
22 #include <linux/slab.h>
23 #include <linux/sched.h>
24 #include <linux/kfifo.h>
25 #include <linux/input/mt.h>
26 #include <linux/workqueue.h>
27 #include <linux/atomic.h>
28 #include <linux/fixp-arith.h>
29 #include <asm/unaligned.h>
30 #include "usbhid/usbhid.h"
33 MODULE_LICENSE("GPL");
34 MODULE_AUTHOR("Benjamin Tissoires <benjamin.tissoires@gmail.com>");
35 MODULE_AUTHOR("Nestor Lopez Casado <nlopezcasad@logitech.com>");
37 static bool disable_raw_mode
;
38 module_param(disable_raw_mode
, bool, 0644);
39 MODULE_PARM_DESC(disable_raw_mode
,
40 "Disable Raw mode reporting for touchpads and keep firmware gestures.");
42 static bool disable_tap_to_click
;
43 module_param(disable_tap_to_click
, bool, 0644);
44 MODULE_PARM_DESC(disable_tap_to_click
,
45 "Disable Tap-To-Click mode reporting for touchpads (only on the K400 currently).");
47 #define REPORT_ID_HIDPP_SHORT 0x10
48 #define REPORT_ID_HIDPP_LONG 0x11
49 #define REPORT_ID_HIDPP_VERY_LONG 0x12
51 #define HIDPP_REPORT_SHORT_LENGTH 7
52 #define HIDPP_REPORT_LONG_LENGTH 20
53 #define HIDPP_REPORT_VERY_LONG_LENGTH 64
55 #define HIDPP_QUIRK_CLASS_WTP BIT(0)
56 #define HIDPP_QUIRK_CLASS_M560 BIT(1)
57 #define HIDPP_QUIRK_CLASS_K400 BIT(2)
58 #define HIDPP_QUIRK_CLASS_G920 BIT(3)
60 /* bits 2..20 are reserved for classes */
61 /* #define HIDPP_QUIRK_CONNECT_EVENTS BIT(21) disabled */
62 #define HIDPP_QUIRK_WTP_PHYSICAL_BUTTONS BIT(22)
63 #define HIDPP_QUIRK_NO_HIDINPUT BIT(23)
64 #define HIDPP_QUIRK_FORCE_OUTPUT_REPORTS BIT(24)
65 #define HIDPP_QUIRK_UNIFYING BIT(25)
67 #define HIDPP_QUIRK_DELAYED_INIT HIDPP_QUIRK_NO_HIDINPUT
69 #define HIDPP_CAPABILITY_HIDPP10_BATTERY BIT(0)
70 #define HIDPP_CAPABILITY_HIDPP20_BATTERY BIT(1)
73 * There are two hidpp protocols in use, the first version hidpp10 is known
74 * as register access protocol or RAP, the second version hidpp20 is known as
75 * feature access protocol or FAP
77 * Most older devices (including the Unifying usb receiver) use the RAP protocol
78 * where as most newer devices use the FAP protocol. Both protocols are
79 * compatible with the underlying transport, which could be usb, Unifiying, or
80 * bluetooth. The message lengths are defined by the hid vendor specific report
81 * descriptor for the HIDPP_SHORT report type (total message lenth 7 bytes) and
82 * the HIDPP_LONG report type (total message length 20 bytes)
84 * The RAP protocol uses both report types, whereas the FAP only uses HIDPP_LONG
85 * messages. The Unifying receiver itself responds to RAP messages (device index
86 * is 0xFF for the receiver), and all messages (short or long) with a device
87 * index between 1 and 6 are passed untouched to the corresponding paired
90 * The paired device can be RAP or FAP, it will receive the message untouched
91 * from the Unifiying receiver.
96 u8 funcindex_clientid
;
97 u8 params
[HIDPP_REPORT_VERY_LONG_LENGTH
- 4U];
103 u8 params
[HIDPP_REPORT_VERY_LONG_LENGTH
- 4U];
106 struct hidpp_report
{
112 u8 rawbytes
[sizeof(struct fap
)];
116 struct hidpp_battery
{
118 struct power_supply_desc desc
;
119 struct power_supply
*ps
;
125 struct hidpp_device
{
126 struct hid_device
*hid_dev
;
127 struct mutex send_mutex
;
128 void *send_receive_buf
;
129 char *name
; /* will never be NULL and should not be freed */
130 wait_queue_head_t wait
;
131 bool answer_available
;
137 struct work_struct work
;
138 struct kfifo delayed_work_fifo
;
140 struct input_dev
*delayed_input
;
142 unsigned long quirks
;
143 unsigned long capabilities
;
145 struct hidpp_battery battery
;
148 /* HID++ 1.0 error codes */
149 #define HIDPP_ERROR 0x8f
150 #define HIDPP_ERROR_SUCCESS 0x00
151 #define HIDPP_ERROR_INVALID_SUBID 0x01
152 #define HIDPP_ERROR_INVALID_ADRESS 0x02
153 #define HIDPP_ERROR_INVALID_VALUE 0x03
154 #define HIDPP_ERROR_CONNECT_FAIL 0x04
155 #define HIDPP_ERROR_TOO_MANY_DEVICES 0x05
156 #define HIDPP_ERROR_ALREADY_EXISTS 0x06
157 #define HIDPP_ERROR_BUSY 0x07
158 #define HIDPP_ERROR_UNKNOWN_DEVICE 0x08
159 #define HIDPP_ERROR_RESOURCE_ERROR 0x09
160 #define HIDPP_ERROR_REQUEST_UNAVAILABLE 0x0a
161 #define HIDPP_ERROR_INVALID_PARAM_VALUE 0x0b
162 #define HIDPP_ERROR_WRONG_PIN_CODE 0x0c
163 /* HID++ 2.0 error codes */
164 #define HIDPP20_ERROR 0xff
166 static void hidpp_connect_event(struct hidpp_device
*hidpp_dev
);
168 static int __hidpp_send_report(struct hid_device
*hdev
,
169 struct hidpp_report
*hidpp_report
)
171 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
172 int fields_count
, ret
;
174 hidpp
= hid_get_drvdata(hdev
);
176 switch (hidpp_report
->report_id
) {
177 case REPORT_ID_HIDPP_SHORT
:
178 fields_count
= HIDPP_REPORT_SHORT_LENGTH
;
180 case REPORT_ID_HIDPP_LONG
:
181 fields_count
= HIDPP_REPORT_LONG_LENGTH
;
183 case REPORT_ID_HIDPP_VERY_LONG
:
184 fields_count
= HIDPP_REPORT_VERY_LONG_LENGTH
;
191 * set the device_index as the receiver, it will be overwritten by
192 * hid_hw_request if needed
194 hidpp_report
->device_index
= 0xff;
196 if (hidpp
->quirks
& HIDPP_QUIRK_FORCE_OUTPUT_REPORTS
) {
197 ret
= hid_hw_output_report(hdev
, (u8
*)hidpp_report
, fields_count
);
199 ret
= hid_hw_raw_request(hdev
, hidpp_report
->report_id
,
200 (u8
*)hidpp_report
, fields_count
, HID_OUTPUT_REPORT
,
204 return ret
== fields_count
? 0 : -1;
208 * hidpp_send_message_sync() returns 0 in case of success, and something else
209 * in case of a failure.
210 * - If ' something else' is positive, that means that an error has been raised
211 * by the protocol itself.
212 * - If ' something else' is negative, that means that we had a classic error
213 * (-ENOMEM, -EPIPE, etc...)
215 static int hidpp_send_message_sync(struct hidpp_device
*hidpp
,
216 struct hidpp_report
*message
,
217 struct hidpp_report
*response
)
221 mutex_lock(&hidpp
->send_mutex
);
223 hidpp
->send_receive_buf
= response
;
224 hidpp
->answer_available
= false;
227 * So that we can later validate the answer when it arrives
230 *response
= *message
;
232 ret
= __hidpp_send_report(hidpp
->hid_dev
, message
);
235 dbg_hid("__hidpp_send_report returned err: %d\n", ret
);
236 memset(response
, 0, sizeof(struct hidpp_report
));
240 if (!wait_event_timeout(hidpp
->wait
, hidpp
->answer_available
,
242 dbg_hid("%s:timeout waiting for response\n", __func__
);
243 memset(response
, 0, sizeof(struct hidpp_report
));
247 if (response
->report_id
== REPORT_ID_HIDPP_SHORT
&&
248 response
->rap
.sub_id
== HIDPP_ERROR
) {
249 ret
= response
->rap
.params
[1];
250 dbg_hid("%s:got hidpp error %02X\n", __func__
, ret
);
254 if ((response
->report_id
== REPORT_ID_HIDPP_LONG
||
255 response
->report_id
== REPORT_ID_HIDPP_VERY_LONG
) &&
256 response
->fap
.feature_index
== HIDPP20_ERROR
) {
257 ret
= response
->fap
.params
[1];
258 dbg_hid("%s:got hidpp 2.0 error %02X\n", __func__
, ret
);
263 mutex_unlock(&hidpp
->send_mutex
);
268 static int hidpp_send_fap_command_sync(struct hidpp_device
*hidpp
,
269 u8 feat_index
, u8 funcindex_clientid
, u8
*params
, int param_count
,
270 struct hidpp_report
*response
)
272 struct hidpp_report
*message
;
275 if (param_count
> sizeof(message
->fap
.params
))
278 message
= kzalloc(sizeof(struct hidpp_report
), GFP_KERNEL
);
282 if (param_count
> (HIDPP_REPORT_LONG_LENGTH
- 4))
283 message
->report_id
= REPORT_ID_HIDPP_VERY_LONG
;
285 message
->report_id
= REPORT_ID_HIDPP_LONG
;
286 message
->fap
.feature_index
= feat_index
;
287 message
->fap
.funcindex_clientid
= funcindex_clientid
;
288 memcpy(&message
->fap
.params
, params
, param_count
);
290 ret
= hidpp_send_message_sync(hidpp
, message
, response
);
295 static int hidpp_send_rap_command_sync(struct hidpp_device
*hidpp_dev
,
296 u8 report_id
, u8 sub_id
, u8 reg_address
, u8
*params
, int param_count
,
297 struct hidpp_report
*response
)
299 struct hidpp_report
*message
;
303 case REPORT_ID_HIDPP_SHORT
:
304 max_count
= HIDPP_REPORT_SHORT_LENGTH
- 4;
306 case REPORT_ID_HIDPP_LONG
:
307 max_count
= HIDPP_REPORT_LONG_LENGTH
- 4;
309 case REPORT_ID_HIDPP_VERY_LONG
:
310 max_count
= HIDPP_REPORT_VERY_LONG_LENGTH
- 4;
316 if (param_count
> max_count
)
319 message
= kzalloc(sizeof(struct hidpp_report
), GFP_KERNEL
);
322 message
->report_id
= report_id
;
323 message
->rap
.sub_id
= sub_id
;
324 message
->rap
.reg_address
= reg_address
;
325 memcpy(&message
->rap
.params
, params
, param_count
);
327 ret
= hidpp_send_message_sync(hidpp_dev
, message
, response
);
332 static void delayed_work_cb(struct work_struct
*work
)
334 struct hidpp_device
*hidpp
= container_of(work
, struct hidpp_device
,
336 hidpp_connect_event(hidpp
);
339 static inline bool hidpp_match_answer(struct hidpp_report
*question
,
340 struct hidpp_report
*answer
)
342 return (answer
->fap
.feature_index
== question
->fap
.feature_index
) &&
343 (answer
->fap
.funcindex_clientid
== question
->fap
.funcindex_clientid
);
346 static inline bool hidpp_match_error(struct hidpp_report
*question
,
347 struct hidpp_report
*answer
)
349 return ((answer
->rap
.sub_id
== HIDPP_ERROR
) ||
350 (answer
->fap
.feature_index
== HIDPP20_ERROR
)) &&
351 (answer
->fap
.funcindex_clientid
== question
->fap
.feature_index
) &&
352 (answer
->fap
.params
[0] == question
->fap
.funcindex_clientid
);
355 static inline bool hidpp_report_is_connect_event(struct hidpp_report
*report
)
357 return (report
->report_id
== REPORT_ID_HIDPP_SHORT
) &&
358 (report
->rap
.sub_id
== 0x41);
362 * hidpp_prefix_name() prefixes the current given name with "Logitech ".
364 static void hidpp_prefix_name(char **name
, int name_length
)
366 #define PREFIX_LENGTH 9 /* "Logitech " */
371 if (name_length
> PREFIX_LENGTH
&&
372 strncmp(*name
, "Logitech ", PREFIX_LENGTH
) == 0)
373 /* The prefix has is already in the name */
376 new_length
= PREFIX_LENGTH
+ name_length
;
377 new_name
= kzalloc(new_length
, GFP_KERNEL
);
381 snprintf(new_name
, new_length
, "Logitech %s", *name
);
388 /* -------------------------------------------------------------------------- */
389 /* HIDP++ 1.0 commands */
390 /* -------------------------------------------------------------------------- */
392 #define HIDPP_SET_REGISTER 0x80
393 #define HIDPP_GET_REGISTER 0x81
394 #define HIDPP_SET_LONG_REGISTER 0x82
395 #define HIDPP_GET_LONG_REGISTER 0x83
397 #define HIDPP_REG_PAIRING_INFORMATION 0xB5
398 #define HIDPP_EXTENDED_PAIRING 0x30
399 #define HIDPP_DEVICE_NAME 0x40
401 static char *hidpp_unifying_get_name(struct hidpp_device
*hidpp_dev
)
403 struct hidpp_report response
;
405 u8 params
[1] = { HIDPP_DEVICE_NAME
};
409 ret
= hidpp_send_rap_command_sync(hidpp_dev
,
410 REPORT_ID_HIDPP_SHORT
,
411 HIDPP_GET_LONG_REGISTER
,
412 HIDPP_REG_PAIRING_INFORMATION
,
413 params
, 1, &response
);
417 len
= response
.rap
.params
[1];
419 if (2 + len
> sizeof(response
.rap
.params
))
422 name
= kzalloc(len
+ 1, GFP_KERNEL
);
426 memcpy(name
, &response
.rap
.params
[2], len
);
428 /* include the terminating '\0' */
429 hidpp_prefix_name(&name
, len
+ 1);
434 static int hidpp_unifying_get_serial(struct hidpp_device
*hidpp
, u32
*serial
)
436 struct hidpp_report response
;
438 u8 params
[1] = { HIDPP_EXTENDED_PAIRING
};
440 ret
= hidpp_send_rap_command_sync(hidpp
,
441 REPORT_ID_HIDPP_SHORT
,
442 HIDPP_GET_LONG_REGISTER
,
443 HIDPP_REG_PAIRING_INFORMATION
,
444 params
, 1, &response
);
449 * We don't care about LE or BE, we will output it as a string
450 * with %4phD, so we need to keep the order.
452 *serial
= *((u32
*)&response
.rap
.params
[1]);
456 static int hidpp_unifying_init(struct hidpp_device
*hidpp
)
458 struct hid_device
*hdev
= hidpp
->hid_dev
;
463 ret
= hidpp_unifying_get_serial(hidpp
, &serial
);
467 snprintf(hdev
->uniq
, sizeof(hdev
->uniq
), "%04x-%4phD",
468 hdev
->product
, &serial
);
469 dbg_hid("HID++ Unifying: Got serial: %s\n", hdev
->uniq
);
471 name
= hidpp_unifying_get_name(hidpp
);
475 snprintf(hdev
->name
, sizeof(hdev
->name
), "%s", name
);
476 dbg_hid("HID++ Unifying: Got name: %s\n", name
);
482 /* -------------------------------------------------------------------------- */
484 /* -------------------------------------------------------------------------- */
486 #define HIDPP_PAGE_ROOT 0x0000
487 #define HIDPP_PAGE_ROOT_IDX 0x00
489 #define CMD_ROOT_GET_FEATURE 0x01
490 #define CMD_ROOT_GET_PROTOCOL_VERSION 0x11
492 static int hidpp_root_get_feature(struct hidpp_device
*hidpp
, u16 feature
,
493 u8
*feature_index
, u8
*feature_type
)
495 struct hidpp_report response
;
497 u8 params
[2] = { feature
>> 8, feature
& 0x00FF };
499 ret
= hidpp_send_fap_command_sync(hidpp
,
501 CMD_ROOT_GET_FEATURE
,
502 params
, 2, &response
);
506 if (response
.fap
.params
[0] == 0)
509 *feature_index
= response
.fap
.params
[0];
510 *feature_type
= response
.fap
.params
[1];
515 static int hidpp_root_get_protocol_version(struct hidpp_device
*hidpp
)
517 struct hidpp_report response
;
520 ret
= hidpp_send_fap_command_sync(hidpp
,
522 CMD_ROOT_GET_PROTOCOL_VERSION
,
525 if (ret
== HIDPP_ERROR_INVALID_SUBID
) {
526 hidpp
->protocol_major
= 1;
527 hidpp
->protocol_minor
= 0;
531 /* the device might not be connected */
532 if (ret
== HIDPP_ERROR_RESOURCE_ERROR
)
536 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
543 hidpp
->protocol_major
= response
.fap
.params
[0];
544 hidpp
->protocol_minor
= response
.fap
.params
[1];
549 static bool hidpp_is_connected(struct hidpp_device
*hidpp
)
553 ret
= hidpp_root_get_protocol_version(hidpp
);
555 hid_dbg(hidpp
->hid_dev
, "HID++ %u.%u device connected.\n",
556 hidpp
->protocol_major
, hidpp
->protocol_minor
);
560 /* -------------------------------------------------------------------------- */
561 /* 0x0005: GetDeviceNameType */
562 /* -------------------------------------------------------------------------- */
564 #define HIDPP_PAGE_GET_DEVICE_NAME_TYPE 0x0005
566 #define CMD_GET_DEVICE_NAME_TYPE_GET_COUNT 0x01
567 #define CMD_GET_DEVICE_NAME_TYPE_GET_DEVICE_NAME 0x11
568 #define CMD_GET_DEVICE_NAME_TYPE_GET_TYPE 0x21
570 static int hidpp_devicenametype_get_count(struct hidpp_device
*hidpp
,
571 u8 feature_index
, u8
*nameLength
)
573 struct hidpp_report response
;
576 ret
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
577 CMD_GET_DEVICE_NAME_TYPE_GET_COUNT
, NULL
, 0, &response
);
580 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
587 *nameLength
= response
.fap
.params
[0];
592 static int hidpp_devicenametype_get_device_name(struct hidpp_device
*hidpp
,
593 u8 feature_index
, u8 char_index
, char *device_name
, int len_buf
)
595 struct hidpp_report response
;
599 ret
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
600 CMD_GET_DEVICE_NAME_TYPE_GET_DEVICE_NAME
, &char_index
, 1,
604 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
611 switch (response
.report_id
) {
612 case REPORT_ID_HIDPP_VERY_LONG
:
613 count
= HIDPP_REPORT_VERY_LONG_LENGTH
- 4;
615 case REPORT_ID_HIDPP_LONG
:
616 count
= HIDPP_REPORT_LONG_LENGTH
- 4;
618 case REPORT_ID_HIDPP_SHORT
:
619 count
= HIDPP_REPORT_SHORT_LENGTH
- 4;
628 for (i
= 0; i
< count
; i
++)
629 device_name
[i
] = response
.fap
.params
[i
];
634 static char *hidpp_get_device_name(struct hidpp_device
*hidpp
)
643 ret
= hidpp_root_get_feature(hidpp
, HIDPP_PAGE_GET_DEVICE_NAME_TYPE
,
644 &feature_index
, &feature_type
);
648 ret
= hidpp_devicenametype_get_count(hidpp
, feature_index
,
653 name
= kzalloc(__name_length
+ 1, GFP_KERNEL
);
657 while (index
< __name_length
) {
658 ret
= hidpp_devicenametype_get_device_name(hidpp
,
659 feature_index
, index
, name
+ index
,
660 __name_length
- index
);
668 /* include the terminating '\0' */
669 hidpp_prefix_name(&name
, __name_length
+ 1);
674 /* -------------------------------------------------------------------------- */
675 /* 0x1000: Battery level status */
676 /* -------------------------------------------------------------------------- */
678 #define HIDPP_PAGE_BATTERY_LEVEL_STATUS 0x1000
680 #define CMD_BATTERY_LEVEL_STATUS_GET_BATTERY_LEVEL_STATUS 0x00
681 #define CMD_BATTERY_LEVEL_STATUS_GET_BATTERY_CAPABILITY 0x10
683 #define EVENT_BATTERY_LEVEL_STATUS_BROADCAST 0x00
685 static int hidpp20_batterylevel_map_status_level(u8 data
[3], int *level
,
692 *next_level
= data
[1];
694 /* When discharging, we can rely on the device reported level.
695 * For all other states the device reports level 0 (unknown). Make up
699 case 0: /* discharging (in use) */
700 status
= POWER_SUPPLY_STATUS_DISCHARGING
;
703 case 1: /* recharging */
704 status
= POWER_SUPPLY_STATUS_CHARGING
;
707 case 2: /* charge in final stage */
708 status
= POWER_SUPPLY_STATUS_CHARGING
;
711 case 3: /* charge complete */
712 status
= POWER_SUPPLY_STATUS_FULL
;
713 level_override
= 100;
715 case 4: /* recharging below optimal speed */
716 status
= POWER_SUPPLY_STATUS_CHARGING
;
719 /* 5 = invalid battery type
721 7 = other charging error */
723 status
= POWER_SUPPLY_STATUS_NOT_CHARGING
;
728 if (level_override
!= 0 && *level
== 0)
729 *level
= level_override
;
734 static int hidpp20_batterylevel_get_battery_level(struct hidpp_device
*hidpp
,
740 struct hidpp_report response
;
742 u8
*params
= (u8
*)response
.fap
.params
;
744 ret
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
745 CMD_BATTERY_LEVEL_STATUS_GET_BATTERY_LEVEL_STATUS
,
748 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
755 *status
= hidpp20_batterylevel_map_status_level(params
, level
,
761 static int hidpp20_query_battery_info(struct hidpp_device
*hidpp
)
765 int status
, level
, next_level
;
767 if (hidpp
->battery
.feature_index
== 0) {
768 ret
= hidpp_root_get_feature(hidpp
,
769 HIDPP_PAGE_BATTERY_LEVEL_STATUS
,
770 &hidpp
->battery
.feature_index
,
776 ret
= hidpp20_batterylevel_get_battery_level(hidpp
,
777 hidpp
->battery
.feature_index
,
778 &status
, &level
, &next_level
);
782 hidpp
->battery
.status
= status
;
783 hidpp
->battery
.level
= level
;
788 static int hidpp20_battery_event(struct hidpp_device
*hidpp
,
791 struct hidpp_report
*report
= (struct hidpp_report
*)data
;
792 int status
, level
, next_level
;
795 if (report
->fap
.feature_index
!= hidpp
->battery
.feature_index
||
796 report
->fap
.funcindex_clientid
!= EVENT_BATTERY_LEVEL_STATUS_BROADCAST
)
799 status
= hidpp20_batterylevel_map_status_level(report
->fap
.params
,
800 &level
, &next_level
);
802 changed
= level
!= hidpp
->battery
.level
||
803 status
!= hidpp
->battery
.status
;
806 hidpp
->battery
.level
= level
;
807 hidpp
->battery
.status
= status
;
808 if (hidpp
->battery
.ps
)
809 power_supply_changed(hidpp
->battery
.ps
);
815 static enum power_supply_property hidpp_battery_props
[] = {
816 POWER_SUPPLY_PROP_STATUS
,
817 POWER_SUPPLY_PROP_CAPACITY
,
818 POWER_SUPPLY_PROP_SCOPE
,
819 POWER_SUPPLY_PROP_MODEL_NAME
,
820 POWER_SUPPLY_PROP_MANUFACTURER
,
821 POWER_SUPPLY_PROP_SERIAL_NUMBER
,
824 static int hidpp_battery_get_property(struct power_supply
*psy
,
825 enum power_supply_property psp
,
826 union power_supply_propval
*val
)
828 struct hidpp_device
*hidpp
= power_supply_get_drvdata(psy
);
832 case POWER_SUPPLY_PROP_STATUS
:
833 val
->intval
= hidpp
->battery
.status
;
835 case POWER_SUPPLY_PROP_CAPACITY
:
836 val
->intval
= hidpp
->battery
.level
;
838 case POWER_SUPPLY_PROP_SCOPE
:
839 val
->intval
= POWER_SUPPLY_SCOPE_DEVICE
;
841 case POWER_SUPPLY_PROP_MODEL_NAME
:
842 if (!strncmp(hidpp
->name
, "Logitech ", 9))
843 val
->strval
= hidpp
->name
+ 9;
845 val
->strval
= hidpp
->name
;
847 case POWER_SUPPLY_PROP_MANUFACTURER
:
848 val
->strval
= "Logitech";
850 case POWER_SUPPLY_PROP_SERIAL_NUMBER
:
851 val
->strval
= hidpp
->hid_dev
->uniq
;
861 /* -------------------------------------------------------------------------- */
862 /* 0x6010: Touchpad FW items */
863 /* -------------------------------------------------------------------------- */
865 #define HIDPP_PAGE_TOUCHPAD_FW_ITEMS 0x6010
867 #define CMD_TOUCHPAD_FW_ITEMS_SET 0x10
869 struct hidpp_touchpad_fw_items
{
871 uint8_t desired_state
;
877 * send a set state command to the device by reading the current items->state
878 * field. items is then filled with the current state.
880 static int hidpp_touchpad_fw_items_set(struct hidpp_device
*hidpp
,
882 struct hidpp_touchpad_fw_items
*items
)
884 struct hidpp_report response
;
886 u8
*params
= (u8
*)response
.fap
.params
;
888 ret
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
889 CMD_TOUCHPAD_FW_ITEMS_SET
, &items
->state
, 1, &response
);
892 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
899 items
->presence
= params
[0];
900 items
->desired_state
= params
[1];
901 items
->state
= params
[2];
902 items
->persistent
= params
[3];
907 /* -------------------------------------------------------------------------- */
908 /* 0x6100: TouchPadRawXY */
909 /* -------------------------------------------------------------------------- */
911 #define HIDPP_PAGE_TOUCHPAD_RAW_XY 0x6100
913 #define CMD_TOUCHPAD_GET_RAW_INFO 0x01
914 #define CMD_TOUCHPAD_SET_RAW_REPORT_STATE 0x21
916 #define EVENT_TOUCHPAD_RAW_XY 0x00
918 #define TOUCHPAD_RAW_XY_ORIGIN_LOWER_LEFT 0x01
919 #define TOUCHPAD_RAW_XY_ORIGIN_UPPER_LEFT 0x03
921 struct hidpp_touchpad_raw_info
{
932 struct hidpp_touchpad_raw_xy_finger
{
942 struct hidpp_touchpad_raw_xy
{
944 struct hidpp_touchpad_raw_xy_finger fingers
[2];
951 static int hidpp_touchpad_get_raw_info(struct hidpp_device
*hidpp
,
952 u8 feature_index
, struct hidpp_touchpad_raw_info
*raw_info
)
954 struct hidpp_report response
;
956 u8
*params
= (u8
*)response
.fap
.params
;
958 ret
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
959 CMD_TOUCHPAD_GET_RAW_INFO
, NULL
, 0, &response
);
962 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
969 raw_info
->x_size
= get_unaligned_be16(¶ms
[0]);
970 raw_info
->y_size
= get_unaligned_be16(¶ms
[2]);
971 raw_info
->z_range
= params
[4];
972 raw_info
->area_range
= params
[5];
973 raw_info
->maxcontacts
= params
[7];
974 raw_info
->origin
= params
[8];
975 /* res is given in unit per inch */
976 raw_info
->res
= get_unaligned_be16(¶ms
[13]) * 2 / 51;
981 static int hidpp_touchpad_set_raw_report_state(struct hidpp_device
*hidpp_dev
,
982 u8 feature_index
, bool send_raw_reports
,
983 bool sensor_enhanced_settings
)
985 struct hidpp_report response
;
990 * bit 1 - 16bit Z, no area
991 * bit 2 - enhanced sensitivity
992 * bit 3 - width, height (4 bits each) instead of area
993 * bit 4 - send raw + gestures (degrades smoothness)
994 * remaining bits - reserved
996 u8 params
= send_raw_reports
| (sensor_enhanced_settings
<< 2);
998 return hidpp_send_fap_command_sync(hidpp_dev
, feature_index
,
999 CMD_TOUCHPAD_SET_RAW_REPORT_STATE
, ¶ms
, 1, &response
);
1002 static void hidpp_touchpad_touch_event(u8
*data
,
1003 struct hidpp_touchpad_raw_xy_finger
*finger
)
1005 u8 x_m
= data
[0] << 2;
1006 u8 y_m
= data
[2] << 2;
1008 finger
->x
= x_m
<< 6 | data
[1];
1009 finger
->y
= y_m
<< 6 | data
[3];
1011 finger
->contact_type
= data
[0] >> 6;
1012 finger
->contact_status
= data
[2] >> 6;
1014 finger
->z
= data
[4];
1015 finger
->area
= data
[5];
1016 finger
->finger_id
= data
[6] >> 4;
1019 static void hidpp_touchpad_raw_xy_event(struct hidpp_device
*hidpp_dev
,
1020 u8
*data
, struct hidpp_touchpad_raw_xy
*raw_xy
)
1022 memset(raw_xy
, 0, sizeof(struct hidpp_touchpad_raw_xy
));
1023 raw_xy
->end_of_frame
= data
[8] & 0x01;
1024 raw_xy
->spurious_flag
= (data
[8] >> 1) & 0x01;
1025 raw_xy
->finger_count
= data
[15] & 0x0f;
1026 raw_xy
->button
= (data
[8] >> 2) & 0x01;
1028 if (raw_xy
->finger_count
) {
1029 hidpp_touchpad_touch_event(&data
[2], &raw_xy
->fingers
[0]);
1030 hidpp_touchpad_touch_event(&data
[9], &raw_xy
->fingers
[1]);
1034 /* -------------------------------------------------------------------------- */
1035 /* 0x8123: Force feedback support */
1036 /* -------------------------------------------------------------------------- */
1038 #define HIDPP_FF_GET_INFO 0x01
1039 #define HIDPP_FF_RESET_ALL 0x11
1040 #define HIDPP_FF_DOWNLOAD_EFFECT 0x21
1041 #define HIDPP_FF_SET_EFFECT_STATE 0x31
1042 #define HIDPP_FF_DESTROY_EFFECT 0x41
1043 #define HIDPP_FF_GET_APERTURE 0x51
1044 #define HIDPP_FF_SET_APERTURE 0x61
1045 #define HIDPP_FF_GET_GLOBAL_GAINS 0x71
1046 #define HIDPP_FF_SET_GLOBAL_GAINS 0x81
1048 #define HIDPP_FF_EFFECT_STATE_GET 0x00
1049 #define HIDPP_FF_EFFECT_STATE_STOP 0x01
1050 #define HIDPP_FF_EFFECT_STATE_PLAY 0x02
1051 #define HIDPP_FF_EFFECT_STATE_PAUSE 0x03
1053 #define HIDPP_FF_EFFECT_CONSTANT 0x00
1054 #define HIDPP_FF_EFFECT_PERIODIC_SINE 0x01
1055 #define HIDPP_FF_EFFECT_PERIODIC_SQUARE 0x02
1056 #define HIDPP_FF_EFFECT_PERIODIC_TRIANGLE 0x03
1057 #define HIDPP_FF_EFFECT_PERIODIC_SAWTOOTHUP 0x04
1058 #define HIDPP_FF_EFFECT_PERIODIC_SAWTOOTHDOWN 0x05
1059 #define HIDPP_FF_EFFECT_SPRING 0x06
1060 #define HIDPP_FF_EFFECT_DAMPER 0x07
1061 #define HIDPP_FF_EFFECT_FRICTION 0x08
1062 #define HIDPP_FF_EFFECT_INERTIA 0x09
1063 #define HIDPP_FF_EFFECT_RAMP 0x0A
1065 #define HIDPP_FF_EFFECT_AUTOSTART 0x80
1067 #define HIDPP_FF_EFFECTID_NONE -1
1068 #define HIDPP_FF_EFFECTID_AUTOCENTER -2
1070 #define HIDPP_FF_MAX_PARAMS 20
1071 #define HIDPP_FF_RESERVED_SLOTS 1
1073 struct hidpp_ff_private_data
{
1074 struct hidpp_device
*hidpp
;
1082 struct workqueue_struct
*wq
;
1083 atomic_t workqueue_size
;
1086 struct hidpp_ff_work_data
{
1087 struct work_struct work
;
1088 struct hidpp_ff_private_data
*data
;
1091 u8 params
[HIDPP_FF_MAX_PARAMS
];
1095 static const signed short hiddpp_ff_effects
[] = {
1110 static const signed short hiddpp_ff_effects_v2
[] = {
1117 static const u8 HIDPP_FF_CONDITION_CMDS
[] = {
1118 HIDPP_FF_EFFECT_SPRING
,
1119 HIDPP_FF_EFFECT_FRICTION
,
1120 HIDPP_FF_EFFECT_DAMPER
,
1121 HIDPP_FF_EFFECT_INERTIA
1124 static const char *HIDPP_FF_CONDITION_NAMES
[] = {
1132 static u8
hidpp_ff_find_effect(struct hidpp_ff_private_data
*data
, int effect_id
)
1136 for (i
= 0; i
< data
->num_effects
; i
++)
1137 if (data
->effect_ids
[i
] == effect_id
)
1143 static void hidpp_ff_work_handler(struct work_struct
*w
)
1145 struct hidpp_ff_work_data
*wd
= container_of(w
, struct hidpp_ff_work_data
, work
);
1146 struct hidpp_ff_private_data
*data
= wd
->data
;
1147 struct hidpp_report response
;
1151 /* add slot number if needed */
1152 switch (wd
->effect_id
) {
1153 case HIDPP_FF_EFFECTID_AUTOCENTER
:
1154 wd
->params
[0] = data
->slot_autocenter
;
1156 case HIDPP_FF_EFFECTID_NONE
:
1157 /* leave slot as zero */
1160 /* find current slot for effect */
1161 wd
->params
[0] = hidpp_ff_find_effect(data
, wd
->effect_id
);
1165 /* send command and wait for reply */
1166 ret
= hidpp_send_fap_command_sync(data
->hidpp
, data
->feature_index
,
1167 wd
->command
, wd
->params
, wd
->size
, &response
);
1170 hid_err(data
->hidpp
->hid_dev
, "Failed to send command to device!\n");
1174 /* parse return data */
1175 switch (wd
->command
) {
1176 case HIDPP_FF_DOWNLOAD_EFFECT
:
1177 slot
= response
.fap
.params
[0];
1178 if (slot
> 0 && slot
<= data
->num_effects
) {
1179 if (wd
->effect_id
>= 0)
1180 /* regular effect uploaded */
1181 data
->effect_ids
[slot
-1] = wd
->effect_id
;
1182 else if (wd
->effect_id
>= HIDPP_FF_EFFECTID_AUTOCENTER
)
1183 /* autocenter spring uploaded */
1184 data
->slot_autocenter
= slot
;
1187 case HIDPP_FF_DESTROY_EFFECT
:
1188 if (wd
->effect_id
>= 0)
1189 /* regular effect destroyed */
1190 data
->effect_ids
[wd
->params
[0]-1] = -1;
1191 else if (wd
->effect_id
>= HIDPP_FF_EFFECTID_AUTOCENTER
)
1192 /* autocenter spring destoyed */
1193 data
->slot_autocenter
= 0;
1195 case HIDPP_FF_SET_GLOBAL_GAINS
:
1196 data
->gain
= (wd
->params
[0] << 8) + wd
->params
[1];
1198 case HIDPP_FF_SET_APERTURE
:
1199 data
->range
= (wd
->params
[0] << 8) + wd
->params
[1];
1202 /* no action needed */
1207 atomic_dec(&data
->workqueue_size
);
1211 static int hidpp_ff_queue_work(struct hidpp_ff_private_data
*data
, int effect_id
, u8 command
, u8
*params
, u8 size
)
1213 struct hidpp_ff_work_data
*wd
= kzalloc(sizeof(*wd
), GFP_KERNEL
);
1219 INIT_WORK(&wd
->work
, hidpp_ff_work_handler
);
1222 wd
->effect_id
= effect_id
;
1223 wd
->command
= command
;
1225 memcpy(wd
->params
, params
, size
);
1227 atomic_inc(&data
->workqueue_size
);
1228 queue_work(data
->wq
, &wd
->work
);
1230 /* warn about excessive queue size */
1231 s
= atomic_read(&data
->workqueue_size
);
1232 if (s
>= 20 && s
% 20 == 0)
1233 hid_warn(data
->hidpp
->hid_dev
, "Force feedback command queue contains %d commands, causing substantial delays!", s
);
1238 static int hidpp_ff_upload_effect(struct input_dev
*dev
, struct ff_effect
*effect
, struct ff_effect
*old
)
1240 struct hidpp_ff_private_data
*data
= dev
->ff
->private;
1245 /* set common parameters */
1246 params
[2] = effect
->replay
.length
>> 8;
1247 params
[3] = effect
->replay
.length
& 255;
1248 params
[4] = effect
->replay
.delay
>> 8;
1249 params
[5] = effect
->replay
.delay
& 255;
1251 switch (effect
->type
) {
1253 force
= (effect
->u
.constant
.level
* fixp_sin16((effect
->direction
* 360) >> 16)) >> 15;
1254 params
[1] = HIDPP_FF_EFFECT_CONSTANT
;
1255 params
[6] = force
>> 8;
1256 params
[7] = force
& 255;
1257 params
[8] = effect
->u
.constant
.envelope
.attack_level
>> 7;
1258 params
[9] = effect
->u
.constant
.envelope
.attack_length
>> 8;
1259 params
[10] = effect
->u
.constant
.envelope
.attack_length
& 255;
1260 params
[11] = effect
->u
.constant
.envelope
.fade_level
>> 7;
1261 params
[12] = effect
->u
.constant
.envelope
.fade_length
>> 8;
1262 params
[13] = effect
->u
.constant
.envelope
.fade_length
& 255;
1264 dbg_hid("Uploading constant force level=%d in dir %d = %d\n",
1265 effect
->u
.constant
.level
,
1266 effect
->direction
, force
);
1267 dbg_hid(" envelope attack=(%d, %d ms) fade=(%d, %d ms)\n",
1268 effect
->u
.constant
.envelope
.attack_level
,
1269 effect
->u
.constant
.envelope
.attack_length
,
1270 effect
->u
.constant
.envelope
.fade_level
,
1271 effect
->u
.constant
.envelope
.fade_length
);
1275 switch (effect
->u
.periodic
.waveform
) {
1277 params
[1] = HIDPP_FF_EFFECT_PERIODIC_SINE
;
1280 params
[1] = HIDPP_FF_EFFECT_PERIODIC_SQUARE
;
1283 params
[1] = HIDPP_FF_EFFECT_PERIODIC_SAWTOOTHUP
;
1286 params
[1] = HIDPP_FF_EFFECT_PERIODIC_SAWTOOTHDOWN
;
1289 params
[1] = HIDPP_FF_EFFECT_PERIODIC_TRIANGLE
;
1292 hid_err(data
->hidpp
->hid_dev
, "Unexpected periodic waveform type %i!\n", effect
->u
.periodic
.waveform
);
1295 force
= (effect
->u
.periodic
.magnitude
* fixp_sin16((effect
->direction
* 360) >> 16)) >> 15;
1296 params
[6] = effect
->u
.periodic
.magnitude
>> 8;
1297 params
[7] = effect
->u
.periodic
.magnitude
& 255;
1298 params
[8] = effect
->u
.periodic
.offset
>> 8;
1299 params
[9] = effect
->u
.periodic
.offset
& 255;
1300 params
[10] = effect
->u
.periodic
.period
>> 8;
1301 params
[11] = effect
->u
.periodic
.period
& 255;
1302 params
[12] = effect
->u
.periodic
.phase
>> 8;
1303 params
[13] = effect
->u
.periodic
.phase
& 255;
1304 params
[14] = effect
->u
.periodic
.envelope
.attack_level
>> 7;
1305 params
[15] = effect
->u
.periodic
.envelope
.attack_length
>> 8;
1306 params
[16] = effect
->u
.periodic
.envelope
.attack_length
& 255;
1307 params
[17] = effect
->u
.periodic
.envelope
.fade_level
>> 7;
1308 params
[18] = effect
->u
.periodic
.envelope
.fade_length
>> 8;
1309 params
[19] = effect
->u
.periodic
.envelope
.fade_length
& 255;
1311 dbg_hid("Uploading periodic force mag=%d/dir=%d, offset=%d, period=%d ms, phase=%d\n",
1312 effect
->u
.periodic
.magnitude
, effect
->direction
,
1313 effect
->u
.periodic
.offset
,
1314 effect
->u
.periodic
.period
,
1315 effect
->u
.periodic
.phase
);
1316 dbg_hid(" envelope attack=(%d, %d ms) fade=(%d, %d ms)\n",
1317 effect
->u
.periodic
.envelope
.attack_level
,
1318 effect
->u
.periodic
.envelope
.attack_length
,
1319 effect
->u
.periodic
.envelope
.fade_level
,
1320 effect
->u
.periodic
.envelope
.fade_length
);
1324 params
[1] = HIDPP_FF_EFFECT_RAMP
;
1325 force
= (effect
->u
.ramp
.start_level
* fixp_sin16((effect
->direction
* 360) >> 16)) >> 15;
1326 params
[6] = force
>> 8;
1327 params
[7] = force
& 255;
1328 force
= (effect
->u
.ramp
.end_level
* fixp_sin16((effect
->direction
* 360) >> 16)) >> 15;
1329 params
[8] = force
>> 8;
1330 params
[9] = force
& 255;
1331 params
[10] = effect
->u
.ramp
.envelope
.attack_level
>> 7;
1332 params
[11] = effect
->u
.ramp
.envelope
.attack_length
>> 8;
1333 params
[12] = effect
->u
.ramp
.envelope
.attack_length
& 255;
1334 params
[13] = effect
->u
.ramp
.envelope
.fade_level
>> 7;
1335 params
[14] = effect
->u
.ramp
.envelope
.fade_length
>> 8;
1336 params
[15] = effect
->u
.ramp
.envelope
.fade_length
& 255;
1338 dbg_hid("Uploading ramp force level=%d -> %d in dir %d = %d\n",
1339 effect
->u
.ramp
.start_level
,
1340 effect
->u
.ramp
.end_level
,
1341 effect
->direction
, force
);
1342 dbg_hid(" envelope attack=(%d, %d ms) fade=(%d, %d ms)\n",
1343 effect
->u
.ramp
.envelope
.attack_level
,
1344 effect
->u
.ramp
.envelope
.attack_length
,
1345 effect
->u
.ramp
.envelope
.fade_level
,
1346 effect
->u
.ramp
.envelope
.fade_length
);
1352 params
[1] = HIDPP_FF_CONDITION_CMDS
[effect
->type
- FF_SPRING
];
1353 params
[6] = effect
->u
.condition
[0].left_saturation
>> 9;
1354 params
[7] = (effect
->u
.condition
[0].left_saturation
>> 1) & 255;
1355 params
[8] = effect
->u
.condition
[0].left_coeff
>> 8;
1356 params
[9] = effect
->u
.condition
[0].left_coeff
& 255;
1357 params
[10] = effect
->u
.condition
[0].deadband
>> 9;
1358 params
[11] = (effect
->u
.condition
[0].deadband
>> 1) & 255;
1359 params
[12] = effect
->u
.condition
[0].center
>> 8;
1360 params
[13] = effect
->u
.condition
[0].center
& 255;
1361 params
[14] = effect
->u
.condition
[0].right_coeff
>> 8;
1362 params
[15] = effect
->u
.condition
[0].right_coeff
& 255;
1363 params
[16] = effect
->u
.condition
[0].right_saturation
>> 9;
1364 params
[17] = (effect
->u
.condition
[0].right_saturation
>> 1) & 255;
1366 dbg_hid("Uploading %s force left coeff=%d, left sat=%d, right coeff=%d, right sat=%d\n",
1367 HIDPP_FF_CONDITION_NAMES
[effect
->type
- FF_SPRING
],
1368 effect
->u
.condition
[0].left_coeff
,
1369 effect
->u
.condition
[0].left_saturation
,
1370 effect
->u
.condition
[0].right_coeff
,
1371 effect
->u
.condition
[0].right_saturation
);
1372 dbg_hid(" deadband=%d, center=%d\n",
1373 effect
->u
.condition
[0].deadband
,
1374 effect
->u
.condition
[0].center
);
1377 hid_err(data
->hidpp
->hid_dev
, "Unexpected force type %i!\n", effect
->type
);
1381 return hidpp_ff_queue_work(data
, effect
->id
, HIDPP_FF_DOWNLOAD_EFFECT
, params
, size
);
1384 static int hidpp_ff_playback(struct input_dev
*dev
, int effect_id
, int value
)
1386 struct hidpp_ff_private_data
*data
= dev
->ff
->private;
1389 params
[1] = value
? HIDPP_FF_EFFECT_STATE_PLAY
: HIDPP_FF_EFFECT_STATE_STOP
;
1391 dbg_hid("St%sing playback of effect %d.\n", value
?"art":"opp", effect_id
);
1393 return hidpp_ff_queue_work(data
, effect_id
, HIDPP_FF_SET_EFFECT_STATE
, params
, ARRAY_SIZE(params
));
1396 static int hidpp_ff_erase_effect(struct input_dev
*dev
, int effect_id
)
1398 struct hidpp_ff_private_data
*data
= dev
->ff
->private;
1401 dbg_hid("Erasing effect %d.\n", effect_id
);
1403 return hidpp_ff_queue_work(data
, effect_id
, HIDPP_FF_DESTROY_EFFECT
, &slot
, 1);
1406 static void hidpp_ff_set_autocenter(struct input_dev
*dev
, u16 magnitude
)
1408 struct hidpp_ff_private_data
*data
= dev
->ff
->private;
1411 dbg_hid("Setting autocenter to %d.\n", magnitude
);
1413 /* start a standard spring effect */
1414 params
[1] = HIDPP_FF_EFFECT_SPRING
| HIDPP_FF_EFFECT_AUTOSTART
;
1415 /* zero delay and duration */
1416 params
[2] = params
[3] = params
[4] = params
[5] = 0;
1417 /* set coeff to 25% of saturation */
1418 params
[8] = params
[14] = magnitude
>> 11;
1419 params
[9] = params
[15] = (magnitude
>> 3) & 255;
1420 params
[6] = params
[16] = magnitude
>> 9;
1421 params
[7] = params
[17] = (magnitude
>> 1) & 255;
1422 /* zero deadband and center */
1423 params
[10] = params
[11] = params
[12] = params
[13] = 0;
1425 hidpp_ff_queue_work(data
, HIDPP_FF_EFFECTID_AUTOCENTER
, HIDPP_FF_DOWNLOAD_EFFECT
, params
, ARRAY_SIZE(params
));
1428 static void hidpp_ff_set_gain(struct input_dev
*dev
, u16 gain
)
1430 struct hidpp_ff_private_data
*data
= dev
->ff
->private;
1433 dbg_hid("Setting gain to %d.\n", gain
);
1435 params
[0] = gain
>> 8;
1436 params
[1] = gain
& 255;
1437 params
[2] = 0; /* no boost */
1440 hidpp_ff_queue_work(data
, HIDPP_FF_EFFECTID_NONE
, HIDPP_FF_SET_GLOBAL_GAINS
, params
, ARRAY_SIZE(params
));
1443 static ssize_t
hidpp_ff_range_show(struct device
*dev
, struct device_attribute
*attr
, char *buf
)
1445 struct hid_device
*hid
= to_hid_device(dev
);
1446 struct hid_input
*hidinput
= list_entry(hid
->inputs
.next
, struct hid_input
, list
);
1447 struct input_dev
*idev
= hidinput
->input
;
1448 struct hidpp_ff_private_data
*data
= idev
->ff
->private;
1450 return scnprintf(buf
, PAGE_SIZE
, "%u\n", data
->range
);
1453 static ssize_t
hidpp_ff_range_store(struct device
*dev
, struct device_attribute
*attr
, const char *buf
, size_t count
)
1455 struct hid_device
*hid
= to_hid_device(dev
);
1456 struct hid_input
*hidinput
= list_entry(hid
->inputs
.next
, struct hid_input
, list
);
1457 struct input_dev
*idev
= hidinput
->input
;
1458 struct hidpp_ff_private_data
*data
= idev
->ff
->private;
1460 int range
= simple_strtoul(buf
, NULL
, 10);
1462 range
= clamp(range
, 180, 900);
1464 params
[0] = range
>> 8;
1465 params
[1] = range
& 0x00FF;
1467 hidpp_ff_queue_work(data
, -1, HIDPP_FF_SET_APERTURE
, params
, ARRAY_SIZE(params
));
1472 static DEVICE_ATTR(range
, S_IRUSR
| S_IWUSR
| S_IRGRP
| S_IWGRP
| S_IROTH
, hidpp_ff_range_show
, hidpp_ff_range_store
);
1474 static void hidpp_ff_destroy(struct ff_device
*ff
)
1476 struct hidpp_ff_private_data
*data
= ff
->private;
1478 kfree(data
->effect_ids
);
1481 static int hidpp_ff_init(struct hidpp_device
*hidpp
, u8 feature_index
)
1483 struct hid_device
*hid
= hidpp
->hid_dev
;
1484 struct hid_input
*hidinput
= list_entry(hid
->inputs
.next
, struct hid_input
, list
);
1485 struct input_dev
*dev
= hidinput
->input
;
1486 const struct usb_device_descriptor
*udesc
= &(hid_to_usb_dev(hid
)->descriptor
);
1487 const u16 bcdDevice
= le16_to_cpu(udesc
->bcdDevice
);
1488 struct ff_device
*ff
;
1489 struct hidpp_report response
;
1490 struct hidpp_ff_private_data
*data
;
1491 int error
, j
, num_slots
;
1495 hid_err(hid
, "Struct input_dev not set!\n");
1499 /* Get firmware release */
1500 version
= bcdDevice
& 255;
1502 /* Set supported force feedback capabilities */
1503 for (j
= 0; hiddpp_ff_effects
[j
] >= 0; j
++)
1504 set_bit(hiddpp_ff_effects
[j
], dev
->ffbit
);
1506 for (j
= 0; hiddpp_ff_effects_v2
[j
] >= 0; j
++)
1507 set_bit(hiddpp_ff_effects_v2
[j
], dev
->ffbit
);
1509 /* Read number of slots available in device */
1510 error
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
1511 HIDPP_FF_GET_INFO
, NULL
, 0, &response
);
1515 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
1520 num_slots
= response
.fap
.params
[0] - HIDPP_FF_RESERVED_SLOTS
;
1522 error
= input_ff_create(dev
, num_slots
);
1525 hid_err(dev
, "Failed to create FF device!\n");
1529 data
= kzalloc(sizeof(*data
), GFP_KERNEL
);
1532 data
->effect_ids
= kcalloc(num_slots
, sizeof(int), GFP_KERNEL
);
1533 if (!data
->effect_ids
) {
1537 data
->hidpp
= hidpp
;
1538 data
->feature_index
= feature_index
;
1539 data
->version
= version
;
1540 data
->slot_autocenter
= 0;
1541 data
->num_effects
= num_slots
;
1542 for (j
= 0; j
< num_slots
; j
++)
1543 data
->effect_ids
[j
] = -1;
1548 ff
->upload
= hidpp_ff_upload_effect
;
1549 ff
->erase
= hidpp_ff_erase_effect
;
1550 ff
->playback
= hidpp_ff_playback
;
1551 ff
->set_gain
= hidpp_ff_set_gain
;
1552 ff
->set_autocenter
= hidpp_ff_set_autocenter
;
1553 ff
->destroy
= hidpp_ff_destroy
;
1556 /* reset all forces */
1557 error
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
1558 HIDPP_FF_RESET_ALL
, NULL
, 0, &response
);
1560 /* Read current Range */
1561 error
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
1562 HIDPP_FF_GET_APERTURE
, NULL
, 0, &response
);
1564 hid_warn(hidpp
->hid_dev
, "Failed to read range from device!\n");
1565 data
->range
= error
? 900 : get_unaligned_be16(&response
.fap
.params
[0]);
1567 /* Create sysfs interface */
1568 error
= device_create_file(&(hidpp
->hid_dev
->dev
), &dev_attr_range
);
1570 hid_warn(hidpp
->hid_dev
, "Unable to create sysfs interface for \"range\", errno %d!\n", error
);
1572 /* Read the current gain values */
1573 error
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
1574 HIDPP_FF_GET_GLOBAL_GAINS
, NULL
, 0, &response
);
1576 hid_warn(hidpp
->hid_dev
, "Failed to read gain values from device!\n");
1577 data
->gain
= error
? 0xffff : get_unaligned_be16(&response
.fap
.params
[0]);
1578 /* ignore boost value at response.fap.params[2] */
1580 /* init the hardware command queue */
1581 data
->wq
= create_singlethread_workqueue("hidpp-ff-sendqueue");
1582 atomic_set(&data
->workqueue_size
, 0);
1584 /* initialize with zero autocenter to get wheel in usable state */
1585 hidpp_ff_set_autocenter(dev
, 0);
1587 hid_info(hid
, "Force feeback support loaded (firmware release %d).\n", version
);
1592 static int hidpp_ff_deinit(struct hid_device
*hid
)
1594 struct hid_input
*hidinput
= list_entry(hid
->inputs
.next
, struct hid_input
, list
);
1595 struct input_dev
*dev
= hidinput
->input
;
1596 struct hidpp_ff_private_data
*data
;
1599 hid_err(hid
, "Struct input_dev not found!\n");
1603 hid_info(hid
, "Unloading HID++ force feedback.\n");
1604 data
= dev
->ff
->private;
1606 hid_err(hid
, "Private data not found!\n");
1610 destroy_workqueue(data
->wq
);
1611 device_remove_file(&hid
->dev
, &dev_attr_range
);
1617 /* ************************************************************************** */
1619 /* Device Support */
1621 /* ************************************************************************** */
1623 /* -------------------------------------------------------------------------- */
1624 /* Touchpad HID++ devices */
1625 /* -------------------------------------------------------------------------- */
1627 #define WTP_MANUAL_RESOLUTION 39
1630 struct input_dev
*input
;
1633 u8 mt_feature_index
;
1634 u8 button_feature_index
;
1637 unsigned int resolution
;
1640 static int wtp_input_mapping(struct hid_device
*hdev
, struct hid_input
*hi
,
1641 struct hid_field
*field
, struct hid_usage
*usage
,
1642 unsigned long **bit
, int *max
)
1647 static void wtp_populate_input(struct hidpp_device
*hidpp
,
1648 struct input_dev
*input_dev
, bool origin_is_hid_core
)
1650 struct wtp_data
*wd
= hidpp
->private_data
;
1652 __set_bit(EV_ABS
, input_dev
->evbit
);
1653 __set_bit(EV_KEY
, input_dev
->evbit
);
1654 __clear_bit(EV_REL
, input_dev
->evbit
);
1655 __clear_bit(EV_LED
, input_dev
->evbit
);
1657 input_set_abs_params(input_dev
, ABS_MT_POSITION_X
, 0, wd
->x_size
, 0, 0);
1658 input_abs_set_res(input_dev
, ABS_MT_POSITION_X
, wd
->resolution
);
1659 input_set_abs_params(input_dev
, ABS_MT_POSITION_Y
, 0, wd
->y_size
, 0, 0);
1660 input_abs_set_res(input_dev
, ABS_MT_POSITION_Y
, wd
->resolution
);
1662 /* Max pressure is not given by the devices, pick one */
1663 input_set_abs_params(input_dev
, ABS_MT_PRESSURE
, 0, 50, 0, 0);
1665 input_set_capability(input_dev
, EV_KEY
, BTN_LEFT
);
1667 if (hidpp
->quirks
& HIDPP_QUIRK_WTP_PHYSICAL_BUTTONS
)
1668 input_set_capability(input_dev
, EV_KEY
, BTN_RIGHT
);
1670 __set_bit(INPUT_PROP_BUTTONPAD
, input_dev
->propbit
);
1672 input_mt_init_slots(input_dev
, wd
->maxcontacts
, INPUT_MT_POINTER
|
1673 INPUT_MT_DROP_UNUSED
);
1675 wd
->input
= input_dev
;
1678 static void wtp_touch_event(struct wtp_data
*wd
,
1679 struct hidpp_touchpad_raw_xy_finger
*touch_report
)
1683 if (!touch_report
->finger_id
|| touch_report
->contact_type
)
1684 /* no actual data */
1687 slot
= input_mt_get_slot_by_key(wd
->input
, touch_report
->finger_id
);
1689 input_mt_slot(wd
->input
, slot
);
1690 input_mt_report_slot_state(wd
->input
, MT_TOOL_FINGER
,
1691 touch_report
->contact_status
);
1692 if (touch_report
->contact_status
) {
1693 input_event(wd
->input
, EV_ABS
, ABS_MT_POSITION_X
,
1695 input_event(wd
->input
, EV_ABS
, ABS_MT_POSITION_Y
,
1696 wd
->flip_y
? wd
->y_size
- touch_report
->y
:
1698 input_event(wd
->input
, EV_ABS
, ABS_MT_PRESSURE
,
1699 touch_report
->area
);
1703 static void wtp_send_raw_xy_event(struct hidpp_device
*hidpp
,
1704 struct hidpp_touchpad_raw_xy
*raw
)
1706 struct wtp_data
*wd
= hidpp
->private_data
;
1709 for (i
= 0; i
< 2; i
++)
1710 wtp_touch_event(wd
, &(raw
->fingers
[i
]));
1712 if (raw
->end_of_frame
&&
1713 !(hidpp
->quirks
& HIDPP_QUIRK_WTP_PHYSICAL_BUTTONS
))
1714 input_event(wd
->input
, EV_KEY
, BTN_LEFT
, raw
->button
);
1716 if (raw
->end_of_frame
|| raw
->finger_count
<= 2) {
1717 input_mt_sync_frame(wd
->input
);
1718 input_sync(wd
->input
);
1722 static int wtp_mouse_raw_xy_event(struct hidpp_device
*hidpp
, u8
*data
)
1724 struct wtp_data
*wd
= hidpp
->private_data
;
1725 u8 c1_area
= ((data
[7] & 0xf) * (data
[7] & 0xf) +
1726 (data
[7] >> 4) * (data
[7] >> 4)) / 2;
1727 u8 c2_area
= ((data
[13] & 0xf) * (data
[13] & 0xf) +
1728 (data
[13] >> 4) * (data
[13] >> 4)) / 2;
1729 struct hidpp_touchpad_raw_xy raw
= {
1730 .timestamp
= data
[1],
1734 .contact_status
= !!data
[7],
1735 .x
= get_unaligned_le16(&data
[3]),
1736 .y
= get_unaligned_le16(&data
[5]),
1739 .finger_id
= data
[2],
1742 .contact_status
= !!data
[13],
1743 .x
= get_unaligned_le16(&data
[9]),
1744 .y
= get_unaligned_le16(&data
[11]),
1747 .finger_id
= data
[8],
1750 .finger_count
= wd
->maxcontacts
,
1752 .end_of_frame
= (data
[0] >> 7) == 0,
1753 .button
= data
[0] & 0x01,
1756 wtp_send_raw_xy_event(hidpp
, &raw
);
1761 static int wtp_raw_event(struct hid_device
*hdev
, u8
*data
, int size
)
1763 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
1764 struct wtp_data
*wd
= hidpp
->private_data
;
1765 struct hidpp_report
*report
= (struct hidpp_report
*)data
;
1766 struct hidpp_touchpad_raw_xy raw
;
1768 if (!wd
|| !wd
->input
)
1774 hid_err(hdev
, "Received HID report of bad size (%d)",
1778 if (hidpp
->quirks
& HIDPP_QUIRK_WTP_PHYSICAL_BUTTONS
) {
1779 input_event(wd
->input
, EV_KEY
, BTN_LEFT
,
1780 !!(data
[1] & 0x01));
1781 input_event(wd
->input
, EV_KEY
, BTN_RIGHT
,
1782 !!(data
[1] & 0x02));
1783 input_sync(wd
->input
);
1788 return wtp_mouse_raw_xy_event(hidpp
, &data
[7]);
1790 case REPORT_ID_HIDPP_LONG
:
1791 /* size is already checked in hidpp_raw_event. */
1792 if ((report
->fap
.feature_index
!= wd
->mt_feature_index
) ||
1793 (report
->fap
.funcindex_clientid
!= EVENT_TOUCHPAD_RAW_XY
))
1795 hidpp_touchpad_raw_xy_event(hidpp
, data
+ 4, &raw
);
1797 wtp_send_raw_xy_event(hidpp
, &raw
);
1804 static int wtp_get_config(struct hidpp_device
*hidpp
)
1806 struct wtp_data
*wd
= hidpp
->private_data
;
1807 struct hidpp_touchpad_raw_info raw_info
= {0};
1811 ret
= hidpp_root_get_feature(hidpp
, HIDPP_PAGE_TOUCHPAD_RAW_XY
,
1812 &wd
->mt_feature_index
, &feature_type
);
1814 /* means that the device is not powered up */
1817 ret
= hidpp_touchpad_get_raw_info(hidpp
, wd
->mt_feature_index
,
1822 wd
->x_size
= raw_info
.x_size
;
1823 wd
->y_size
= raw_info
.y_size
;
1824 wd
->maxcontacts
= raw_info
.maxcontacts
;
1825 wd
->flip_y
= raw_info
.origin
== TOUCHPAD_RAW_XY_ORIGIN_LOWER_LEFT
;
1826 wd
->resolution
= raw_info
.res
;
1827 if (!wd
->resolution
)
1828 wd
->resolution
= WTP_MANUAL_RESOLUTION
;
1833 static int wtp_allocate(struct hid_device
*hdev
, const struct hid_device_id
*id
)
1835 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
1836 struct wtp_data
*wd
;
1838 wd
= devm_kzalloc(&hdev
->dev
, sizeof(struct wtp_data
),
1843 hidpp
->private_data
= wd
;
1848 static int wtp_connect(struct hid_device
*hdev
, bool connected
)
1850 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
1851 struct wtp_data
*wd
= hidpp
->private_data
;
1855 ret
= wtp_get_config(hidpp
);
1857 hid_err(hdev
, "Can not get wtp config: %d\n", ret
);
1862 return hidpp_touchpad_set_raw_report_state(hidpp
, wd
->mt_feature_index
,
1866 /* ------------------------------------------------------------------------- */
1867 /* Logitech M560 devices */
1868 /* ------------------------------------------------------------------------- */
1871 * Logitech M560 protocol overview
1873 * The Logitech M560 mouse, is designed for windows 8. When the middle and/or
1874 * the sides buttons are pressed, it sends some keyboard keys events
1875 * instead of buttons ones.
1876 * To complicate things further, the middle button keys sequence
1877 * is different from the odd press and the even press.
1879 * forward button -> Super_R
1880 * backward button -> Super_L+'d' (press only)
1881 * middle button -> 1st time: Alt_L+SuperL+XF86TouchpadOff (press only)
1882 * 2nd time: left-click (press only)
1883 * NB: press-only means that when the button is pressed, the
1884 * KeyPress/ButtonPress and KeyRelease/ButtonRelease events are generated
1885 * together sequentially; instead when the button is released, no event is
1889 * 10<xx>0a 3500af03 (where <xx> is the mouse id),
1890 * the mouse reacts differently:
1891 * - it never sends a keyboard key event
1892 * - for the three mouse button it sends:
1893 * middle button press 11<xx>0a 3500af00...
1894 * side 1 button (forward) press 11<xx>0a 3500b000...
1895 * side 2 button (backward) press 11<xx>0a 3500ae00...
1896 * middle/side1/side2 button release 11<xx>0a 35000000...
1899 static const u8 m560_config_parameter
[] = {0x00, 0xaf, 0x03};
1901 struct m560_private_data
{
1902 struct input_dev
*input
;
1905 /* how buttons are mapped in the report */
1906 #define M560_MOUSE_BTN_LEFT 0x01
1907 #define M560_MOUSE_BTN_RIGHT 0x02
1908 #define M560_MOUSE_BTN_WHEEL_LEFT 0x08
1909 #define M560_MOUSE_BTN_WHEEL_RIGHT 0x10
1911 #define M560_SUB_ID 0x0a
1912 #define M560_BUTTON_MODE_REGISTER 0x35
1914 static int m560_send_config_command(struct hid_device
*hdev
, bool connected
)
1916 struct hidpp_report response
;
1917 struct hidpp_device
*hidpp_dev
;
1919 hidpp_dev
= hid_get_drvdata(hdev
);
1921 return hidpp_send_rap_command_sync(
1923 REPORT_ID_HIDPP_SHORT
,
1925 M560_BUTTON_MODE_REGISTER
,
1926 (u8
*)m560_config_parameter
,
1927 sizeof(m560_config_parameter
),
1932 static int m560_allocate(struct hid_device
*hdev
)
1934 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
1935 struct m560_private_data
*d
;
1937 d
= devm_kzalloc(&hdev
->dev
, sizeof(struct m560_private_data
),
1942 hidpp
->private_data
= d
;
1947 static int m560_raw_event(struct hid_device
*hdev
, u8
*data
, int size
)
1949 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
1950 struct m560_private_data
*mydata
= hidpp
->private_data
;
1953 if (!mydata
|| !mydata
->input
) {
1954 hid_err(hdev
, "error in parameter\n");
1959 hid_err(hdev
, "error in report\n");
1963 if (data
[0] == REPORT_ID_HIDPP_LONG
&&
1964 data
[2] == M560_SUB_ID
&& data
[6] == 0x00) {
1966 * m560 mouse report for middle, forward and backward button
1969 * data[1] = device-id
1971 * data[5] = 0xaf -> middle
1974 * 0x00 -> release all
1980 input_report_key(mydata
->input
, BTN_MIDDLE
, 1);
1983 input_report_key(mydata
->input
, BTN_FORWARD
, 1);
1986 input_report_key(mydata
->input
, BTN_BACK
, 1);
1989 input_report_key(mydata
->input
, BTN_BACK
, 0);
1990 input_report_key(mydata
->input
, BTN_FORWARD
, 0);
1991 input_report_key(mydata
->input
, BTN_MIDDLE
, 0);
1994 hid_err(hdev
, "error in report\n");
1997 input_sync(mydata
->input
);
1999 } else if (data
[0] == 0x02) {
2001 * Logitech M560 mouse report
2003 * data[0] = type (0x02)
2004 * data[1..2] = buttons
2011 input_report_key(mydata
->input
, BTN_LEFT
,
2012 !!(data
[1] & M560_MOUSE_BTN_LEFT
));
2013 input_report_key(mydata
->input
, BTN_RIGHT
,
2014 !!(data
[1] & M560_MOUSE_BTN_RIGHT
));
2016 if (data
[1] & M560_MOUSE_BTN_WHEEL_LEFT
)
2017 input_report_rel(mydata
->input
, REL_HWHEEL
, -1);
2018 else if (data
[1] & M560_MOUSE_BTN_WHEEL_RIGHT
)
2019 input_report_rel(mydata
->input
, REL_HWHEEL
, 1);
2021 v
= hid_snto32(hid_field_extract(hdev
, data
+3, 0, 12), 12);
2022 input_report_rel(mydata
->input
, REL_X
, v
);
2024 v
= hid_snto32(hid_field_extract(hdev
, data
+3, 12, 12), 12);
2025 input_report_rel(mydata
->input
, REL_Y
, v
);
2027 v
= hid_snto32(data
[6], 8);
2028 input_report_rel(mydata
->input
, REL_WHEEL
, v
);
2030 input_sync(mydata
->input
);
2036 static void m560_populate_input(struct hidpp_device
*hidpp
,
2037 struct input_dev
*input_dev
, bool origin_is_hid_core
)
2039 struct m560_private_data
*mydata
= hidpp
->private_data
;
2041 mydata
->input
= input_dev
;
2043 __set_bit(EV_KEY
, mydata
->input
->evbit
);
2044 __set_bit(BTN_MIDDLE
, mydata
->input
->keybit
);
2045 __set_bit(BTN_RIGHT
, mydata
->input
->keybit
);
2046 __set_bit(BTN_LEFT
, mydata
->input
->keybit
);
2047 __set_bit(BTN_BACK
, mydata
->input
->keybit
);
2048 __set_bit(BTN_FORWARD
, mydata
->input
->keybit
);
2050 __set_bit(EV_REL
, mydata
->input
->evbit
);
2051 __set_bit(REL_X
, mydata
->input
->relbit
);
2052 __set_bit(REL_Y
, mydata
->input
->relbit
);
2053 __set_bit(REL_WHEEL
, mydata
->input
->relbit
);
2054 __set_bit(REL_HWHEEL
, mydata
->input
->relbit
);
2057 static int m560_input_mapping(struct hid_device
*hdev
, struct hid_input
*hi
,
2058 struct hid_field
*field
, struct hid_usage
*usage
,
2059 unsigned long **bit
, int *max
)
2064 /* ------------------------------------------------------------------------- */
2065 /* Logitech K400 devices */
2066 /* ------------------------------------------------------------------------- */
2069 * The Logitech K400 keyboard has an embedded touchpad which is seen
2070 * as a mouse from the OS point of view. There is a hardware shortcut to disable
2071 * tap-to-click but the setting is not remembered accross reset, annoying some
2074 * We can toggle this feature from the host by using the feature 0x6010:
2078 struct k400_private_data
{
2082 static int k400_disable_tap_to_click(struct hidpp_device
*hidpp
)
2084 struct k400_private_data
*k400
= hidpp
->private_data
;
2085 struct hidpp_touchpad_fw_items items
= {};
2089 if (!k400
->feature_index
) {
2090 ret
= hidpp_root_get_feature(hidpp
,
2091 HIDPP_PAGE_TOUCHPAD_FW_ITEMS
,
2092 &k400
->feature_index
, &feature_type
);
2094 /* means that the device is not powered up */
2098 ret
= hidpp_touchpad_fw_items_set(hidpp
, k400
->feature_index
, &items
);
2105 static int k400_allocate(struct hid_device
*hdev
)
2107 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2108 struct k400_private_data
*k400
;
2110 k400
= devm_kzalloc(&hdev
->dev
, sizeof(struct k400_private_data
),
2115 hidpp
->private_data
= k400
;
2120 static int k400_connect(struct hid_device
*hdev
, bool connected
)
2122 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2124 if (!disable_tap_to_click
)
2127 return k400_disable_tap_to_click(hidpp
);
2130 /* ------------------------------------------------------------------------- */
2131 /* Logitech G920 Driving Force Racing Wheel for Xbox One */
2132 /* ------------------------------------------------------------------------- */
2134 #define HIDPP_PAGE_G920_FORCE_FEEDBACK 0x8123
2136 static int g920_get_config(struct hidpp_device
*hidpp
)
2142 /* Find feature and store for later use */
2143 ret
= hidpp_root_get_feature(hidpp
, HIDPP_PAGE_G920_FORCE_FEEDBACK
,
2144 &feature_index
, &feature_type
);
2148 ret
= hidpp_ff_init(hidpp
, feature_index
);
2150 hid_warn(hidpp
->hid_dev
, "Unable to initialize force feedback support, errno %d\n",
2156 /* -------------------------------------------------------------------------- */
2157 /* Generic HID++ devices */
2158 /* -------------------------------------------------------------------------- */
2160 static int hidpp_input_mapping(struct hid_device
*hdev
, struct hid_input
*hi
,
2161 struct hid_field
*field
, struct hid_usage
*usage
,
2162 unsigned long **bit
, int *max
)
2164 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2166 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_WTP
)
2167 return wtp_input_mapping(hdev
, hi
, field
, usage
, bit
, max
);
2168 else if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_M560
&&
2169 field
->application
!= HID_GD_MOUSE
)
2170 return m560_input_mapping(hdev
, hi
, field
, usage
, bit
, max
);
2175 static int hidpp_input_mapped(struct hid_device
*hdev
, struct hid_input
*hi
,
2176 struct hid_field
*field
, struct hid_usage
*usage
,
2177 unsigned long **bit
, int *max
)
2179 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2181 /* Ensure that Logitech G920 is not given a default fuzz/flat value */
2182 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_G920
) {
2183 if (usage
->type
== EV_ABS
&& (usage
->code
== ABS_X
||
2184 usage
->code
== ABS_Y
|| usage
->code
== ABS_Z
||
2185 usage
->code
== ABS_RZ
)) {
2186 field
->application
= HID_GD_MULTIAXIS
;
2194 static void hidpp_populate_input(struct hidpp_device
*hidpp
,
2195 struct input_dev
*input
, bool origin_is_hid_core
)
2197 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_WTP
)
2198 wtp_populate_input(hidpp
, input
, origin_is_hid_core
);
2199 else if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_M560
)
2200 m560_populate_input(hidpp
, input
, origin_is_hid_core
);
2203 static int hidpp_input_configured(struct hid_device
*hdev
,
2204 struct hid_input
*hidinput
)
2206 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2207 struct input_dev
*input
= hidinput
->input
;
2209 hidpp_populate_input(hidpp
, input
, true);
2214 static int hidpp_raw_hidpp_event(struct hidpp_device
*hidpp
, u8
*data
,
2217 struct hidpp_report
*question
= hidpp
->send_receive_buf
;
2218 struct hidpp_report
*answer
= hidpp
->send_receive_buf
;
2219 struct hidpp_report
*report
= (struct hidpp_report
*)data
;
2223 * If the mutex is locked then we have a pending answer from a
2224 * previously sent command.
2226 if (unlikely(mutex_is_locked(&hidpp
->send_mutex
))) {
2228 * Check for a correct hidpp20 answer or the corresponding
2231 if (hidpp_match_answer(question
, report
) ||
2232 hidpp_match_error(question
, report
)) {
2234 hidpp
->answer_available
= true;
2235 wake_up(&hidpp
->wait
);
2237 * This was an answer to a command that this driver sent
2238 * We return 1 to hid-core to avoid forwarding the
2239 * command upstream as it has been treated by the driver
2246 if (unlikely(hidpp_report_is_connect_event(report
))) {
2247 atomic_set(&hidpp
->connected
,
2248 !(report
->rap
.params
[0] & (1 << 6)));
2249 if (schedule_work(&hidpp
->work
) == 0)
2250 dbg_hid("%s: connect event already queued\n", __func__
);
2254 if (hidpp
->capabilities
& HIDPP_CAPABILITY_HIDPP20_BATTERY
) {
2255 ret
= hidpp20_battery_event(hidpp
, data
, size
);
2263 static int hidpp_raw_event(struct hid_device
*hdev
, struct hid_report
*report
,
2266 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2269 /* Generic HID++ processing. */
2271 case REPORT_ID_HIDPP_VERY_LONG
:
2272 if (size
!= HIDPP_REPORT_VERY_LONG_LENGTH
) {
2273 hid_err(hdev
, "received hid++ report of bad size (%d)",
2277 ret
= hidpp_raw_hidpp_event(hidpp
, data
, size
);
2279 case REPORT_ID_HIDPP_LONG
:
2280 if (size
!= HIDPP_REPORT_LONG_LENGTH
) {
2281 hid_err(hdev
, "received hid++ report of bad size (%d)",
2285 ret
= hidpp_raw_hidpp_event(hidpp
, data
, size
);
2287 case REPORT_ID_HIDPP_SHORT
:
2288 if (size
!= HIDPP_REPORT_SHORT_LENGTH
) {
2289 hid_err(hdev
, "received hid++ report of bad size (%d)",
2293 ret
= hidpp_raw_hidpp_event(hidpp
, data
, size
);
2297 /* If no report is available for further processing, skip calling
2298 * raw_event of subclasses. */
2302 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_WTP
)
2303 return wtp_raw_event(hdev
, data
, size
);
2304 else if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_M560
)
2305 return m560_raw_event(hdev
, data
, size
);
2310 static int hidpp_initialize_battery(struct hidpp_device
*hidpp
)
2312 static atomic_t battery_no
= ATOMIC_INIT(0);
2313 struct power_supply_config cfg
= { .drv_data
= hidpp
};
2314 struct power_supply_desc
*desc
= &hidpp
->battery
.desc
;
2315 struct hidpp_battery
*battery
;
2319 if (hidpp
->battery
.ps
)
2322 if (hidpp
->protocol_major
>= 2) {
2323 ret
= hidpp20_query_battery_info(hidpp
);
2326 hidpp
->capabilities
|= HIDPP_CAPABILITY_HIDPP20_BATTERY
;
2331 battery
= &hidpp
->battery
;
2333 n
= atomic_inc_return(&battery_no
) - 1;
2334 desc
->properties
= hidpp_battery_props
;
2335 desc
->num_properties
= ARRAY_SIZE(hidpp_battery_props
);
2336 desc
->get_property
= hidpp_battery_get_property
;
2337 sprintf(battery
->name
, "hidpp_battery_%ld", n
);
2338 desc
->name
= battery
->name
;
2339 desc
->type
= POWER_SUPPLY_TYPE_BATTERY
;
2340 desc
->use_for_apm
= 0;
2342 battery
->ps
= devm_power_supply_register(&hidpp
->hid_dev
->dev
,
2345 if (IS_ERR(battery
->ps
))
2346 return PTR_ERR(battery
->ps
);
2348 power_supply_powers(battery
->ps
, &hidpp
->hid_dev
->dev
);
2353 static void hidpp_overwrite_name(struct hid_device
*hdev
)
2355 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2358 if (hidpp
->protocol_major
< 2)
2361 name
= hidpp_get_device_name(hidpp
);
2364 hid_err(hdev
, "unable to retrieve the name of the device");
2366 dbg_hid("HID++: Got name: %s\n", name
);
2367 snprintf(hdev
->name
, sizeof(hdev
->name
), "%s", name
);
2373 static int hidpp_input_open(struct input_dev
*dev
)
2375 struct hid_device
*hid
= input_get_drvdata(dev
);
2377 return hid_hw_open(hid
);
2380 static void hidpp_input_close(struct input_dev
*dev
)
2382 struct hid_device
*hid
= input_get_drvdata(dev
);
2387 static struct input_dev
*hidpp_allocate_input(struct hid_device
*hdev
)
2389 struct input_dev
*input_dev
= devm_input_allocate_device(&hdev
->dev
);
2390 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2395 input_set_drvdata(input_dev
, hdev
);
2396 input_dev
->open
= hidpp_input_open
;
2397 input_dev
->close
= hidpp_input_close
;
2399 input_dev
->name
= hidpp
->name
;
2400 input_dev
->phys
= hdev
->phys
;
2401 input_dev
->uniq
= hdev
->uniq
;
2402 input_dev
->id
.bustype
= hdev
->bus
;
2403 input_dev
->id
.vendor
= hdev
->vendor
;
2404 input_dev
->id
.product
= hdev
->product
;
2405 input_dev
->id
.version
= hdev
->version
;
2406 input_dev
->dev
.parent
= &hdev
->dev
;
2411 static void hidpp_connect_event(struct hidpp_device
*hidpp
)
2413 struct hid_device
*hdev
= hidpp
->hid_dev
;
2415 bool connected
= atomic_read(&hidpp
->connected
);
2416 struct input_dev
*input
;
2417 char *name
, *devm_name
;
2422 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_WTP
) {
2423 ret
= wtp_connect(hdev
, connected
);
2426 } else if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_M560
) {
2427 ret
= m560_send_config_command(hdev
, connected
);
2430 } else if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_K400
) {
2431 ret
= k400_connect(hdev
, connected
);
2436 /* the device is already connected, we can ask for its name and
2438 if (!hidpp
->protocol_major
) {
2439 ret
= !hidpp_is_connected(hidpp
);
2441 hid_err(hdev
, "Can not get the protocol version.\n");
2444 hid_info(hdev
, "HID++ %u.%u device connected.\n",
2445 hidpp
->protocol_major
, hidpp
->protocol_minor
);
2448 if (hidpp
->name
== hdev
->name
&& hidpp
->protocol_major
>= 2) {
2449 name
= hidpp_get_device_name(hidpp
);
2452 "unable to retrieve the name of the device");
2456 devm_name
= devm_kasprintf(&hdev
->dev
, GFP_KERNEL
, "%s", name
);
2461 hidpp
->name
= devm_name
;
2464 hidpp_initialize_battery(hidpp
);
2466 /* forward current battery state */
2467 if (hidpp
->capabilities
& HIDPP_CAPABILITY_HIDPP20_BATTERY
) {
2468 hidpp20_query_battery_info(hidpp
);
2469 if (hidpp
->battery
.ps
)
2470 power_supply_changed(hidpp
->battery
.ps
);
2473 if (!(hidpp
->quirks
& HIDPP_QUIRK_NO_HIDINPUT
) || hidpp
->delayed_input
)
2474 /* if the input nodes are already created, we can stop now */
2477 input
= hidpp_allocate_input(hdev
);
2479 hid_err(hdev
, "cannot allocate new input device: %d\n", ret
);
2483 hidpp_populate_input(hidpp
, input
, false);
2485 ret
= input_register_device(input
);
2487 input_free_device(input
);
2489 hidpp
->delayed_input
= input
;
2492 static int hidpp_probe(struct hid_device
*hdev
, const struct hid_device_id
*id
)
2494 struct hidpp_device
*hidpp
;
2497 unsigned int connect_mask
= HID_CONNECT_DEFAULT
;
2499 hidpp
= devm_kzalloc(&hdev
->dev
, sizeof(struct hidpp_device
),
2504 hidpp
->hid_dev
= hdev
;
2505 hidpp
->name
= hdev
->name
;
2506 hid_set_drvdata(hdev
, hidpp
);
2508 hidpp
->quirks
= id
->driver_data
;
2510 if (id
->group
== HID_GROUP_LOGITECH_DJ_DEVICE
)
2511 hidpp
->quirks
|= HIDPP_QUIRK_UNIFYING
;
2513 if (disable_raw_mode
) {
2514 hidpp
->quirks
&= ~HIDPP_QUIRK_CLASS_WTP
;
2515 hidpp
->quirks
&= ~HIDPP_QUIRK_NO_HIDINPUT
;
2518 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_WTP
) {
2519 ret
= wtp_allocate(hdev
, id
);
2522 } else if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_M560
) {
2523 ret
= m560_allocate(hdev
);
2526 } else if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_K400
) {
2527 ret
= k400_allocate(hdev
);
2532 INIT_WORK(&hidpp
->work
, delayed_work_cb
);
2533 mutex_init(&hidpp
->send_mutex
);
2534 init_waitqueue_head(&hidpp
->wait
);
2536 ret
= hid_parse(hdev
);
2538 hid_err(hdev
, "%s:parse failed\n", __func__
);
2539 goto hid_parse_fail
;
2542 if (hidpp
->quirks
& HIDPP_QUIRK_NO_HIDINPUT
)
2543 connect_mask
&= ~HID_CONNECT_HIDINPUT
;
2545 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_G920
) {
2546 ret
= hid_hw_start(hdev
, connect_mask
);
2548 hid_err(hdev
, "hw start failed\n");
2549 goto hid_hw_start_fail
;
2551 ret
= hid_hw_open(hdev
);
2553 dev_err(&hdev
->dev
, "%s:hid_hw_open returned error:%d\n",
2556 goto hid_hw_start_fail
;
2561 /* Allow incoming packets */
2562 hid_device_io_start(hdev
);
2564 if (hidpp
->quirks
& HIDPP_QUIRK_UNIFYING
)
2565 hidpp_unifying_init(hidpp
);
2567 connected
= hidpp_is_connected(hidpp
);
2568 atomic_set(&hidpp
->connected
, connected
);
2569 if (!(hidpp
->quirks
& HIDPP_QUIRK_UNIFYING
)) {
2572 hid_err(hdev
, "Device not connected");
2573 goto hid_hw_open_failed
;
2576 hid_info(hdev
, "HID++ %u.%u device connected.\n",
2577 hidpp
->protocol_major
, hidpp
->protocol_minor
);
2579 hidpp_overwrite_name(hdev
);
2582 if (connected
&& (hidpp
->quirks
& HIDPP_QUIRK_CLASS_WTP
)) {
2583 ret
= wtp_get_config(hidpp
);
2585 goto hid_hw_open_failed
;
2586 } else if (connected
&& (hidpp
->quirks
& HIDPP_QUIRK_CLASS_G920
)) {
2587 ret
= g920_get_config(hidpp
);
2589 goto hid_hw_open_failed
;
2592 /* Block incoming packets */
2593 hid_device_io_stop(hdev
);
2595 if (!(hidpp
->quirks
& HIDPP_QUIRK_CLASS_G920
)) {
2596 ret
= hid_hw_start(hdev
, connect_mask
);
2598 hid_err(hdev
, "%s:hid_hw_start returned error\n", __func__
);
2599 goto hid_hw_start_fail
;
2603 /* Allow incoming packets */
2604 hid_device_io_start(hdev
);
2606 hidpp_connect_event(hidpp
);
2611 hid_device_io_stop(hdev
);
2612 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_G920
) {
2618 cancel_work_sync(&hidpp
->work
);
2619 mutex_destroy(&hidpp
->send_mutex
);
2621 hid_set_drvdata(hdev
, NULL
);
2625 static void hidpp_remove(struct hid_device
*hdev
)
2627 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2629 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_G920
) {
2630 hidpp_ff_deinit(hdev
);
2634 cancel_work_sync(&hidpp
->work
);
2635 mutex_destroy(&hidpp
->send_mutex
);
2638 static const struct hid_device_id hidpp_devices
[] = {
2639 { /* wireless touchpad */
2640 HID_DEVICE(BUS_USB
, HID_GROUP_LOGITECH_DJ_DEVICE
,
2641 USB_VENDOR_ID_LOGITECH
, 0x4011),
2642 .driver_data
= HIDPP_QUIRK_CLASS_WTP
| HIDPP_QUIRK_DELAYED_INIT
|
2643 HIDPP_QUIRK_WTP_PHYSICAL_BUTTONS
},
2644 { /* wireless touchpad T650 */
2645 HID_DEVICE(BUS_USB
, HID_GROUP_LOGITECH_DJ_DEVICE
,
2646 USB_VENDOR_ID_LOGITECH
, 0x4101),
2647 .driver_data
= HIDPP_QUIRK_CLASS_WTP
| HIDPP_QUIRK_DELAYED_INIT
},
2648 { /* wireless touchpad T651 */
2649 HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_LOGITECH
,
2650 USB_DEVICE_ID_LOGITECH_T651
),
2651 .driver_data
= HIDPP_QUIRK_CLASS_WTP
},
2652 { /* Mouse logitech M560 */
2653 HID_DEVICE(BUS_USB
, HID_GROUP_LOGITECH_DJ_DEVICE
,
2654 USB_VENDOR_ID_LOGITECH
, 0x402d),
2655 .driver_data
= HIDPP_QUIRK_DELAYED_INIT
| HIDPP_QUIRK_CLASS_M560
},
2656 { /* Keyboard logitech K400 */
2657 HID_DEVICE(BUS_USB
, HID_GROUP_LOGITECH_DJ_DEVICE
,
2658 USB_VENDOR_ID_LOGITECH
, 0x4024),
2659 .driver_data
= HIDPP_QUIRK_CLASS_K400
},
2661 { HID_DEVICE(BUS_USB
, HID_GROUP_LOGITECH_DJ_DEVICE
,
2662 USB_VENDOR_ID_LOGITECH
, HID_ANY_ID
)},
2664 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH
, USB_DEVICE_ID_LOGITECH_G920_WHEEL
),
2665 .driver_data
= HIDPP_QUIRK_CLASS_G920
| HIDPP_QUIRK_FORCE_OUTPUT_REPORTS
},
2669 MODULE_DEVICE_TABLE(hid
, hidpp_devices
);
2671 static struct hid_driver hidpp_driver
= {
2672 .name
= "logitech-hidpp-device",
2673 .id_table
= hidpp_devices
,
2674 .probe
= hidpp_probe
,
2675 .remove
= hidpp_remove
,
2676 .raw_event
= hidpp_raw_event
,
2677 .input_configured
= hidpp_input_configured
,
2678 .input_mapping
= hidpp_input_mapping
,
2679 .input_mapped
= hidpp_input_mapped
,
2682 module_hid_driver(hidpp_driver
);