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)
59 #define HIDPP_QUIRK_CLASS_K750 BIT(4)
61 /* bits 2..20 are reserved for classes */
62 /* #define HIDPP_QUIRK_CONNECT_EVENTS BIT(21) disabled */
63 #define HIDPP_QUIRK_WTP_PHYSICAL_BUTTONS BIT(22)
64 #define HIDPP_QUIRK_NO_HIDINPUT BIT(23)
65 #define HIDPP_QUIRK_FORCE_OUTPUT_REPORTS BIT(24)
66 #define HIDPP_QUIRK_UNIFYING BIT(25)
68 #define HIDPP_QUIRK_DELAYED_INIT HIDPP_QUIRK_NO_HIDINPUT
70 #define HIDPP_CAPABILITY_HIDPP10_BATTERY BIT(0)
71 #define HIDPP_CAPABILITY_HIDPP20_BATTERY BIT(1)
72 #define HIDPP_CAPABILITY_BATTERY_MILEAGE BIT(2)
73 #define HIDPP_CAPABILITY_BATTERY_LEVEL_STATUS BIT(3)
76 * There are two hidpp protocols in use, the first version hidpp10 is known
77 * as register access protocol or RAP, the second version hidpp20 is known as
78 * feature access protocol or FAP
80 * Most older devices (including the Unifying usb receiver) use the RAP protocol
81 * where as most newer devices use the FAP protocol. Both protocols are
82 * compatible with the underlying transport, which could be usb, Unifiying, or
83 * bluetooth. The message lengths are defined by the hid vendor specific report
84 * descriptor for the HIDPP_SHORT report type (total message lenth 7 bytes) and
85 * the HIDPP_LONG report type (total message length 20 bytes)
87 * The RAP protocol uses both report types, whereas the FAP only uses HIDPP_LONG
88 * messages. The Unifying receiver itself responds to RAP messages (device index
89 * is 0xFF for the receiver), and all messages (short or long) with a device
90 * index between 1 and 6 are passed untouched to the corresponding paired
93 * The paired device can be RAP or FAP, it will receive the message untouched
94 * from the Unifiying receiver.
99 u8 funcindex_clientid
;
100 u8 params
[HIDPP_REPORT_VERY_LONG_LENGTH
- 4U];
106 u8 params
[HIDPP_REPORT_VERY_LONG_LENGTH
- 4U];
109 struct hidpp_report
{
115 u8 rawbytes
[sizeof(struct fap
)];
119 struct hidpp_battery
{
121 u8 solar_feature_index
;
122 struct power_supply_desc desc
;
123 struct power_supply
*ps
;
131 struct hidpp_device
{
132 struct hid_device
*hid_dev
;
133 struct mutex send_mutex
;
134 void *send_receive_buf
;
135 char *name
; /* will never be NULL and should not be freed */
136 wait_queue_head_t wait
;
137 bool answer_available
;
143 struct work_struct work
;
144 struct kfifo delayed_work_fifo
;
146 struct input_dev
*delayed_input
;
148 unsigned long quirks
;
149 unsigned long capabilities
;
151 struct hidpp_battery battery
;
154 /* HID++ 1.0 error codes */
155 #define HIDPP_ERROR 0x8f
156 #define HIDPP_ERROR_SUCCESS 0x00
157 #define HIDPP_ERROR_INVALID_SUBID 0x01
158 #define HIDPP_ERROR_INVALID_ADRESS 0x02
159 #define HIDPP_ERROR_INVALID_VALUE 0x03
160 #define HIDPP_ERROR_CONNECT_FAIL 0x04
161 #define HIDPP_ERROR_TOO_MANY_DEVICES 0x05
162 #define HIDPP_ERROR_ALREADY_EXISTS 0x06
163 #define HIDPP_ERROR_BUSY 0x07
164 #define HIDPP_ERROR_UNKNOWN_DEVICE 0x08
165 #define HIDPP_ERROR_RESOURCE_ERROR 0x09
166 #define HIDPP_ERROR_REQUEST_UNAVAILABLE 0x0a
167 #define HIDPP_ERROR_INVALID_PARAM_VALUE 0x0b
168 #define HIDPP_ERROR_WRONG_PIN_CODE 0x0c
169 /* HID++ 2.0 error codes */
170 #define HIDPP20_ERROR 0xff
172 static void hidpp_connect_event(struct hidpp_device
*hidpp_dev
);
174 static int __hidpp_send_report(struct hid_device
*hdev
,
175 struct hidpp_report
*hidpp_report
)
177 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
178 int fields_count
, ret
;
180 hidpp
= hid_get_drvdata(hdev
);
182 switch (hidpp_report
->report_id
) {
183 case REPORT_ID_HIDPP_SHORT
:
184 fields_count
= HIDPP_REPORT_SHORT_LENGTH
;
186 case REPORT_ID_HIDPP_LONG
:
187 fields_count
= HIDPP_REPORT_LONG_LENGTH
;
189 case REPORT_ID_HIDPP_VERY_LONG
:
190 fields_count
= HIDPP_REPORT_VERY_LONG_LENGTH
;
197 * set the device_index as the receiver, it will be overwritten by
198 * hid_hw_request if needed
200 hidpp_report
->device_index
= 0xff;
202 if (hidpp
->quirks
& HIDPP_QUIRK_FORCE_OUTPUT_REPORTS
) {
203 ret
= hid_hw_output_report(hdev
, (u8
*)hidpp_report
, fields_count
);
205 ret
= hid_hw_raw_request(hdev
, hidpp_report
->report_id
,
206 (u8
*)hidpp_report
, fields_count
, HID_OUTPUT_REPORT
,
210 return ret
== fields_count
? 0 : -1;
214 * hidpp_send_message_sync() returns 0 in case of success, and something else
215 * in case of a failure.
216 * - If ' something else' is positive, that means that an error has been raised
217 * by the protocol itself.
218 * - If ' something else' is negative, that means that we had a classic error
219 * (-ENOMEM, -EPIPE, etc...)
221 static int hidpp_send_message_sync(struct hidpp_device
*hidpp
,
222 struct hidpp_report
*message
,
223 struct hidpp_report
*response
)
227 mutex_lock(&hidpp
->send_mutex
);
229 hidpp
->send_receive_buf
= response
;
230 hidpp
->answer_available
= false;
233 * So that we can later validate the answer when it arrives
236 *response
= *message
;
238 ret
= __hidpp_send_report(hidpp
->hid_dev
, message
);
241 dbg_hid("__hidpp_send_report returned err: %d\n", ret
);
242 memset(response
, 0, sizeof(struct hidpp_report
));
246 if (!wait_event_timeout(hidpp
->wait
, hidpp
->answer_available
,
248 dbg_hid("%s:timeout waiting for response\n", __func__
);
249 memset(response
, 0, sizeof(struct hidpp_report
));
253 if (response
->report_id
== REPORT_ID_HIDPP_SHORT
&&
254 response
->rap
.sub_id
== HIDPP_ERROR
) {
255 ret
= response
->rap
.params
[1];
256 dbg_hid("%s:got hidpp error %02X\n", __func__
, ret
);
260 if ((response
->report_id
== REPORT_ID_HIDPP_LONG
||
261 response
->report_id
== REPORT_ID_HIDPP_VERY_LONG
) &&
262 response
->fap
.feature_index
== HIDPP20_ERROR
) {
263 ret
= response
->fap
.params
[1];
264 dbg_hid("%s:got hidpp 2.0 error %02X\n", __func__
, ret
);
269 mutex_unlock(&hidpp
->send_mutex
);
274 static int hidpp_send_fap_command_sync(struct hidpp_device
*hidpp
,
275 u8 feat_index
, u8 funcindex_clientid
, u8
*params
, int param_count
,
276 struct hidpp_report
*response
)
278 struct hidpp_report
*message
;
281 if (param_count
> sizeof(message
->fap
.params
))
284 message
= kzalloc(sizeof(struct hidpp_report
), GFP_KERNEL
);
288 if (param_count
> (HIDPP_REPORT_LONG_LENGTH
- 4))
289 message
->report_id
= REPORT_ID_HIDPP_VERY_LONG
;
291 message
->report_id
= REPORT_ID_HIDPP_LONG
;
292 message
->fap
.feature_index
= feat_index
;
293 message
->fap
.funcindex_clientid
= funcindex_clientid
;
294 memcpy(&message
->fap
.params
, params
, param_count
);
296 ret
= hidpp_send_message_sync(hidpp
, message
, response
);
301 static int hidpp_send_rap_command_sync(struct hidpp_device
*hidpp_dev
,
302 u8 report_id
, u8 sub_id
, u8 reg_address
, u8
*params
, int param_count
,
303 struct hidpp_report
*response
)
305 struct hidpp_report
*message
;
309 case REPORT_ID_HIDPP_SHORT
:
310 max_count
= HIDPP_REPORT_SHORT_LENGTH
- 4;
312 case REPORT_ID_HIDPP_LONG
:
313 max_count
= HIDPP_REPORT_LONG_LENGTH
- 4;
315 case REPORT_ID_HIDPP_VERY_LONG
:
316 max_count
= HIDPP_REPORT_VERY_LONG_LENGTH
- 4;
322 if (param_count
> max_count
)
325 message
= kzalloc(sizeof(struct hidpp_report
), GFP_KERNEL
);
328 message
->report_id
= report_id
;
329 message
->rap
.sub_id
= sub_id
;
330 message
->rap
.reg_address
= reg_address
;
331 memcpy(&message
->rap
.params
, params
, param_count
);
333 ret
= hidpp_send_message_sync(hidpp_dev
, message
, response
);
338 static void delayed_work_cb(struct work_struct
*work
)
340 struct hidpp_device
*hidpp
= container_of(work
, struct hidpp_device
,
342 hidpp_connect_event(hidpp
);
345 static inline bool hidpp_match_answer(struct hidpp_report
*question
,
346 struct hidpp_report
*answer
)
348 return (answer
->fap
.feature_index
== question
->fap
.feature_index
) &&
349 (answer
->fap
.funcindex_clientid
== question
->fap
.funcindex_clientid
);
352 static inline bool hidpp_match_error(struct hidpp_report
*question
,
353 struct hidpp_report
*answer
)
355 return ((answer
->rap
.sub_id
== HIDPP_ERROR
) ||
356 (answer
->fap
.feature_index
== HIDPP20_ERROR
)) &&
357 (answer
->fap
.funcindex_clientid
== question
->fap
.feature_index
) &&
358 (answer
->fap
.params
[0] == question
->fap
.funcindex_clientid
);
361 static inline bool hidpp_report_is_connect_event(struct hidpp_report
*report
)
363 return (report
->report_id
== REPORT_ID_HIDPP_SHORT
) &&
364 (report
->rap
.sub_id
== 0x41);
368 * hidpp_prefix_name() prefixes the current given name with "Logitech ".
370 static void hidpp_prefix_name(char **name
, int name_length
)
372 #define PREFIX_LENGTH 9 /* "Logitech " */
377 if (name_length
> PREFIX_LENGTH
&&
378 strncmp(*name
, "Logitech ", PREFIX_LENGTH
) == 0)
379 /* The prefix has is already in the name */
382 new_length
= PREFIX_LENGTH
+ name_length
;
383 new_name
= kzalloc(new_length
, GFP_KERNEL
);
387 snprintf(new_name
, new_length
, "Logitech %s", *name
);
394 /* -------------------------------------------------------------------------- */
395 /* HIDP++ 1.0 commands */
396 /* -------------------------------------------------------------------------- */
398 #define HIDPP_SET_REGISTER 0x80
399 #define HIDPP_GET_REGISTER 0x81
400 #define HIDPP_SET_LONG_REGISTER 0x82
401 #define HIDPP_GET_LONG_REGISTER 0x83
403 #define HIDPP_REG_GENERAL 0x00
405 static int hidpp10_enable_battery_reporting(struct hidpp_device
*hidpp_dev
)
407 struct hidpp_report response
;
409 u8 params
[3] = { 0 };
411 ret
= hidpp_send_rap_command_sync(hidpp_dev
,
412 REPORT_ID_HIDPP_SHORT
,
419 memcpy(params
, response
.rap
.params
, 3);
421 /* Set the battery bit */
424 return hidpp_send_rap_command_sync(hidpp_dev
,
425 REPORT_ID_HIDPP_SHORT
,
428 params
, 3, &response
);
431 #define HIDPP_REG_BATTERY_STATUS 0x07
433 static int hidpp10_battery_status_map_level(u8 param
)
439 level
= POWER_SUPPLY_CAPACITY_LEVEL_CRITICAL
;
442 level
= POWER_SUPPLY_CAPACITY_LEVEL_LOW
;
445 level
= POWER_SUPPLY_CAPACITY_LEVEL_NORMAL
;
448 level
= POWER_SUPPLY_CAPACITY_LEVEL_HIGH
;
451 level
= POWER_SUPPLY_CAPACITY_LEVEL_UNKNOWN
;
457 static int hidpp10_battery_status_map_status(u8 param
)
463 /* discharging (in use) */
464 status
= POWER_SUPPLY_STATUS_DISCHARGING
;
466 case 0x21: /* (standard) charging */
467 case 0x24: /* fast charging */
468 case 0x25: /* slow charging */
469 status
= POWER_SUPPLY_STATUS_CHARGING
;
471 case 0x26: /* topping charge */
472 case 0x22: /* charge complete */
473 status
= POWER_SUPPLY_STATUS_FULL
;
475 case 0x20: /* unknown */
476 status
= POWER_SUPPLY_STATUS_UNKNOWN
;
479 * 0x01...0x1F = reserved (not charging)
480 * 0x23 = charging error
481 * 0x27..0xff = reserved
484 status
= POWER_SUPPLY_STATUS_NOT_CHARGING
;
491 static int hidpp10_query_battery_status(struct hidpp_device
*hidpp
)
493 struct hidpp_report response
;
496 ret
= hidpp_send_rap_command_sync(hidpp
,
497 REPORT_ID_HIDPP_SHORT
,
499 HIDPP_REG_BATTERY_STATUS
,
504 hidpp
->battery
.level
=
505 hidpp10_battery_status_map_level(response
.rap
.params
[0]);
506 status
= hidpp10_battery_status_map_status(response
.rap
.params
[1]);
507 hidpp
->battery
.status
= status
;
508 /* the capacity is only available when discharging or full */
509 hidpp
->battery
.online
= status
== POWER_SUPPLY_STATUS_DISCHARGING
||
510 status
== POWER_SUPPLY_STATUS_FULL
;
515 #define HIDPP_REG_BATTERY_MILEAGE 0x0D
517 static int hidpp10_battery_mileage_map_status(u8 param
)
521 switch (param
>> 6) {
523 /* discharging (in use) */
524 status
= POWER_SUPPLY_STATUS_DISCHARGING
;
526 case 0x01: /* charging */
527 status
= POWER_SUPPLY_STATUS_CHARGING
;
529 case 0x02: /* charge complete */
530 status
= POWER_SUPPLY_STATUS_FULL
;
533 * 0x03 = charging error
536 status
= POWER_SUPPLY_STATUS_NOT_CHARGING
;
543 static int hidpp10_query_battery_mileage(struct hidpp_device
*hidpp
)
545 struct hidpp_report response
;
548 ret
= hidpp_send_rap_command_sync(hidpp
,
549 REPORT_ID_HIDPP_SHORT
,
551 HIDPP_REG_BATTERY_MILEAGE
,
556 hidpp
->battery
.capacity
= response
.rap
.params
[0];
557 status
= hidpp10_battery_mileage_map_status(response
.rap
.params
[2]);
558 hidpp
->battery
.status
= status
;
559 /* the capacity is only available when discharging or full */
560 hidpp
->battery
.online
= status
== POWER_SUPPLY_STATUS_DISCHARGING
||
561 status
== POWER_SUPPLY_STATUS_FULL
;
566 static int hidpp10_battery_event(struct hidpp_device
*hidpp
, u8
*data
, int size
)
568 struct hidpp_report
*report
= (struct hidpp_report
*)data
;
569 int status
, capacity
, level
;
572 if (report
->report_id
!= REPORT_ID_HIDPP_SHORT
)
575 switch (report
->rap
.sub_id
) {
576 case HIDPP_REG_BATTERY_STATUS
:
577 capacity
= hidpp
->battery
.capacity
;
578 level
= hidpp10_battery_status_map_level(report
->rawbytes
[1]);
579 status
= hidpp10_battery_status_map_status(report
->rawbytes
[2]);
581 case HIDPP_REG_BATTERY_MILEAGE
:
582 capacity
= report
->rap
.params
[0];
583 level
= hidpp
->battery
.level
;
584 status
= hidpp10_battery_mileage_map_status(report
->rawbytes
[3]);
590 changed
= capacity
!= hidpp
->battery
.capacity
||
591 level
!= hidpp
->battery
.level
||
592 status
!= hidpp
->battery
.status
;
594 /* the capacity is only available when discharging or full */
595 hidpp
->battery
.online
= status
== POWER_SUPPLY_STATUS_DISCHARGING
||
596 status
== POWER_SUPPLY_STATUS_FULL
;
599 hidpp
->battery
.level
= level
;
600 hidpp
->battery
.status
= status
;
601 if (hidpp
->battery
.ps
)
602 power_supply_changed(hidpp
->battery
.ps
);
608 #define HIDPP_REG_PAIRING_INFORMATION 0xB5
609 #define HIDPP_EXTENDED_PAIRING 0x30
610 #define HIDPP_DEVICE_NAME 0x40
612 static char *hidpp_unifying_get_name(struct hidpp_device
*hidpp_dev
)
614 struct hidpp_report response
;
616 u8 params
[1] = { HIDPP_DEVICE_NAME
};
620 ret
= hidpp_send_rap_command_sync(hidpp_dev
,
621 REPORT_ID_HIDPP_SHORT
,
622 HIDPP_GET_LONG_REGISTER
,
623 HIDPP_REG_PAIRING_INFORMATION
,
624 params
, 1, &response
);
628 len
= response
.rap
.params
[1];
630 if (2 + len
> sizeof(response
.rap
.params
))
633 name
= kzalloc(len
+ 1, GFP_KERNEL
);
637 memcpy(name
, &response
.rap
.params
[2], len
);
639 /* include the terminating '\0' */
640 hidpp_prefix_name(&name
, len
+ 1);
645 static int hidpp_unifying_get_serial(struct hidpp_device
*hidpp
, u32
*serial
)
647 struct hidpp_report response
;
649 u8 params
[1] = { HIDPP_EXTENDED_PAIRING
};
651 ret
= hidpp_send_rap_command_sync(hidpp
,
652 REPORT_ID_HIDPP_SHORT
,
653 HIDPP_GET_LONG_REGISTER
,
654 HIDPP_REG_PAIRING_INFORMATION
,
655 params
, 1, &response
);
660 * We don't care about LE or BE, we will output it as a string
661 * with %4phD, so we need to keep the order.
663 *serial
= *((u32
*)&response
.rap
.params
[1]);
667 static int hidpp_unifying_init(struct hidpp_device
*hidpp
)
669 struct hid_device
*hdev
= hidpp
->hid_dev
;
674 ret
= hidpp_unifying_get_serial(hidpp
, &serial
);
678 snprintf(hdev
->uniq
, sizeof(hdev
->uniq
), "%04x-%4phD",
679 hdev
->product
, &serial
);
680 dbg_hid("HID++ Unifying: Got serial: %s\n", hdev
->uniq
);
682 name
= hidpp_unifying_get_name(hidpp
);
686 snprintf(hdev
->name
, sizeof(hdev
->name
), "%s", name
);
687 dbg_hid("HID++ Unifying: Got name: %s\n", name
);
693 /* -------------------------------------------------------------------------- */
695 /* -------------------------------------------------------------------------- */
697 #define HIDPP_PAGE_ROOT 0x0000
698 #define HIDPP_PAGE_ROOT_IDX 0x00
700 #define CMD_ROOT_GET_FEATURE 0x01
701 #define CMD_ROOT_GET_PROTOCOL_VERSION 0x11
703 static int hidpp_root_get_feature(struct hidpp_device
*hidpp
, u16 feature
,
704 u8
*feature_index
, u8
*feature_type
)
706 struct hidpp_report response
;
708 u8 params
[2] = { feature
>> 8, feature
& 0x00FF };
710 ret
= hidpp_send_fap_command_sync(hidpp
,
712 CMD_ROOT_GET_FEATURE
,
713 params
, 2, &response
);
717 if (response
.fap
.params
[0] == 0)
720 *feature_index
= response
.fap
.params
[0];
721 *feature_type
= response
.fap
.params
[1];
726 static int hidpp_root_get_protocol_version(struct hidpp_device
*hidpp
)
728 const u8 ping_byte
= 0x5a;
729 u8 ping_data
[3] = { 0, 0, ping_byte
};
730 struct hidpp_report response
;
733 ret
= hidpp_send_rap_command_sync(hidpp
,
734 REPORT_ID_HIDPP_SHORT
,
736 CMD_ROOT_GET_PROTOCOL_VERSION
,
737 ping_data
, sizeof(ping_data
), &response
);
739 if (ret
== HIDPP_ERROR_INVALID_SUBID
) {
740 hidpp
->protocol_major
= 1;
741 hidpp
->protocol_minor
= 0;
745 /* the device might not be connected */
746 if (ret
== HIDPP_ERROR_RESOURCE_ERROR
)
750 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
757 if (response
.rap
.params
[2] != ping_byte
) {
758 hid_err(hidpp
->hid_dev
, "%s: ping mismatch 0x%02x != 0x%02x\n",
759 __func__
, response
.rap
.params
[2], ping_byte
);
763 hidpp
->protocol_major
= response
.rap
.params
[0];
764 hidpp
->protocol_minor
= response
.rap
.params
[1];
769 static bool hidpp_is_connected(struct hidpp_device
*hidpp
)
773 ret
= hidpp_root_get_protocol_version(hidpp
);
775 hid_dbg(hidpp
->hid_dev
, "HID++ %u.%u device connected.\n",
776 hidpp
->protocol_major
, hidpp
->protocol_minor
);
780 /* -------------------------------------------------------------------------- */
781 /* 0x0005: GetDeviceNameType */
782 /* -------------------------------------------------------------------------- */
784 #define HIDPP_PAGE_GET_DEVICE_NAME_TYPE 0x0005
786 #define CMD_GET_DEVICE_NAME_TYPE_GET_COUNT 0x01
787 #define CMD_GET_DEVICE_NAME_TYPE_GET_DEVICE_NAME 0x11
788 #define CMD_GET_DEVICE_NAME_TYPE_GET_TYPE 0x21
790 static int hidpp_devicenametype_get_count(struct hidpp_device
*hidpp
,
791 u8 feature_index
, u8
*nameLength
)
793 struct hidpp_report response
;
796 ret
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
797 CMD_GET_DEVICE_NAME_TYPE_GET_COUNT
, NULL
, 0, &response
);
800 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
807 *nameLength
= response
.fap
.params
[0];
812 static int hidpp_devicenametype_get_device_name(struct hidpp_device
*hidpp
,
813 u8 feature_index
, u8 char_index
, char *device_name
, int len_buf
)
815 struct hidpp_report response
;
819 ret
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
820 CMD_GET_DEVICE_NAME_TYPE_GET_DEVICE_NAME
, &char_index
, 1,
824 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
831 switch (response
.report_id
) {
832 case REPORT_ID_HIDPP_VERY_LONG
:
833 count
= HIDPP_REPORT_VERY_LONG_LENGTH
- 4;
835 case REPORT_ID_HIDPP_LONG
:
836 count
= HIDPP_REPORT_LONG_LENGTH
- 4;
838 case REPORT_ID_HIDPP_SHORT
:
839 count
= HIDPP_REPORT_SHORT_LENGTH
- 4;
848 for (i
= 0; i
< count
; i
++)
849 device_name
[i
] = response
.fap
.params
[i
];
854 static char *hidpp_get_device_name(struct hidpp_device
*hidpp
)
863 ret
= hidpp_root_get_feature(hidpp
, HIDPP_PAGE_GET_DEVICE_NAME_TYPE
,
864 &feature_index
, &feature_type
);
868 ret
= hidpp_devicenametype_get_count(hidpp
, feature_index
,
873 name
= kzalloc(__name_length
+ 1, GFP_KERNEL
);
877 while (index
< __name_length
) {
878 ret
= hidpp_devicenametype_get_device_name(hidpp
,
879 feature_index
, index
, name
+ index
,
880 __name_length
- index
);
888 /* include the terminating '\0' */
889 hidpp_prefix_name(&name
, __name_length
+ 1);
894 /* -------------------------------------------------------------------------- */
895 /* 0x1000: Battery level status */
896 /* -------------------------------------------------------------------------- */
898 #define HIDPP_PAGE_BATTERY_LEVEL_STATUS 0x1000
900 #define CMD_BATTERY_LEVEL_STATUS_GET_BATTERY_LEVEL_STATUS 0x00
901 #define CMD_BATTERY_LEVEL_STATUS_GET_BATTERY_CAPABILITY 0x10
903 #define EVENT_BATTERY_LEVEL_STATUS_BROADCAST 0x00
905 #define FLAG_BATTERY_LEVEL_DISABLE_OSD BIT(0)
906 #define FLAG_BATTERY_LEVEL_MILEAGE BIT(1)
907 #define FLAG_BATTERY_LEVEL_RECHARGEABLE BIT(2)
909 static int hidpp_map_battery_level(int capacity
)
912 return POWER_SUPPLY_CAPACITY_LEVEL_CRITICAL
;
914 * The spec says this should be < 31 but some devices report 30
915 * with brand new batteries and Windows reports 30 as "Good".
917 else if (capacity
< 30)
918 return POWER_SUPPLY_CAPACITY_LEVEL_LOW
;
919 else if (capacity
< 81)
920 return POWER_SUPPLY_CAPACITY_LEVEL_NORMAL
;
921 return POWER_SUPPLY_CAPACITY_LEVEL_FULL
;
924 static int hidpp20_batterylevel_map_status_capacity(u8 data
[3], int *capacity
,
931 *next_capacity
= data
[1];
932 *level
= POWER_SUPPLY_CAPACITY_LEVEL_UNKNOWN
;
934 /* When discharging, we can rely on the device reported capacity.
935 * For all other states the device reports 0 (unknown).
938 case 0: /* discharging (in use) */
939 status
= POWER_SUPPLY_STATUS_DISCHARGING
;
940 *level
= hidpp_map_battery_level(*capacity
);
942 case 1: /* recharging */
943 status
= POWER_SUPPLY_STATUS_CHARGING
;
945 case 2: /* charge in final stage */
946 status
= POWER_SUPPLY_STATUS_CHARGING
;
948 case 3: /* charge complete */
949 status
= POWER_SUPPLY_STATUS_FULL
;
950 *level
= POWER_SUPPLY_CAPACITY_LEVEL_FULL
;
953 case 4: /* recharging below optimal speed */
954 status
= POWER_SUPPLY_STATUS_CHARGING
;
956 /* 5 = invalid battery type
958 7 = other charging error */
960 status
= POWER_SUPPLY_STATUS_NOT_CHARGING
;
967 static int hidpp20_batterylevel_get_battery_capacity(struct hidpp_device
*hidpp
,
974 struct hidpp_report response
;
976 u8
*params
= (u8
*)response
.fap
.params
;
978 ret
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
979 CMD_BATTERY_LEVEL_STATUS_GET_BATTERY_LEVEL_STATUS
,
982 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
989 *status
= hidpp20_batterylevel_map_status_capacity(params
, capacity
,
996 static int hidpp20_batterylevel_get_battery_info(struct hidpp_device
*hidpp
,
999 struct hidpp_report response
;
1001 u8
*params
= (u8
*)response
.fap
.params
;
1002 unsigned int level_count
, flags
;
1004 ret
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
1005 CMD_BATTERY_LEVEL_STATUS_GET_BATTERY_CAPABILITY
,
1006 NULL
, 0, &response
);
1008 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
1015 level_count
= params
[0];
1018 if (level_count
< 10 || !(flags
& FLAG_BATTERY_LEVEL_MILEAGE
))
1019 hidpp
->capabilities
|= HIDPP_CAPABILITY_BATTERY_LEVEL_STATUS
;
1021 hidpp
->capabilities
|= HIDPP_CAPABILITY_BATTERY_MILEAGE
;
1026 static int hidpp20_query_battery_info(struct hidpp_device
*hidpp
)
1030 int status
, capacity
, next_capacity
, level
;
1032 if (hidpp
->battery
.feature_index
== 0xff) {
1033 ret
= hidpp_root_get_feature(hidpp
,
1034 HIDPP_PAGE_BATTERY_LEVEL_STATUS
,
1035 &hidpp
->battery
.feature_index
,
1041 ret
= hidpp20_batterylevel_get_battery_capacity(hidpp
,
1042 hidpp
->battery
.feature_index
,
1044 &next_capacity
, &level
);
1048 ret
= hidpp20_batterylevel_get_battery_info(hidpp
,
1049 hidpp
->battery
.feature_index
);
1053 hidpp
->battery
.status
= status
;
1054 hidpp
->battery
.capacity
= capacity
;
1055 hidpp
->battery
.level
= level
;
1056 /* the capacity is only available when discharging or full */
1057 hidpp
->battery
.online
= status
== POWER_SUPPLY_STATUS_DISCHARGING
||
1058 status
== POWER_SUPPLY_STATUS_FULL
;
1063 static int hidpp20_battery_event(struct hidpp_device
*hidpp
,
1066 struct hidpp_report
*report
= (struct hidpp_report
*)data
;
1067 int status
, capacity
, next_capacity
, level
;
1070 if (report
->fap
.feature_index
!= hidpp
->battery
.feature_index
||
1071 report
->fap
.funcindex_clientid
!= EVENT_BATTERY_LEVEL_STATUS_BROADCAST
)
1074 status
= hidpp20_batterylevel_map_status_capacity(report
->fap
.params
,
1079 /* the capacity is only available when discharging or full */
1080 hidpp
->battery
.online
= status
== POWER_SUPPLY_STATUS_DISCHARGING
||
1081 status
== POWER_SUPPLY_STATUS_FULL
;
1083 changed
= capacity
!= hidpp
->battery
.capacity
||
1084 level
!= hidpp
->battery
.level
||
1085 status
!= hidpp
->battery
.status
;
1088 hidpp
->battery
.level
= level
;
1089 hidpp
->battery
.capacity
= capacity
;
1090 hidpp
->battery
.status
= status
;
1091 if (hidpp
->battery
.ps
)
1092 power_supply_changed(hidpp
->battery
.ps
);
1098 static enum power_supply_property hidpp_battery_props
[] = {
1099 POWER_SUPPLY_PROP_ONLINE
,
1100 POWER_SUPPLY_PROP_STATUS
,
1101 POWER_SUPPLY_PROP_SCOPE
,
1102 POWER_SUPPLY_PROP_MODEL_NAME
,
1103 POWER_SUPPLY_PROP_MANUFACTURER
,
1104 POWER_SUPPLY_PROP_SERIAL_NUMBER
,
1105 0, /* placeholder for POWER_SUPPLY_PROP_CAPACITY, */
1106 0, /* placeholder for POWER_SUPPLY_PROP_CAPACITY_LEVEL, */
1109 static int hidpp_battery_get_property(struct power_supply
*psy
,
1110 enum power_supply_property psp
,
1111 union power_supply_propval
*val
)
1113 struct hidpp_device
*hidpp
= power_supply_get_drvdata(psy
);
1117 case POWER_SUPPLY_PROP_STATUS
:
1118 val
->intval
= hidpp
->battery
.status
;
1120 case POWER_SUPPLY_PROP_CAPACITY
:
1121 val
->intval
= hidpp
->battery
.capacity
;
1123 case POWER_SUPPLY_PROP_CAPACITY_LEVEL
:
1124 val
->intval
= hidpp
->battery
.level
;
1126 case POWER_SUPPLY_PROP_SCOPE
:
1127 val
->intval
= POWER_SUPPLY_SCOPE_DEVICE
;
1129 case POWER_SUPPLY_PROP_ONLINE
:
1130 val
->intval
= hidpp
->battery
.online
;
1132 case POWER_SUPPLY_PROP_MODEL_NAME
:
1133 if (!strncmp(hidpp
->name
, "Logitech ", 9))
1134 val
->strval
= hidpp
->name
+ 9;
1136 val
->strval
= hidpp
->name
;
1138 case POWER_SUPPLY_PROP_MANUFACTURER
:
1139 val
->strval
= "Logitech";
1141 case POWER_SUPPLY_PROP_SERIAL_NUMBER
:
1142 val
->strval
= hidpp
->hid_dev
->uniq
;
1152 /* -------------------------------------------------------------------------- */
1153 /* 0x4301: Solar Keyboard */
1154 /* -------------------------------------------------------------------------- */
1156 #define HIDPP_PAGE_SOLAR_KEYBOARD 0x4301
1158 #define CMD_SOLAR_SET_LIGHT_MEASURE 0x00
1160 #define EVENT_SOLAR_BATTERY_BROADCAST 0x00
1161 #define EVENT_SOLAR_BATTERY_LIGHT_MEASURE 0x10
1162 #define EVENT_SOLAR_CHECK_LIGHT_BUTTON 0x20
1164 static int hidpp_solar_request_battery_event(struct hidpp_device
*hidpp
)
1166 struct hidpp_report response
;
1167 u8 params
[2] = { 1, 1 };
1171 if (hidpp
->battery
.feature_index
== 0xff) {
1172 ret
= hidpp_root_get_feature(hidpp
,
1173 HIDPP_PAGE_SOLAR_KEYBOARD
,
1174 &hidpp
->battery
.solar_feature_index
,
1180 ret
= hidpp_send_fap_command_sync(hidpp
,
1181 hidpp
->battery
.solar_feature_index
,
1182 CMD_SOLAR_SET_LIGHT_MEASURE
,
1183 params
, 2, &response
);
1185 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
1192 hidpp
->capabilities
|= HIDPP_CAPABILITY_BATTERY_MILEAGE
;
1197 static int hidpp_solar_battery_event(struct hidpp_device
*hidpp
,
1200 struct hidpp_report
*report
= (struct hidpp_report
*)data
;
1201 int capacity
, lux
, status
;
1204 function
= report
->fap
.funcindex_clientid
;
1207 if (report
->fap
.feature_index
!= hidpp
->battery
.solar_feature_index
||
1208 !(function
== EVENT_SOLAR_BATTERY_BROADCAST
||
1209 function
== EVENT_SOLAR_BATTERY_LIGHT_MEASURE
||
1210 function
== EVENT_SOLAR_CHECK_LIGHT_BUTTON
))
1213 capacity
= report
->fap
.params
[0];
1216 case EVENT_SOLAR_BATTERY_LIGHT_MEASURE
:
1217 lux
= (report
->fap
.params
[1] << 8) | report
->fap
.params
[2];
1219 status
= POWER_SUPPLY_STATUS_CHARGING
;
1221 status
= POWER_SUPPLY_STATUS_DISCHARGING
;
1223 case EVENT_SOLAR_CHECK_LIGHT_BUTTON
:
1225 if (capacity
< hidpp
->battery
.capacity
)
1226 status
= POWER_SUPPLY_STATUS_DISCHARGING
;
1228 status
= POWER_SUPPLY_STATUS_CHARGING
;
1232 if (capacity
== 100)
1233 status
= POWER_SUPPLY_STATUS_FULL
;
1235 hidpp
->battery
.online
= true;
1236 if (capacity
!= hidpp
->battery
.capacity
||
1237 status
!= hidpp
->battery
.status
) {
1238 hidpp
->battery
.capacity
= capacity
;
1239 hidpp
->battery
.status
= status
;
1240 if (hidpp
->battery
.ps
)
1241 power_supply_changed(hidpp
->battery
.ps
);
1247 /* -------------------------------------------------------------------------- */
1248 /* 0x6010: Touchpad FW items */
1249 /* -------------------------------------------------------------------------- */
1251 #define HIDPP_PAGE_TOUCHPAD_FW_ITEMS 0x6010
1253 #define CMD_TOUCHPAD_FW_ITEMS_SET 0x10
1255 struct hidpp_touchpad_fw_items
{
1257 uint8_t desired_state
;
1263 * send a set state command to the device by reading the current items->state
1264 * field. items is then filled with the current state.
1266 static int hidpp_touchpad_fw_items_set(struct hidpp_device
*hidpp
,
1268 struct hidpp_touchpad_fw_items
*items
)
1270 struct hidpp_report response
;
1272 u8
*params
= (u8
*)response
.fap
.params
;
1274 ret
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
1275 CMD_TOUCHPAD_FW_ITEMS_SET
, &items
->state
, 1, &response
);
1278 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
1285 items
->presence
= params
[0];
1286 items
->desired_state
= params
[1];
1287 items
->state
= params
[2];
1288 items
->persistent
= params
[3];
1293 /* -------------------------------------------------------------------------- */
1294 /* 0x6100: TouchPadRawXY */
1295 /* -------------------------------------------------------------------------- */
1297 #define HIDPP_PAGE_TOUCHPAD_RAW_XY 0x6100
1299 #define CMD_TOUCHPAD_GET_RAW_INFO 0x01
1300 #define CMD_TOUCHPAD_SET_RAW_REPORT_STATE 0x21
1302 #define EVENT_TOUCHPAD_RAW_XY 0x00
1304 #define TOUCHPAD_RAW_XY_ORIGIN_LOWER_LEFT 0x01
1305 #define TOUCHPAD_RAW_XY_ORIGIN_UPPER_LEFT 0x03
1307 struct hidpp_touchpad_raw_info
{
1318 struct hidpp_touchpad_raw_xy_finger
{
1328 struct hidpp_touchpad_raw_xy
{
1330 struct hidpp_touchpad_raw_xy_finger fingers
[2];
1337 static int hidpp_touchpad_get_raw_info(struct hidpp_device
*hidpp
,
1338 u8 feature_index
, struct hidpp_touchpad_raw_info
*raw_info
)
1340 struct hidpp_report response
;
1342 u8
*params
= (u8
*)response
.fap
.params
;
1344 ret
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
1345 CMD_TOUCHPAD_GET_RAW_INFO
, NULL
, 0, &response
);
1348 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
1355 raw_info
->x_size
= get_unaligned_be16(¶ms
[0]);
1356 raw_info
->y_size
= get_unaligned_be16(¶ms
[2]);
1357 raw_info
->z_range
= params
[4];
1358 raw_info
->area_range
= params
[5];
1359 raw_info
->maxcontacts
= params
[7];
1360 raw_info
->origin
= params
[8];
1361 /* res is given in unit per inch */
1362 raw_info
->res
= get_unaligned_be16(¶ms
[13]) * 2 / 51;
1367 static int hidpp_touchpad_set_raw_report_state(struct hidpp_device
*hidpp_dev
,
1368 u8 feature_index
, bool send_raw_reports
,
1369 bool sensor_enhanced_settings
)
1371 struct hidpp_report response
;
1375 * bit 0 - enable raw
1376 * bit 1 - 16bit Z, no area
1377 * bit 2 - enhanced sensitivity
1378 * bit 3 - width, height (4 bits each) instead of area
1379 * bit 4 - send raw + gestures (degrades smoothness)
1380 * remaining bits - reserved
1382 u8 params
= send_raw_reports
| (sensor_enhanced_settings
<< 2);
1384 return hidpp_send_fap_command_sync(hidpp_dev
, feature_index
,
1385 CMD_TOUCHPAD_SET_RAW_REPORT_STATE
, ¶ms
, 1, &response
);
1388 static void hidpp_touchpad_touch_event(u8
*data
,
1389 struct hidpp_touchpad_raw_xy_finger
*finger
)
1391 u8 x_m
= data
[0] << 2;
1392 u8 y_m
= data
[2] << 2;
1394 finger
->x
= x_m
<< 6 | data
[1];
1395 finger
->y
= y_m
<< 6 | data
[3];
1397 finger
->contact_type
= data
[0] >> 6;
1398 finger
->contact_status
= data
[2] >> 6;
1400 finger
->z
= data
[4];
1401 finger
->area
= data
[5];
1402 finger
->finger_id
= data
[6] >> 4;
1405 static void hidpp_touchpad_raw_xy_event(struct hidpp_device
*hidpp_dev
,
1406 u8
*data
, struct hidpp_touchpad_raw_xy
*raw_xy
)
1408 memset(raw_xy
, 0, sizeof(struct hidpp_touchpad_raw_xy
));
1409 raw_xy
->end_of_frame
= data
[8] & 0x01;
1410 raw_xy
->spurious_flag
= (data
[8] >> 1) & 0x01;
1411 raw_xy
->finger_count
= data
[15] & 0x0f;
1412 raw_xy
->button
= (data
[8] >> 2) & 0x01;
1414 if (raw_xy
->finger_count
) {
1415 hidpp_touchpad_touch_event(&data
[2], &raw_xy
->fingers
[0]);
1416 hidpp_touchpad_touch_event(&data
[9], &raw_xy
->fingers
[1]);
1420 /* -------------------------------------------------------------------------- */
1421 /* 0x8123: Force feedback support */
1422 /* -------------------------------------------------------------------------- */
1424 #define HIDPP_FF_GET_INFO 0x01
1425 #define HIDPP_FF_RESET_ALL 0x11
1426 #define HIDPP_FF_DOWNLOAD_EFFECT 0x21
1427 #define HIDPP_FF_SET_EFFECT_STATE 0x31
1428 #define HIDPP_FF_DESTROY_EFFECT 0x41
1429 #define HIDPP_FF_GET_APERTURE 0x51
1430 #define HIDPP_FF_SET_APERTURE 0x61
1431 #define HIDPP_FF_GET_GLOBAL_GAINS 0x71
1432 #define HIDPP_FF_SET_GLOBAL_GAINS 0x81
1434 #define HIDPP_FF_EFFECT_STATE_GET 0x00
1435 #define HIDPP_FF_EFFECT_STATE_STOP 0x01
1436 #define HIDPP_FF_EFFECT_STATE_PLAY 0x02
1437 #define HIDPP_FF_EFFECT_STATE_PAUSE 0x03
1439 #define HIDPP_FF_EFFECT_CONSTANT 0x00
1440 #define HIDPP_FF_EFFECT_PERIODIC_SINE 0x01
1441 #define HIDPP_FF_EFFECT_PERIODIC_SQUARE 0x02
1442 #define HIDPP_FF_EFFECT_PERIODIC_TRIANGLE 0x03
1443 #define HIDPP_FF_EFFECT_PERIODIC_SAWTOOTHUP 0x04
1444 #define HIDPP_FF_EFFECT_PERIODIC_SAWTOOTHDOWN 0x05
1445 #define HIDPP_FF_EFFECT_SPRING 0x06
1446 #define HIDPP_FF_EFFECT_DAMPER 0x07
1447 #define HIDPP_FF_EFFECT_FRICTION 0x08
1448 #define HIDPP_FF_EFFECT_INERTIA 0x09
1449 #define HIDPP_FF_EFFECT_RAMP 0x0A
1451 #define HIDPP_FF_EFFECT_AUTOSTART 0x80
1453 #define HIDPP_FF_EFFECTID_NONE -1
1454 #define HIDPP_FF_EFFECTID_AUTOCENTER -2
1456 #define HIDPP_FF_MAX_PARAMS 20
1457 #define HIDPP_FF_RESERVED_SLOTS 1
1459 struct hidpp_ff_private_data
{
1460 struct hidpp_device
*hidpp
;
1468 struct workqueue_struct
*wq
;
1469 atomic_t workqueue_size
;
1472 struct hidpp_ff_work_data
{
1473 struct work_struct work
;
1474 struct hidpp_ff_private_data
*data
;
1477 u8 params
[HIDPP_FF_MAX_PARAMS
];
1481 static const signed short hiddpp_ff_effects
[] = {
1496 static const signed short hiddpp_ff_effects_v2
[] = {
1503 static const u8 HIDPP_FF_CONDITION_CMDS
[] = {
1504 HIDPP_FF_EFFECT_SPRING
,
1505 HIDPP_FF_EFFECT_FRICTION
,
1506 HIDPP_FF_EFFECT_DAMPER
,
1507 HIDPP_FF_EFFECT_INERTIA
1510 static const char *HIDPP_FF_CONDITION_NAMES
[] = {
1518 static u8
hidpp_ff_find_effect(struct hidpp_ff_private_data
*data
, int effect_id
)
1522 for (i
= 0; i
< data
->num_effects
; i
++)
1523 if (data
->effect_ids
[i
] == effect_id
)
1529 static void hidpp_ff_work_handler(struct work_struct
*w
)
1531 struct hidpp_ff_work_data
*wd
= container_of(w
, struct hidpp_ff_work_data
, work
);
1532 struct hidpp_ff_private_data
*data
= wd
->data
;
1533 struct hidpp_report response
;
1537 /* add slot number if needed */
1538 switch (wd
->effect_id
) {
1539 case HIDPP_FF_EFFECTID_AUTOCENTER
:
1540 wd
->params
[0] = data
->slot_autocenter
;
1542 case HIDPP_FF_EFFECTID_NONE
:
1543 /* leave slot as zero */
1546 /* find current slot for effect */
1547 wd
->params
[0] = hidpp_ff_find_effect(data
, wd
->effect_id
);
1551 /* send command and wait for reply */
1552 ret
= hidpp_send_fap_command_sync(data
->hidpp
, data
->feature_index
,
1553 wd
->command
, wd
->params
, wd
->size
, &response
);
1556 hid_err(data
->hidpp
->hid_dev
, "Failed to send command to device!\n");
1560 /* parse return data */
1561 switch (wd
->command
) {
1562 case HIDPP_FF_DOWNLOAD_EFFECT
:
1563 slot
= response
.fap
.params
[0];
1564 if (slot
> 0 && slot
<= data
->num_effects
) {
1565 if (wd
->effect_id
>= 0)
1566 /* regular effect uploaded */
1567 data
->effect_ids
[slot
-1] = wd
->effect_id
;
1568 else if (wd
->effect_id
>= HIDPP_FF_EFFECTID_AUTOCENTER
)
1569 /* autocenter spring uploaded */
1570 data
->slot_autocenter
= slot
;
1573 case HIDPP_FF_DESTROY_EFFECT
:
1574 if (wd
->effect_id
>= 0)
1575 /* regular effect destroyed */
1576 data
->effect_ids
[wd
->params
[0]-1] = -1;
1577 else if (wd
->effect_id
>= HIDPP_FF_EFFECTID_AUTOCENTER
)
1578 /* autocenter spring destoyed */
1579 data
->slot_autocenter
= 0;
1581 case HIDPP_FF_SET_GLOBAL_GAINS
:
1582 data
->gain
= (wd
->params
[0] << 8) + wd
->params
[1];
1584 case HIDPP_FF_SET_APERTURE
:
1585 data
->range
= (wd
->params
[0] << 8) + wd
->params
[1];
1588 /* no action needed */
1593 atomic_dec(&data
->workqueue_size
);
1597 static int hidpp_ff_queue_work(struct hidpp_ff_private_data
*data
, int effect_id
, u8 command
, u8
*params
, u8 size
)
1599 struct hidpp_ff_work_data
*wd
= kzalloc(sizeof(*wd
), GFP_KERNEL
);
1605 INIT_WORK(&wd
->work
, hidpp_ff_work_handler
);
1608 wd
->effect_id
= effect_id
;
1609 wd
->command
= command
;
1611 memcpy(wd
->params
, params
, size
);
1613 atomic_inc(&data
->workqueue_size
);
1614 queue_work(data
->wq
, &wd
->work
);
1616 /* warn about excessive queue size */
1617 s
= atomic_read(&data
->workqueue_size
);
1618 if (s
>= 20 && s
% 20 == 0)
1619 hid_warn(data
->hidpp
->hid_dev
, "Force feedback command queue contains %d commands, causing substantial delays!", s
);
1624 static int hidpp_ff_upload_effect(struct input_dev
*dev
, struct ff_effect
*effect
, struct ff_effect
*old
)
1626 struct hidpp_ff_private_data
*data
= dev
->ff
->private;
1631 /* set common parameters */
1632 params
[2] = effect
->replay
.length
>> 8;
1633 params
[3] = effect
->replay
.length
& 255;
1634 params
[4] = effect
->replay
.delay
>> 8;
1635 params
[5] = effect
->replay
.delay
& 255;
1637 switch (effect
->type
) {
1639 force
= (effect
->u
.constant
.level
* fixp_sin16((effect
->direction
* 360) >> 16)) >> 15;
1640 params
[1] = HIDPP_FF_EFFECT_CONSTANT
;
1641 params
[6] = force
>> 8;
1642 params
[7] = force
& 255;
1643 params
[8] = effect
->u
.constant
.envelope
.attack_level
>> 7;
1644 params
[9] = effect
->u
.constant
.envelope
.attack_length
>> 8;
1645 params
[10] = effect
->u
.constant
.envelope
.attack_length
& 255;
1646 params
[11] = effect
->u
.constant
.envelope
.fade_level
>> 7;
1647 params
[12] = effect
->u
.constant
.envelope
.fade_length
>> 8;
1648 params
[13] = effect
->u
.constant
.envelope
.fade_length
& 255;
1650 dbg_hid("Uploading constant force level=%d in dir %d = %d\n",
1651 effect
->u
.constant
.level
,
1652 effect
->direction
, force
);
1653 dbg_hid(" envelope attack=(%d, %d ms) fade=(%d, %d ms)\n",
1654 effect
->u
.constant
.envelope
.attack_level
,
1655 effect
->u
.constant
.envelope
.attack_length
,
1656 effect
->u
.constant
.envelope
.fade_level
,
1657 effect
->u
.constant
.envelope
.fade_length
);
1661 switch (effect
->u
.periodic
.waveform
) {
1663 params
[1] = HIDPP_FF_EFFECT_PERIODIC_SINE
;
1666 params
[1] = HIDPP_FF_EFFECT_PERIODIC_SQUARE
;
1669 params
[1] = HIDPP_FF_EFFECT_PERIODIC_SAWTOOTHUP
;
1672 params
[1] = HIDPP_FF_EFFECT_PERIODIC_SAWTOOTHDOWN
;
1675 params
[1] = HIDPP_FF_EFFECT_PERIODIC_TRIANGLE
;
1678 hid_err(data
->hidpp
->hid_dev
, "Unexpected periodic waveform type %i!\n", effect
->u
.periodic
.waveform
);
1681 force
= (effect
->u
.periodic
.magnitude
* fixp_sin16((effect
->direction
* 360) >> 16)) >> 15;
1682 params
[6] = effect
->u
.periodic
.magnitude
>> 8;
1683 params
[7] = effect
->u
.periodic
.magnitude
& 255;
1684 params
[8] = effect
->u
.periodic
.offset
>> 8;
1685 params
[9] = effect
->u
.periodic
.offset
& 255;
1686 params
[10] = effect
->u
.periodic
.period
>> 8;
1687 params
[11] = effect
->u
.periodic
.period
& 255;
1688 params
[12] = effect
->u
.periodic
.phase
>> 8;
1689 params
[13] = effect
->u
.periodic
.phase
& 255;
1690 params
[14] = effect
->u
.periodic
.envelope
.attack_level
>> 7;
1691 params
[15] = effect
->u
.periodic
.envelope
.attack_length
>> 8;
1692 params
[16] = effect
->u
.periodic
.envelope
.attack_length
& 255;
1693 params
[17] = effect
->u
.periodic
.envelope
.fade_level
>> 7;
1694 params
[18] = effect
->u
.periodic
.envelope
.fade_length
>> 8;
1695 params
[19] = effect
->u
.periodic
.envelope
.fade_length
& 255;
1697 dbg_hid("Uploading periodic force mag=%d/dir=%d, offset=%d, period=%d ms, phase=%d\n",
1698 effect
->u
.periodic
.magnitude
, effect
->direction
,
1699 effect
->u
.periodic
.offset
,
1700 effect
->u
.periodic
.period
,
1701 effect
->u
.periodic
.phase
);
1702 dbg_hid(" envelope attack=(%d, %d ms) fade=(%d, %d ms)\n",
1703 effect
->u
.periodic
.envelope
.attack_level
,
1704 effect
->u
.periodic
.envelope
.attack_length
,
1705 effect
->u
.periodic
.envelope
.fade_level
,
1706 effect
->u
.periodic
.envelope
.fade_length
);
1710 params
[1] = HIDPP_FF_EFFECT_RAMP
;
1711 force
= (effect
->u
.ramp
.start_level
* fixp_sin16((effect
->direction
* 360) >> 16)) >> 15;
1712 params
[6] = force
>> 8;
1713 params
[7] = force
& 255;
1714 force
= (effect
->u
.ramp
.end_level
* fixp_sin16((effect
->direction
* 360) >> 16)) >> 15;
1715 params
[8] = force
>> 8;
1716 params
[9] = force
& 255;
1717 params
[10] = effect
->u
.ramp
.envelope
.attack_level
>> 7;
1718 params
[11] = effect
->u
.ramp
.envelope
.attack_length
>> 8;
1719 params
[12] = effect
->u
.ramp
.envelope
.attack_length
& 255;
1720 params
[13] = effect
->u
.ramp
.envelope
.fade_level
>> 7;
1721 params
[14] = effect
->u
.ramp
.envelope
.fade_length
>> 8;
1722 params
[15] = effect
->u
.ramp
.envelope
.fade_length
& 255;
1724 dbg_hid("Uploading ramp force level=%d -> %d in dir %d = %d\n",
1725 effect
->u
.ramp
.start_level
,
1726 effect
->u
.ramp
.end_level
,
1727 effect
->direction
, force
);
1728 dbg_hid(" envelope attack=(%d, %d ms) fade=(%d, %d ms)\n",
1729 effect
->u
.ramp
.envelope
.attack_level
,
1730 effect
->u
.ramp
.envelope
.attack_length
,
1731 effect
->u
.ramp
.envelope
.fade_level
,
1732 effect
->u
.ramp
.envelope
.fade_length
);
1738 params
[1] = HIDPP_FF_CONDITION_CMDS
[effect
->type
- FF_SPRING
];
1739 params
[6] = effect
->u
.condition
[0].left_saturation
>> 9;
1740 params
[7] = (effect
->u
.condition
[0].left_saturation
>> 1) & 255;
1741 params
[8] = effect
->u
.condition
[0].left_coeff
>> 8;
1742 params
[9] = effect
->u
.condition
[0].left_coeff
& 255;
1743 params
[10] = effect
->u
.condition
[0].deadband
>> 9;
1744 params
[11] = (effect
->u
.condition
[0].deadband
>> 1) & 255;
1745 params
[12] = effect
->u
.condition
[0].center
>> 8;
1746 params
[13] = effect
->u
.condition
[0].center
& 255;
1747 params
[14] = effect
->u
.condition
[0].right_coeff
>> 8;
1748 params
[15] = effect
->u
.condition
[0].right_coeff
& 255;
1749 params
[16] = effect
->u
.condition
[0].right_saturation
>> 9;
1750 params
[17] = (effect
->u
.condition
[0].right_saturation
>> 1) & 255;
1752 dbg_hid("Uploading %s force left coeff=%d, left sat=%d, right coeff=%d, right sat=%d\n",
1753 HIDPP_FF_CONDITION_NAMES
[effect
->type
- FF_SPRING
],
1754 effect
->u
.condition
[0].left_coeff
,
1755 effect
->u
.condition
[0].left_saturation
,
1756 effect
->u
.condition
[0].right_coeff
,
1757 effect
->u
.condition
[0].right_saturation
);
1758 dbg_hid(" deadband=%d, center=%d\n",
1759 effect
->u
.condition
[0].deadband
,
1760 effect
->u
.condition
[0].center
);
1763 hid_err(data
->hidpp
->hid_dev
, "Unexpected force type %i!\n", effect
->type
);
1767 return hidpp_ff_queue_work(data
, effect
->id
, HIDPP_FF_DOWNLOAD_EFFECT
, params
, size
);
1770 static int hidpp_ff_playback(struct input_dev
*dev
, int effect_id
, int value
)
1772 struct hidpp_ff_private_data
*data
= dev
->ff
->private;
1775 params
[1] = value
? HIDPP_FF_EFFECT_STATE_PLAY
: HIDPP_FF_EFFECT_STATE_STOP
;
1777 dbg_hid("St%sing playback of effect %d.\n", value
?"art":"opp", effect_id
);
1779 return hidpp_ff_queue_work(data
, effect_id
, HIDPP_FF_SET_EFFECT_STATE
, params
, ARRAY_SIZE(params
));
1782 static int hidpp_ff_erase_effect(struct input_dev
*dev
, int effect_id
)
1784 struct hidpp_ff_private_data
*data
= dev
->ff
->private;
1787 dbg_hid("Erasing effect %d.\n", effect_id
);
1789 return hidpp_ff_queue_work(data
, effect_id
, HIDPP_FF_DESTROY_EFFECT
, &slot
, 1);
1792 static void hidpp_ff_set_autocenter(struct input_dev
*dev
, u16 magnitude
)
1794 struct hidpp_ff_private_data
*data
= dev
->ff
->private;
1797 dbg_hid("Setting autocenter to %d.\n", magnitude
);
1799 /* start a standard spring effect */
1800 params
[1] = HIDPP_FF_EFFECT_SPRING
| HIDPP_FF_EFFECT_AUTOSTART
;
1801 /* zero delay and duration */
1802 params
[2] = params
[3] = params
[4] = params
[5] = 0;
1803 /* set coeff to 25% of saturation */
1804 params
[8] = params
[14] = magnitude
>> 11;
1805 params
[9] = params
[15] = (magnitude
>> 3) & 255;
1806 params
[6] = params
[16] = magnitude
>> 9;
1807 params
[7] = params
[17] = (magnitude
>> 1) & 255;
1808 /* zero deadband and center */
1809 params
[10] = params
[11] = params
[12] = params
[13] = 0;
1811 hidpp_ff_queue_work(data
, HIDPP_FF_EFFECTID_AUTOCENTER
, HIDPP_FF_DOWNLOAD_EFFECT
, params
, ARRAY_SIZE(params
));
1814 static void hidpp_ff_set_gain(struct input_dev
*dev
, u16 gain
)
1816 struct hidpp_ff_private_data
*data
= dev
->ff
->private;
1819 dbg_hid("Setting gain to %d.\n", gain
);
1821 params
[0] = gain
>> 8;
1822 params
[1] = gain
& 255;
1823 params
[2] = 0; /* no boost */
1826 hidpp_ff_queue_work(data
, HIDPP_FF_EFFECTID_NONE
, HIDPP_FF_SET_GLOBAL_GAINS
, params
, ARRAY_SIZE(params
));
1829 static ssize_t
hidpp_ff_range_show(struct device
*dev
, struct device_attribute
*attr
, char *buf
)
1831 struct hid_device
*hid
= to_hid_device(dev
);
1832 struct hid_input
*hidinput
= list_entry(hid
->inputs
.next
, struct hid_input
, list
);
1833 struct input_dev
*idev
= hidinput
->input
;
1834 struct hidpp_ff_private_data
*data
= idev
->ff
->private;
1836 return scnprintf(buf
, PAGE_SIZE
, "%u\n", data
->range
);
1839 static ssize_t
hidpp_ff_range_store(struct device
*dev
, struct device_attribute
*attr
, const char *buf
, size_t count
)
1841 struct hid_device
*hid
= to_hid_device(dev
);
1842 struct hid_input
*hidinput
= list_entry(hid
->inputs
.next
, struct hid_input
, list
);
1843 struct input_dev
*idev
= hidinput
->input
;
1844 struct hidpp_ff_private_data
*data
= idev
->ff
->private;
1846 int range
= simple_strtoul(buf
, NULL
, 10);
1848 range
= clamp(range
, 180, 900);
1850 params
[0] = range
>> 8;
1851 params
[1] = range
& 0x00FF;
1853 hidpp_ff_queue_work(data
, -1, HIDPP_FF_SET_APERTURE
, params
, ARRAY_SIZE(params
));
1858 static DEVICE_ATTR(range
, S_IRUSR
| S_IWUSR
| S_IRGRP
| S_IWGRP
| S_IROTH
, hidpp_ff_range_show
, hidpp_ff_range_store
);
1860 static void hidpp_ff_destroy(struct ff_device
*ff
)
1862 struct hidpp_ff_private_data
*data
= ff
->private;
1864 kfree(data
->effect_ids
);
1867 static int hidpp_ff_init(struct hidpp_device
*hidpp
, u8 feature_index
)
1869 struct hid_device
*hid
= hidpp
->hid_dev
;
1870 struct hid_input
*hidinput
= list_entry(hid
->inputs
.next
, struct hid_input
, list
);
1871 struct input_dev
*dev
= hidinput
->input
;
1872 const struct usb_device_descriptor
*udesc
= &(hid_to_usb_dev(hid
)->descriptor
);
1873 const u16 bcdDevice
= le16_to_cpu(udesc
->bcdDevice
);
1874 struct ff_device
*ff
;
1875 struct hidpp_report response
;
1876 struct hidpp_ff_private_data
*data
;
1877 int error
, j
, num_slots
;
1881 hid_err(hid
, "Struct input_dev not set!\n");
1885 /* Get firmware release */
1886 version
= bcdDevice
& 255;
1888 /* Set supported force feedback capabilities */
1889 for (j
= 0; hiddpp_ff_effects
[j
] >= 0; j
++)
1890 set_bit(hiddpp_ff_effects
[j
], dev
->ffbit
);
1892 for (j
= 0; hiddpp_ff_effects_v2
[j
] >= 0; j
++)
1893 set_bit(hiddpp_ff_effects_v2
[j
], dev
->ffbit
);
1895 /* Read number of slots available in device */
1896 error
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
1897 HIDPP_FF_GET_INFO
, NULL
, 0, &response
);
1901 hid_err(hidpp
->hid_dev
, "%s: received protocol error 0x%02x\n",
1906 num_slots
= response
.fap
.params
[0] - HIDPP_FF_RESERVED_SLOTS
;
1908 error
= input_ff_create(dev
, num_slots
);
1911 hid_err(dev
, "Failed to create FF device!\n");
1915 data
= kzalloc(sizeof(*data
), GFP_KERNEL
);
1918 data
->effect_ids
= kcalloc(num_slots
, sizeof(int), GFP_KERNEL
);
1919 if (!data
->effect_ids
) {
1923 data
->wq
= create_singlethread_workqueue("hidpp-ff-sendqueue");
1925 kfree(data
->effect_ids
);
1930 data
->hidpp
= hidpp
;
1931 data
->feature_index
= feature_index
;
1932 data
->version
= version
;
1933 data
->slot_autocenter
= 0;
1934 data
->num_effects
= num_slots
;
1935 for (j
= 0; j
< num_slots
; j
++)
1936 data
->effect_ids
[j
] = -1;
1941 ff
->upload
= hidpp_ff_upload_effect
;
1942 ff
->erase
= hidpp_ff_erase_effect
;
1943 ff
->playback
= hidpp_ff_playback
;
1944 ff
->set_gain
= hidpp_ff_set_gain
;
1945 ff
->set_autocenter
= hidpp_ff_set_autocenter
;
1946 ff
->destroy
= hidpp_ff_destroy
;
1949 /* reset all forces */
1950 error
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
1951 HIDPP_FF_RESET_ALL
, NULL
, 0, &response
);
1953 /* Read current Range */
1954 error
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
1955 HIDPP_FF_GET_APERTURE
, NULL
, 0, &response
);
1957 hid_warn(hidpp
->hid_dev
, "Failed to read range from device!\n");
1958 data
->range
= error
? 900 : get_unaligned_be16(&response
.fap
.params
[0]);
1960 /* Create sysfs interface */
1961 error
= device_create_file(&(hidpp
->hid_dev
->dev
), &dev_attr_range
);
1963 hid_warn(hidpp
->hid_dev
, "Unable to create sysfs interface for \"range\", errno %d!\n", error
);
1965 /* Read the current gain values */
1966 error
= hidpp_send_fap_command_sync(hidpp
, feature_index
,
1967 HIDPP_FF_GET_GLOBAL_GAINS
, NULL
, 0, &response
);
1969 hid_warn(hidpp
->hid_dev
, "Failed to read gain values from device!\n");
1970 data
->gain
= error
? 0xffff : get_unaligned_be16(&response
.fap
.params
[0]);
1971 /* ignore boost value at response.fap.params[2] */
1973 /* init the hardware command queue */
1974 atomic_set(&data
->workqueue_size
, 0);
1976 /* initialize with zero autocenter to get wheel in usable state */
1977 hidpp_ff_set_autocenter(dev
, 0);
1979 hid_info(hid
, "Force feedback support loaded (firmware release %d).\n",
1985 static int hidpp_ff_deinit(struct hid_device
*hid
)
1987 struct hid_input
*hidinput
= list_entry(hid
->inputs
.next
, struct hid_input
, list
);
1988 struct input_dev
*dev
= hidinput
->input
;
1989 struct hidpp_ff_private_data
*data
;
1992 hid_err(hid
, "Struct input_dev not found!\n");
1996 hid_info(hid
, "Unloading HID++ force feedback.\n");
1997 data
= dev
->ff
->private;
1999 hid_err(hid
, "Private data not found!\n");
2003 destroy_workqueue(data
->wq
);
2004 device_remove_file(&hid
->dev
, &dev_attr_range
);
2010 /* ************************************************************************** */
2012 /* Device Support */
2014 /* ************************************************************************** */
2016 /* -------------------------------------------------------------------------- */
2017 /* Touchpad HID++ devices */
2018 /* -------------------------------------------------------------------------- */
2020 #define WTP_MANUAL_RESOLUTION 39
2023 struct input_dev
*input
;
2026 u8 mt_feature_index
;
2027 u8 button_feature_index
;
2030 unsigned int resolution
;
2033 static int wtp_input_mapping(struct hid_device
*hdev
, struct hid_input
*hi
,
2034 struct hid_field
*field
, struct hid_usage
*usage
,
2035 unsigned long **bit
, int *max
)
2040 static void wtp_populate_input(struct hidpp_device
*hidpp
,
2041 struct input_dev
*input_dev
, bool origin_is_hid_core
)
2043 struct wtp_data
*wd
= hidpp
->private_data
;
2045 __set_bit(EV_ABS
, input_dev
->evbit
);
2046 __set_bit(EV_KEY
, input_dev
->evbit
);
2047 __clear_bit(EV_REL
, input_dev
->evbit
);
2048 __clear_bit(EV_LED
, input_dev
->evbit
);
2050 input_set_abs_params(input_dev
, ABS_MT_POSITION_X
, 0, wd
->x_size
, 0, 0);
2051 input_abs_set_res(input_dev
, ABS_MT_POSITION_X
, wd
->resolution
);
2052 input_set_abs_params(input_dev
, ABS_MT_POSITION_Y
, 0, wd
->y_size
, 0, 0);
2053 input_abs_set_res(input_dev
, ABS_MT_POSITION_Y
, wd
->resolution
);
2055 /* Max pressure is not given by the devices, pick one */
2056 input_set_abs_params(input_dev
, ABS_MT_PRESSURE
, 0, 50, 0, 0);
2058 input_set_capability(input_dev
, EV_KEY
, BTN_LEFT
);
2060 if (hidpp
->quirks
& HIDPP_QUIRK_WTP_PHYSICAL_BUTTONS
)
2061 input_set_capability(input_dev
, EV_KEY
, BTN_RIGHT
);
2063 __set_bit(INPUT_PROP_BUTTONPAD
, input_dev
->propbit
);
2065 input_mt_init_slots(input_dev
, wd
->maxcontacts
, INPUT_MT_POINTER
|
2066 INPUT_MT_DROP_UNUSED
);
2068 wd
->input
= input_dev
;
2071 static void wtp_touch_event(struct wtp_data
*wd
,
2072 struct hidpp_touchpad_raw_xy_finger
*touch_report
)
2076 if (!touch_report
->finger_id
|| touch_report
->contact_type
)
2077 /* no actual data */
2080 slot
= input_mt_get_slot_by_key(wd
->input
, touch_report
->finger_id
);
2082 input_mt_slot(wd
->input
, slot
);
2083 input_mt_report_slot_state(wd
->input
, MT_TOOL_FINGER
,
2084 touch_report
->contact_status
);
2085 if (touch_report
->contact_status
) {
2086 input_event(wd
->input
, EV_ABS
, ABS_MT_POSITION_X
,
2088 input_event(wd
->input
, EV_ABS
, ABS_MT_POSITION_Y
,
2089 wd
->flip_y
? wd
->y_size
- touch_report
->y
:
2091 input_event(wd
->input
, EV_ABS
, ABS_MT_PRESSURE
,
2092 touch_report
->area
);
2096 static void wtp_send_raw_xy_event(struct hidpp_device
*hidpp
,
2097 struct hidpp_touchpad_raw_xy
*raw
)
2099 struct wtp_data
*wd
= hidpp
->private_data
;
2102 for (i
= 0; i
< 2; i
++)
2103 wtp_touch_event(wd
, &(raw
->fingers
[i
]));
2105 if (raw
->end_of_frame
&&
2106 !(hidpp
->quirks
& HIDPP_QUIRK_WTP_PHYSICAL_BUTTONS
))
2107 input_event(wd
->input
, EV_KEY
, BTN_LEFT
, raw
->button
);
2109 if (raw
->end_of_frame
|| raw
->finger_count
<= 2) {
2110 input_mt_sync_frame(wd
->input
);
2111 input_sync(wd
->input
);
2115 static int wtp_mouse_raw_xy_event(struct hidpp_device
*hidpp
, u8
*data
)
2117 struct wtp_data
*wd
= hidpp
->private_data
;
2118 u8 c1_area
= ((data
[7] & 0xf) * (data
[7] & 0xf) +
2119 (data
[7] >> 4) * (data
[7] >> 4)) / 2;
2120 u8 c2_area
= ((data
[13] & 0xf) * (data
[13] & 0xf) +
2121 (data
[13] >> 4) * (data
[13] >> 4)) / 2;
2122 struct hidpp_touchpad_raw_xy raw
= {
2123 .timestamp
= data
[1],
2127 .contact_status
= !!data
[7],
2128 .x
= get_unaligned_le16(&data
[3]),
2129 .y
= get_unaligned_le16(&data
[5]),
2132 .finger_id
= data
[2],
2135 .contact_status
= !!data
[13],
2136 .x
= get_unaligned_le16(&data
[9]),
2137 .y
= get_unaligned_le16(&data
[11]),
2140 .finger_id
= data
[8],
2143 .finger_count
= wd
->maxcontacts
,
2145 .end_of_frame
= (data
[0] >> 7) == 0,
2146 .button
= data
[0] & 0x01,
2149 wtp_send_raw_xy_event(hidpp
, &raw
);
2154 static int wtp_raw_event(struct hid_device
*hdev
, u8
*data
, int size
)
2156 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2157 struct wtp_data
*wd
= hidpp
->private_data
;
2158 struct hidpp_report
*report
= (struct hidpp_report
*)data
;
2159 struct hidpp_touchpad_raw_xy raw
;
2161 if (!wd
|| !wd
->input
)
2167 hid_err(hdev
, "Received HID report of bad size (%d)",
2171 if (hidpp
->quirks
& HIDPP_QUIRK_WTP_PHYSICAL_BUTTONS
) {
2172 input_event(wd
->input
, EV_KEY
, BTN_LEFT
,
2173 !!(data
[1] & 0x01));
2174 input_event(wd
->input
, EV_KEY
, BTN_RIGHT
,
2175 !!(data
[1] & 0x02));
2176 input_sync(wd
->input
);
2181 return wtp_mouse_raw_xy_event(hidpp
, &data
[7]);
2183 case REPORT_ID_HIDPP_LONG
:
2184 /* size is already checked in hidpp_raw_event. */
2185 if ((report
->fap
.feature_index
!= wd
->mt_feature_index
) ||
2186 (report
->fap
.funcindex_clientid
!= EVENT_TOUCHPAD_RAW_XY
))
2188 hidpp_touchpad_raw_xy_event(hidpp
, data
+ 4, &raw
);
2190 wtp_send_raw_xy_event(hidpp
, &raw
);
2197 static int wtp_get_config(struct hidpp_device
*hidpp
)
2199 struct wtp_data
*wd
= hidpp
->private_data
;
2200 struct hidpp_touchpad_raw_info raw_info
= {0};
2204 ret
= hidpp_root_get_feature(hidpp
, HIDPP_PAGE_TOUCHPAD_RAW_XY
,
2205 &wd
->mt_feature_index
, &feature_type
);
2207 /* means that the device is not powered up */
2210 ret
= hidpp_touchpad_get_raw_info(hidpp
, wd
->mt_feature_index
,
2215 wd
->x_size
= raw_info
.x_size
;
2216 wd
->y_size
= raw_info
.y_size
;
2217 wd
->maxcontacts
= raw_info
.maxcontacts
;
2218 wd
->flip_y
= raw_info
.origin
== TOUCHPAD_RAW_XY_ORIGIN_LOWER_LEFT
;
2219 wd
->resolution
= raw_info
.res
;
2220 if (!wd
->resolution
)
2221 wd
->resolution
= WTP_MANUAL_RESOLUTION
;
2226 static int wtp_allocate(struct hid_device
*hdev
, const struct hid_device_id
*id
)
2228 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2229 struct wtp_data
*wd
;
2231 wd
= devm_kzalloc(&hdev
->dev
, sizeof(struct wtp_data
),
2236 hidpp
->private_data
= wd
;
2241 static int wtp_connect(struct hid_device
*hdev
, bool connected
)
2243 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2244 struct wtp_data
*wd
= hidpp
->private_data
;
2248 ret
= wtp_get_config(hidpp
);
2250 hid_err(hdev
, "Can not get wtp config: %d\n", ret
);
2255 return hidpp_touchpad_set_raw_report_state(hidpp
, wd
->mt_feature_index
,
2259 /* ------------------------------------------------------------------------- */
2260 /* Logitech M560 devices */
2261 /* ------------------------------------------------------------------------- */
2264 * Logitech M560 protocol overview
2266 * The Logitech M560 mouse, is designed for windows 8. When the middle and/or
2267 * the sides buttons are pressed, it sends some keyboard keys events
2268 * instead of buttons ones.
2269 * To complicate things further, the middle button keys sequence
2270 * is different from the odd press and the even press.
2272 * forward button -> Super_R
2273 * backward button -> Super_L+'d' (press only)
2274 * middle button -> 1st time: Alt_L+SuperL+XF86TouchpadOff (press only)
2275 * 2nd time: left-click (press only)
2276 * NB: press-only means that when the button is pressed, the
2277 * KeyPress/ButtonPress and KeyRelease/ButtonRelease events are generated
2278 * together sequentially; instead when the button is released, no event is
2282 * 10<xx>0a 3500af03 (where <xx> is the mouse id),
2283 * the mouse reacts differently:
2284 * - it never sends a keyboard key event
2285 * - for the three mouse button it sends:
2286 * middle button press 11<xx>0a 3500af00...
2287 * side 1 button (forward) press 11<xx>0a 3500b000...
2288 * side 2 button (backward) press 11<xx>0a 3500ae00...
2289 * middle/side1/side2 button release 11<xx>0a 35000000...
2292 static const u8 m560_config_parameter
[] = {0x00, 0xaf, 0x03};
2294 struct m560_private_data
{
2295 struct input_dev
*input
;
2298 /* how buttons are mapped in the report */
2299 #define M560_MOUSE_BTN_LEFT 0x01
2300 #define M560_MOUSE_BTN_RIGHT 0x02
2301 #define M560_MOUSE_BTN_WHEEL_LEFT 0x08
2302 #define M560_MOUSE_BTN_WHEEL_RIGHT 0x10
2304 #define M560_SUB_ID 0x0a
2305 #define M560_BUTTON_MODE_REGISTER 0x35
2307 static int m560_send_config_command(struct hid_device
*hdev
, bool connected
)
2309 struct hidpp_report response
;
2310 struct hidpp_device
*hidpp_dev
;
2312 hidpp_dev
= hid_get_drvdata(hdev
);
2314 return hidpp_send_rap_command_sync(
2316 REPORT_ID_HIDPP_SHORT
,
2318 M560_BUTTON_MODE_REGISTER
,
2319 (u8
*)m560_config_parameter
,
2320 sizeof(m560_config_parameter
),
2325 static int m560_allocate(struct hid_device
*hdev
)
2327 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2328 struct m560_private_data
*d
;
2330 d
= devm_kzalloc(&hdev
->dev
, sizeof(struct m560_private_data
),
2335 hidpp
->private_data
= d
;
2340 static int m560_raw_event(struct hid_device
*hdev
, u8
*data
, int size
)
2342 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2343 struct m560_private_data
*mydata
= hidpp
->private_data
;
2346 if (!mydata
|| !mydata
->input
) {
2347 hid_err(hdev
, "error in parameter\n");
2352 hid_err(hdev
, "error in report\n");
2356 if (data
[0] == REPORT_ID_HIDPP_LONG
&&
2357 data
[2] == M560_SUB_ID
&& data
[6] == 0x00) {
2359 * m560 mouse report for middle, forward and backward button
2362 * data[1] = device-id
2364 * data[5] = 0xaf -> middle
2367 * 0x00 -> release all
2373 input_report_key(mydata
->input
, BTN_MIDDLE
, 1);
2376 input_report_key(mydata
->input
, BTN_FORWARD
, 1);
2379 input_report_key(mydata
->input
, BTN_BACK
, 1);
2382 input_report_key(mydata
->input
, BTN_BACK
, 0);
2383 input_report_key(mydata
->input
, BTN_FORWARD
, 0);
2384 input_report_key(mydata
->input
, BTN_MIDDLE
, 0);
2387 hid_err(hdev
, "error in report\n");
2390 input_sync(mydata
->input
);
2392 } else if (data
[0] == 0x02) {
2394 * Logitech M560 mouse report
2396 * data[0] = type (0x02)
2397 * data[1..2] = buttons
2404 input_report_key(mydata
->input
, BTN_LEFT
,
2405 !!(data
[1] & M560_MOUSE_BTN_LEFT
));
2406 input_report_key(mydata
->input
, BTN_RIGHT
,
2407 !!(data
[1] & M560_MOUSE_BTN_RIGHT
));
2409 if (data
[1] & M560_MOUSE_BTN_WHEEL_LEFT
)
2410 input_report_rel(mydata
->input
, REL_HWHEEL
, -1);
2411 else if (data
[1] & M560_MOUSE_BTN_WHEEL_RIGHT
)
2412 input_report_rel(mydata
->input
, REL_HWHEEL
, 1);
2414 v
= hid_snto32(hid_field_extract(hdev
, data
+3, 0, 12), 12);
2415 input_report_rel(mydata
->input
, REL_X
, v
);
2417 v
= hid_snto32(hid_field_extract(hdev
, data
+3, 12, 12), 12);
2418 input_report_rel(mydata
->input
, REL_Y
, v
);
2420 v
= hid_snto32(data
[6], 8);
2421 input_report_rel(mydata
->input
, REL_WHEEL
, v
);
2423 input_sync(mydata
->input
);
2429 static void m560_populate_input(struct hidpp_device
*hidpp
,
2430 struct input_dev
*input_dev
, bool origin_is_hid_core
)
2432 struct m560_private_data
*mydata
= hidpp
->private_data
;
2434 mydata
->input
= input_dev
;
2436 __set_bit(EV_KEY
, mydata
->input
->evbit
);
2437 __set_bit(BTN_MIDDLE
, mydata
->input
->keybit
);
2438 __set_bit(BTN_RIGHT
, mydata
->input
->keybit
);
2439 __set_bit(BTN_LEFT
, mydata
->input
->keybit
);
2440 __set_bit(BTN_BACK
, mydata
->input
->keybit
);
2441 __set_bit(BTN_FORWARD
, mydata
->input
->keybit
);
2443 __set_bit(EV_REL
, mydata
->input
->evbit
);
2444 __set_bit(REL_X
, mydata
->input
->relbit
);
2445 __set_bit(REL_Y
, mydata
->input
->relbit
);
2446 __set_bit(REL_WHEEL
, mydata
->input
->relbit
);
2447 __set_bit(REL_HWHEEL
, mydata
->input
->relbit
);
2450 static int m560_input_mapping(struct hid_device
*hdev
, struct hid_input
*hi
,
2451 struct hid_field
*field
, struct hid_usage
*usage
,
2452 unsigned long **bit
, int *max
)
2457 /* ------------------------------------------------------------------------- */
2458 /* Logitech K400 devices */
2459 /* ------------------------------------------------------------------------- */
2462 * The Logitech K400 keyboard has an embedded touchpad which is seen
2463 * as a mouse from the OS point of view. There is a hardware shortcut to disable
2464 * tap-to-click but the setting is not remembered accross reset, annoying some
2467 * We can toggle this feature from the host by using the feature 0x6010:
2471 struct k400_private_data
{
2475 static int k400_disable_tap_to_click(struct hidpp_device
*hidpp
)
2477 struct k400_private_data
*k400
= hidpp
->private_data
;
2478 struct hidpp_touchpad_fw_items items
= {};
2482 if (!k400
->feature_index
) {
2483 ret
= hidpp_root_get_feature(hidpp
,
2484 HIDPP_PAGE_TOUCHPAD_FW_ITEMS
,
2485 &k400
->feature_index
, &feature_type
);
2487 /* means that the device is not powered up */
2491 ret
= hidpp_touchpad_fw_items_set(hidpp
, k400
->feature_index
, &items
);
2498 static int k400_allocate(struct hid_device
*hdev
)
2500 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2501 struct k400_private_data
*k400
;
2503 k400
= devm_kzalloc(&hdev
->dev
, sizeof(struct k400_private_data
),
2508 hidpp
->private_data
= k400
;
2513 static int k400_connect(struct hid_device
*hdev
, bool connected
)
2515 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2517 if (!disable_tap_to_click
)
2520 return k400_disable_tap_to_click(hidpp
);
2523 /* ------------------------------------------------------------------------- */
2524 /* Logitech G920 Driving Force Racing Wheel for Xbox One */
2525 /* ------------------------------------------------------------------------- */
2527 #define HIDPP_PAGE_G920_FORCE_FEEDBACK 0x8123
2529 static int g920_get_config(struct hidpp_device
*hidpp
)
2535 /* Find feature and store for later use */
2536 ret
= hidpp_root_get_feature(hidpp
, HIDPP_PAGE_G920_FORCE_FEEDBACK
,
2537 &feature_index
, &feature_type
);
2541 ret
= hidpp_ff_init(hidpp
, feature_index
);
2543 hid_warn(hidpp
->hid_dev
, "Unable to initialize force feedback support, errno %d\n",
2549 /* -------------------------------------------------------------------------- */
2550 /* Generic HID++ devices */
2551 /* -------------------------------------------------------------------------- */
2553 static int hidpp_input_mapping(struct hid_device
*hdev
, struct hid_input
*hi
,
2554 struct hid_field
*field
, struct hid_usage
*usage
,
2555 unsigned long **bit
, int *max
)
2557 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2559 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_WTP
)
2560 return wtp_input_mapping(hdev
, hi
, field
, usage
, bit
, max
);
2561 else if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_M560
&&
2562 field
->application
!= HID_GD_MOUSE
)
2563 return m560_input_mapping(hdev
, hi
, field
, usage
, bit
, max
);
2568 static int hidpp_input_mapped(struct hid_device
*hdev
, struct hid_input
*hi
,
2569 struct hid_field
*field
, struct hid_usage
*usage
,
2570 unsigned long **bit
, int *max
)
2572 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2574 /* Ensure that Logitech G920 is not given a default fuzz/flat value */
2575 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_G920
) {
2576 if (usage
->type
== EV_ABS
&& (usage
->code
== ABS_X
||
2577 usage
->code
== ABS_Y
|| usage
->code
== ABS_Z
||
2578 usage
->code
== ABS_RZ
)) {
2579 field
->application
= HID_GD_MULTIAXIS
;
2587 static void hidpp_populate_input(struct hidpp_device
*hidpp
,
2588 struct input_dev
*input
, bool origin_is_hid_core
)
2590 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_WTP
)
2591 wtp_populate_input(hidpp
, input
, origin_is_hid_core
);
2592 else if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_M560
)
2593 m560_populate_input(hidpp
, input
, origin_is_hid_core
);
2596 static int hidpp_input_configured(struct hid_device
*hdev
,
2597 struct hid_input
*hidinput
)
2599 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2600 struct input_dev
*input
= hidinput
->input
;
2602 hidpp_populate_input(hidpp
, input
, true);
2607 static int hidpp_raw_hidpp_event(struct hidpp_device
*hidpp
, u8
*data
,
2610 struct hidpp_report
*question
= hidpp
->send_receive_buf
;
2611 struct hidpp_report
*answer
= hidpp
->send_receive_buf
;
2612 struct hidpp_report
*report
= (struct hidpp_report
*)data
;
2616 * If the mutex is locked then we have a pending answer from a
2617 * previously sent command.
2619 if (unlikely(mutex_is_locked(&hidpp
->send_mutex
))) {
2621 * Check for a correct hidpp20 answer or the corresponding
2624 if (hidpp_match_answer(question
, report
) ||
2625 hidpp_match_error(question
, report
)) {
2627 hidpp
->answer_available
= true;
2628 wake_up(&hidpp
->wait
);
2630 * This was an answer to a command that this driver sent
2631 * We return 1 to hid-core to avoid forwarding the
2632 * command upstream as it has been treated by the driver
2639 if (unlikely(hidpp_report_is_connect_event(report
))) {
2640 atomic_set(&hidpp
->connected
,
2641 !(report
->rap
.params
[0] & (1 << 6)));
2642 if (schedule_work(&hidpp
->work
) == 0)
2643 dbg_hid("%s: connect event already queued\n", __func__
);
2647 if (hidpp
->capabilities
& HIDPP_CAPABILITY_HIDPP20_BATTERY
) {
2648 ret
= hidpp20_battery_event(hidpp
, data
, size
);
2651 ret
= hidpp_solar_battery_event(hidpp
, data
, size
);
2656 if (hidpp
->capabilities
& HIDPP_CAPABILITY_HIDPP10_BATTERY
) {
2657 ret
= hidpp10_battery_event(hidpp
, data
, size
);
2665 static int hidpp_raw_event(struct hid_device
*hdev
, struct hid_report
*report
,
2668 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2671 /* Generic HID++ processing. */
2673 case REPORT_ID_HIDPP_VERY_LONG
:
2674 if (size
!= HIDPP_REPORT_VERY_LONG_LENGTH
) {
2675 hid_err(hdev
, "received hid++ report of bad size (%d)",
2679 ret
= hidpp_raw_hidpp_event(hidpp
, data
, size
);
2681 case REPORT_ID_HIDPP_LONG
:
2682 if (size
!= HIDPP_REPORT_LONG_LENGTH
) {
2683 hid_err(hdev
, "received hid++ report of bad size (%d)",
2687 ret
= hidpp_raw_hidpp_event(hidpp
, data
, size
);
2689 case REPORT_ID_HIDPP_SHORT
:
2690 if (size
!= HIDPP_REPORT_SHORT_LENGTH
) {
2691 hid_err(hdev
, "received hid++ report of bad size (%d)",
2695 ret
= hidpp_raw_hidpp_event(hidpp
, data
, size
);
2699 /* If no report is available for further processing, skip calling
2700 * raw_event of subclasses. */
2704 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_WTP
)
2705 return wtp_raw_event(hdev
, data
, size
);
2706 else if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_M560
)
2707 return m560_raw_event(hdev
, data
, size
);
2712 static int hidpp_initialize_battery(struct hidpp_device
*hidpp
)
2714 static atomic_t battery_no
= ATOMIC_INIT(0);
2715 struct power_supply_config cfg
= { .drv_data
= hidpp
};
2716 struct power_supply_desc
*desc
= &hidpp
->battery
.desc
;
2717 enum power_supply_property
*battery_props
;
2718 struct hidpp_battery
*battery
;
2719 unsigned int num_battery_props
;
2723 if (hidpp
->battery
.ps
)
2726 hidpp
->battery
.feature_index
= 0xff;
2727 hidpp
->battery
.solar_feature_index
= 0xff;
2729 if (hidpp
->protocol_major
>= 2) {
2730 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_K750
)
2731 ret
= hidpp_solar_request_battery_event(hidpp
);
2733 ret
= hidpp20_query_battery_info(hidpp
);
2737 hidpp
->capabilities
|= HIDPP_CAPABILITY_HIDPP20_BATTERY
;
2739 ret
= hidpp10_query_battery_status(hidpp
);
2741 ret
= hidpp10_query_battery_mileage(hidpp
);
2744 hidpp
->capabilities
|= HIDPP_CAPABILITY_BATTERY_MILEAGE
;
2746 hidpp
->capabilities
|= HIDPP_CAPABILITY_BATTERY_LEVEL_STATUS
;
2748 hidpp
->capabilities
|= HIDPP_CAPABILITY_HIDPP10_BATTERY
;
2751 battery_props
= devm_kmemdup(&hidpp
->hid_dev
->dev
,
2752 hidpp_battery_props
,
2753 sizeof(hidpp_battery_props
),
2758 num_battery_props
= ARRAY_SIZE(hidpp_battery_props
) - 2;
2760 if (hidpp
->capabilities
& HIDPP_CAPABILITY_BATTERY_MILEAGE
)
2761 battery_props
[num_battery_props
++] =
2762 POWER_SUPPLY_PROP_CAPACITY
;
2764 if (hidpp
->capabilities
& HIDPP_CAPABILITY_BATTERY_LEVEL_STATUS
)
2765 battery_props
[num_battery_props
++] =
2766 POWER_SUPPLY_PROP_CAPACITY_LEVEL
;
2768 battery
= &hidpp
->battery
;
2770 n
= atomic_inc_return(&battery_no
) - 1;
2771 desc
->properties
= battery_props
;
2772 desc
->num_properties
= num_battery_props
;
2773 desc
->get_property
= hidpp_battery_get_property
;
2774 sprintf(battery
->name
, "hidpp_battery_%ld", n
);
2775 desc
->name
= battery
->name
;
2776 desc
->type
= POWER_SUPPLY_TYPE_BATTERY
;
2777 desc
->use_for_apm
= 0;
2779 battery
->ps
= devm_power_supply_register(&hidpp
->hid_dev
->dev
,
2782 if (IS_ERR(battery
->ps
))
2783 return PTR_ERR(battery
->ps
);
2785 power_supply_powers(battery
->ps
, &hidpp
->hid_dev
->dev
);
2790 static void hidpp_overwrite_name(struct hid_device
*hdev
)
2792 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2795 if (hidpp
->protocol_major
< 2)
2798 name
= hidpp_get_device_name(hidpp
);
2801 hid_err(hdev
, "unable to retrieve the name of the device");
2803 dbg_hid("HID++: Got name: %s\n", name
);
2804 snprintf(hdev
->name
, sizeof(hdev
->name
), "%s", name
);
2810 static int hidpp_input_open(struct input_dev
*dev
)
2812 struct hid_device
*hid
= input_get_drvdata(dev
);
2814 return hid_hw_open(hid
);
2817 static void hidpp_input_close(struct input_dev
*dev
)
2819 struct hid_device
*hid
= input_get_drvdata(dev
);
2824 static struct input_dev
*hidpp_allocate_input(struct hid_device
*hdev
)
2826 struct input_dev
*input_dev
= devm_input_allocate_device(&hdev
->dev
);
2827 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
2832 input_set_drvdata(input_dev
, hdev
);
2833 input_dev
->open
= hidpp_input_open
;
2834 input_dev
->close
= hidpp_input_close
;
2836 input_dev
->name
= hidpp
->name
;
2837 input_dev
->phys
= hdev
->phys
;
2838 input_dev
->uniq
= hdev
->uniq
;
2839 input_dev
->id
.bustype
= hdev
->bus
;
2840 input_dev
->id
.vendor
= hdev
->vendor
;
2841 input_dev
->id
.product
= hdev
->product
;
2842 input_dev
->id
.version
= hdev
->version
;
2843 input_dev
->dev
.parent
= &hdev
->dev
;
2848 static void hidpp_connect_event(struct hidpp_device
*hidpp
)
2850 struct hid_device
*hdev
= hidpp
->hid_dev
;
2852 bool connected
= atomic_read(&hidpp
->connected
);
2853 struct input_dev
*input
;
2854 char *name
, *devm_name
;
2857 if (hidpp
->battery
.ps
) {
2858 hidpp
->battery
.online
= false;
2859 hidpp
->battery
.status
= POWER_SUPPLY_STATUS_UNKNOWN
;
2860 hidpp
->battery
.level
= POWER_SUPPLY_CAPACITY_LEVEL_UNKNOWN
;
2861 power_supply_changed(hidpp
->battery
.ps
);
2866 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_WTP
) {
2867 ret
= wtp_connect(hdev
, connected
);
2870 } else if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_M560
) {
2871 ret
= m560_send_config_command(hdev
, connected
);
2874 } else if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_K400
) {
2875 ret
= k400_connect(hdev
, connected
);
2880 /* the device is already connected, we can ask for its name and
2882 if (!hidpp
->protocol_major
) {
2883 ret
= !hidpp_is_connected(hidpp
);
2885 hid_err(hdev
, "Can not get the protocol version.\n");
2888 hid_info(hdev
, "HID++ %u.%u device connected.\n",
2889 hidpp
->protocol_major
, hidpp
->protocol_minor
);
2892 if (hidpp
->name
== hdev
->name
&& hidpp
->protocol_major
>= 2) {
2893 name
= hidpp_get_device_name(hidpp
);
2896 "unable to retrieve the name of the device");
2900 devm_name
= devm_kasprintf(&hdev
->dev
, GFP_KERNEL
, "%s", name
);
2905 hidpp
->name
= devm_name
;
2908 hidpp_initialize_battery(hidpp
);
2910 /* forward current battery state */
2911 if (hidpp
->capabilities
& HIDPP_CAPABILITY_HIDPP10_BATTERY
) {
2912 hidpp10_enable_battery_reporting(hidpp
);
2913 if (hidpp
->capabilities
& HIDPP_CAPABILITY_BATTERY_MILEAGE
)
2914 hidpp10_query_battery_mileage(hidpp
);
2916 hidpp10_query_battery_status(hidpp
);
2917 } else if (hidpp
->capabilities
& HIDPP_CAPABILITY_HIDPP20_BATTERY
) {
2918 hidpp20_query_battery_info(hidpp
);
2920 if (hidpp
->battery
.ps
)
2921 power_supply_changed(hidpp
->battery
.ps
);
2923 if (!(hidpp
->quirks
& HIDPP_QUIRK_NO_HIDINPUT
) || hidpp
->delayed_input
)
2924 /* if the input nodes are already created, we can stop now */
2927 input
= hidpp_allocate_input(hdev
);
2929 hid_err(hdev
, "cannot allocate new input device: %d\n", ret
);
2933 hidpp_populate_input(hidpp
, input
, false);
2935 ret
= input_register_device(input
);
2937 input_free_device(input
);
2939 hidpp
->delayed_input
= input
;
2942 static DEVICE_ATTR(builtin_power_supply
, 0000, NULL
, NULL
);
2944 static struct attribute
*sysfs_attrs
[] = {
2945 &dev_attr_builtin_power_supply
.attr
,
2949 static const struct attribute_group ps_attribute_group
= {
2950 .attrs
= sysfs_attrs
2953 static int hidpp_probe(struct hid_device
*hdev
, const struct hid_device_id
*id
)
2955 struct hidpp_device
*hidpp
;
2958 unsigned int connect_mask
= HID_CONNECT_DEFAULT
;
2960 hidpp
= devm_kzalloc(&hdev
->dev
, sizeof(struct hidpp_device
),
2965 hidpp
->hid_dev
= hdev
;
2966 hidpp
->name
= hdev
->name
;
2967 hid_set_drvdata(hdev
, hidpp
);
2969 hidpp
->quirks
= id
->driver_data
;
2971 if (id
->group
== HID_GROUP_LOGITECH_DJ_DEVICE
)
2972 hidpp
->quirks
|= HIDPP_QUIRK_UNIFYING
;
2974 if (disable_raw_mode
) {
2975 hidpp
->quirks
&= ~HIDPP_QUIRK_CLASS_WTP
;
2976 hidpp
->quirks
&= ~HIDPP_QUIRK_NO_HIDINPUT
;
2979 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_WTP
) {
2980 ret
= wtp_allocate(hdev
, id
);
2983 } else if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_M560
) {
2984 ret
= m560_allocate(hdev
);
2987 } else if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_K400
) {
2988 ret
= k400_allocate(hdev
);
2993 INIT_WORK(&hidpp
->work
, delayed_work_cb
);
2994 mutex_init(&hidpp
->send_mutex
);
2995 init_waitqueue_head(&hidpp
->wait
);
2997 /* indicates we are handling the battery properties in the kernel */
2998 ret
= sysfs_create_group(&hdev
->dev
.kobj
, &ps_attribute_group
);
3000 hid_warn(hdev
, "Cannot allocate sysfs group for %s\n",
3003 ret
= hid_parse(hdev
);
3005 hid_err(hdev
, "%s:parse failed\n", __func__
);
3006 goto hid_parse_fail
;
3009 if (hidpp
->quirks
& HIDPP_QUIRK_NO_HIDINPUT
)
3010 connect_mask
&= ~HID_CONNECT_HIDINPUT
;
3012 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_G920
) {
3013 ret
= hid_hw_start(hdev
, connect_mask
);
3015 hid_err(hdev
, "hw start failed\n");
3016 goto hid_hw_start_fail
;
3018 ret
= hid_hw_open(hdev
);
3020 dev_err(&hdev
->dev
, "%s:hid_hw_open returned error:%d\n",
3023 goto hid_hw_start_fail
;
3028 /* Allow incoming packets */
3029 hid_device_io_start(hdev
);
3031 if (hidpp
->quirks
& HIDPP_QUIRK_UNIFYING
)
3032 hidpp_unifying_init(hidpp
);
3034 connected
= hidpp_is_connected(hidpp
);
3035 atomic_set(&hidpp
->connected
, connected
);
3036 if (!(hidpp
->quirks
& HIDPP_QUIRK_UNIFYING
)) {
3039 hid_err(hdev
, "Device not connected");
3040 goto hid_hw_open_failed
;
3043 hid_info(hdev
, "HID++ %u.%u device connected.\n",
3044 hidpp
->protocol_major
, hidpp
->protocol_minor
);
3046 hidpp_overwrite_name(hdev
);
3049 if (connected
&& (hidpp
->quirks
& HIDPP_QUIRK_CLASS_WTP
)) {
3050 ret
= wtp_get_config(hidpp
);
3052 goto hid_hw_open_failed
;
3053 } else if (connected
&& (hidpp
->quirks
& HIDPP_QUIRK_CLASS_G920
)) {
3054 ret
= g920_get_config(hidpp
);
3056 goto hid_hw_open_failed
;
3059 /* Block incoming packets */
3060 hid_device_io_stop(hdev
);
3062 if (!(hidpp
->quirks
& HIDPP_QUIRK_CLASS_G920
)) {
3063 ret
= hid_hw_start(hdev
, connect_mask
);
3065 hid_err(hdev
, "%s:hid_hw_start returned error\n", __func__
);
3066 goto hid_hw_start_fail
;
3070 /* Allow incoming packets */
3071 hid_device_io_start(hdev
);
3073 hidpp_connect_event(hidpp
);
3078 hid_device_io_stop(hdev
);
3079 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_G920
) {
3085 sysfs_remove_group(&hdev
->dev
.kobj
, &ps_attribute_group
);
3086 cancel_work_sync(&hidpp
->work
);
3087 mutex_destroy(&hidpp
->send_mutex
);
3089 hid_set_drvdata(hdev
, NULL
);
3093 static void hidpp_remove(struct hid_device
*hdev
)
3095 struct hidpp_device
*hidpp
= hid_get_drvdata(hdev
);
3097 sysfs_remove_group(&hdev
->dev
.kobj
, &ps_attribute_group
);
3099 if (hidpp
->quirks
& HIDPP_QUIRK_CLASS_G920
) {
3100 hidpp_ff_deinit(hdev
);
3104 cancel_work_sync(&hidpp
->work
);
3105 mutex_destroy(&hidpp
->send_mutex
);
3108 static const struct hid_device_id hidpp_devices
[] = {
3109 { /* wireless touchpad */
3110 HID_DEVICE(BUS_USB
, HID_GROUP_LOGITECH_DJ_DEVICE
,
3111 USB_VENDOR_ID_LOGITECH
, 0x4011),
3112 .driver_data
= HIDPP_QUIRK_CLASS_WTP
| HIDPP_QUIRK_DELAYED_INIT
|
3113 HIDPP_QUIRK_WTP_PHYSICAL_BUTTONS
},
3114 { /* wireless touchpad T650 */
3115 HID_DEVICE(BUS_USB
, HID_GROUP_LOGITECH_DJ_DEVICE
,
3116 USB_VENDOR_ID_LOGITECH
, 0x4101),
3117 .driver_data
= HIDPP_QUIRK_CLASS_WTP
| HIDPP_QUIRK_DELAYED_INIT
},
3118 { /* wireless touchpad T651 */
3119 HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_LOGITECH
,
3120 USB_DEVICE_ID_LOGITECH_T651
),
3121 .driver_data
= HIDPP_QUIRK_CLASS_WTP
},
3122 { /* Mouse logitech M560 */
3123 HID_DEVICE(BUS_USB
, HID_GROUP_LOGITECH_DJ_DEVICE
,
3124 USB_VENDOR_ID_LOGITECH
, 0x402d),
3125 .driver_data
= HIDPP_QUIRK_DELAYED_INIT
| HIDPP_QUIRK_CLASS_M560
},
3126 { /* Keyboard logitech K400 */
3127 HID_DEVICE(BUS_USB
, HID_GROUP_LOGITECH_DJ_DEVICE
,
3128 USB_VENDOR_ID_LOGITECH
, 0x4024),
3129 .driver_data
= HIDPP_QUIRK_CLASS_K400
},
3130 { /* Solar Keyboard Logitech K750 */
3131 HID_DEVICE(BUS_USB
, HID_GROUP_LOGITECH_DJ_DEVICE
,
3132 USB_VENDOR_ID_LOGITECH
, 0x4002),
3133 .driver_data
= HIDPP_QUIRK_CLASS_K750
},
3135 { HID_DEVICE(BUS_USB
, HID_GROUP_LOGITECH_DJ_DEVICE
,
3136 USB_VENDOR_ID_LOGITECH
, HID_ANY_ID
)},
3138 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH
, USB_DEVICE_ID_LOGITECH_G920_WHEEL
),
3139 .driver_data
= HIDPP_QUIRK_CLASS_G920
| HIDPP_QUIRK_FORCE_OUTPUT_REPORTS
},
3143 MODULE_DEVICE_TABLE(hid
, hidpp_devices
);
3145 static struct hid_driver hidpp_driver
= {
3146 .name
= "logitech-hidpp-device",
3147 .id_table
= hidpp_devices
,
3148 .probe
= hidpp_probe
,
3149 .remove
= hidpp_remove
,
3150 .raw_event
= hidpp_raw_event
,
3151 .input_configured
= hidpp_input_configured
,
3152 .input_mapping
= hidpp_input_mapping
,
3153 .input_mapped
= hidpp_input_mapped
,
3156 module_hid_driver(hidpp_driver
);