3 * Copyright (c) 2012, Intel Corporation.
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms and conditions of the GNU General Public License,
7 * version 2, as published by the Free Software Foundation.
9 * This program is distributed in the hope it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
14 * You should have received a copy of the GNU General Public License along with
15 * this program; if not, write to the Free Software Foundation, Inc.,
16 * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
20 #include <linux/device.h>
21 #include <linux/hid.h>
22 #include <linux/module.h>
23 #include <linux/slab.h>
24 #include <linux/mfd/core.h>
25 #include <linux/list.h>
26 #include <linux/hid-sensor-ids.h>
27 #include <linux/hid-sensor-hub.h>
30 #define HID_SENSOR_HUB_ENUM_QUIRK 0x01
33 * struct sensor_hub_data - Hold a instance data for a HID hub device
34 * @hsdev: Stored hid instance for current hub device.
35 * @mutex: Mutex to serialize synchronous request.
36 * @lock: Spin lock to protect pending request structure.
37 * @dyn_callback_list: Holds callback function
38 * @dyn_callback_lock: spin lock to protect callback list
39 * @hid_sensor_hub_client_devs: Stores all MFD cells for a hub instance.
40 * @hid_sensor_client_cnt: Number of MFD cells, (no of sensors attached).
41 * @ref_cnt: Number of MFD clients have opened this device
43 struct sensor_hub_data
{
46 struct list_head dyn_callback_list
;
47 spinlock_t dyn_callback_lock
;
48 struct mfd_cell
*hid_sensor_hub_client_devs
;
49 int hid_sensor_client_cnt
;
55 * struct hid_sensor_hub_callbacks_list - Stores callback list
57 * @usage_id: usage id for a physical device.
58 * @usage_callback: Stores registered callback functions.
59 * @priv: Private data for a physical device.
61 struct hid_sensor_hub_callbacks_list
{
62 struct list_head list
;
64 struct hid_sensor_hub_device
*hsdev
;
65 struct hid_sensor_hub_callbacks
*usage_callback
;
69 static struct hid_report
*sensor_hub_report(int id
, struct hid_device
*hdev
,
72 struct hid_report
*report
;
74 list_for_each_entry(report
, &hdev
->report_enum
[dir
].report_list
, list
) {
78 hid_warn(hdev
, "No report with id 0x%x found\n", id
);
83 static int sensor_hub_get_physical_device_count(struct hid_device
*hdev
)
88 for (i
= 0; i
< hdev
->maxcollection
; ++i
) {
89 struct hid_collection
*collection
= &hdev
->collection
[i
];
90 if (collection
->type
== HID_COLLECTION_PHYSICAL
||
91 collection
->type
== HID_COLLECTION_APPLICATION
)
98 static void sensor_hub_fill_attr_info(
99 struct hid_sensor_hub_attribute_info
*info
,
100 s32 index
, s32 report_id
, struct hid_field
*field
)
103 info
->report_id
= report_id
;
104 info
->units
= field
->unit
;
105 info
->unit_expo
= field
->unit_exponent
;
106 info
->size
= (field
->report_size
* field
->report_count
)/8;
107 info
->logical_minimum
= field
->logical_minimum
;
108 info
->logical_maximum
= field
->logical_maximum
;
111 static struct hid_sensor_hub_callbacks
*sensor_hub_get_callback(
112 struct hid_device
*hdev
,
114 int collection_index
,
115 struct hid_sensor_hub_device
**hsdev
,
118 struct hid_sensor_hub_callbacks_list
*callback
;
119 struct sensor_hub_data
*pdata
= hid_get_drvdata(hdev
);
122 spin_lock_irqsave(&pdata
->dyn_callback_lock
, flags
);
123 list_for_each_entry(callback
, &pdata
->dyn_callback_list
, list
)
124 if ((callback
->usage_id
== usage_id
||
125 callback
->usage_id
== HID_USAGE_SENSOR_COLLECTION
) &&
127 callback
->hsdev
->start_collection_index
) &&
129 callback
->hsdev
->end_collection_index
)) {
130 *priv
= callback
->priv
;
131 *hsdev
= callback
->hsdev
;
132 spin_unlock_irqrestore(&pdata
->dyn_callback_lock
,
134 return callback
->usage_callback
;
136 spin_unlock_irqrestore(&pdata
->dyn_callback_lock
, flags
);
141 int sensor_hub_register_callback(struct hid_sensor_hub_device
*hsdev
,
143 struct hid_sensor_hub_callbacks
*usage_callback
)
145 struct hid_sensor_hub_callbacks_list
*callback
;
146 struct sensor_hub_data
*pdata
= hid_get_drvdata(hsdev
->hdev
);
149 spin_lock_irqsave(&pdata
->dyn_callback_lock
, flags
);
150 list_for_each_entry(callback
, &pdata
->dyn_callback_list
, list
)
151 if (callback
->usage_id
== usage_id
&&
152 callback
->hsdev
== hsdev
) {
153 spin_unlock_irqrestore(&pdata
->dyn_callback_lock
, flags
);
156 callback
= kzalloc(sizeof(*callback
), GFP_ATOMIC
);
158 spin_unlock_irqrestore(&pdata
->dyn_callback_lock
, flags
);
161 callback
->hsdev
= hsdev
;
162 callback
->usage_callback
= usage_callback
;
163 callback
->usage_id
= usage_id
;
164 callback
->priv
= NULL
;
166 * If there is a handler registered for the collection type, then
167 * it will handle all reports for sensors in this collection. If
168 * there is also an individual sensor handler registration, then
169 * we want to make sure that the reports are directed to collection
170 * handler, as this may be a fusion sensor. So add collection handlers
171 * to the beginning of the list, so that they are matched first.
173 if (usage_id
== HID_USAGE_SENSOR_COLLECTION
)
174 list_add(&callback
->list
, &pdata
->dyn_callback_list
);
176 list_add_tail(&callback
->list
, &pdata
->dyn_callback_list
);
177 spin_unlock_irqrestore(&pdata
->dyn_callback_lock
, flags
);
181 EXPORT_SYMBOL_GPL(sensor_hub_register_callback
);
183 int sensor_hub_remove_callback(struct hid_sensor_hub_device
*hsdev
,
186 struct hid_sensor_hub_callbacks_list
*callback
;
187 struct sensor_hub_data
*pdata
= hid_get_drvdata(hsdev
->hdev
);
190 spin_lock_irqsave(&pdata
->dyn_callback_lock
, flags
);
191 list_for_each_entry(callback
, &pdata
->dyn_callback_list
, list
)
192 if (callback
->usage_id
== usage_id
&&
193 callback
->hsdev
== hsdev
) {
194 list_del(&callback
->list
);
198 spin_unlock_irqrestore(&pdata
->dyn_callback_lock
, flags
);
202 EXPORT_SYMBOL_GPL(sensor_hub_remove_callback
);
204 int sensor_hub_set_feature(struct hid_sensor_hub_device
*hsdev
, u32 report_id
,
205 u32 field_index
, int buffer_size
, void *buffer
)
207 struct hid_report
*report
;
208 struct sensor_hub_data
*data
= hid_get_drvdata(hsdev
->hdev
);
209 __s32
*buf32
= buffer
;
215 mutex_lock(&data
->mutex
);
216 report
= sensor_hub_report(report_id
, hsdev
->hdev
, HID_FEATURE_REPORT
);
217 if (!report
|| (field_index
>= report
->maxfield
)) {
222 remaining_bytes
= buffer_size
% sizeof(__s32
);
223 buffer_size
= buffer_size
/ sizeof(__s32
);
225 for (i
= 0; i
< buffer_size
; ++i
) {
226 hid_set_field(report
->field
[field_index
], i
,
227 (__force __s32
)cpu_to_le32(*buf32
));
231 if (remaining_bytes
) {
233 memcpy(&value
, (u8
*)buf32
, remaining_bytes
);
234 hid_set_field(report
->field
[field_index
], i
,
235 (__force __s32
)cpu_to_le32(value
));
237 hid_hw_request(hsdev
->hdev
, report
, HID_REQ_SET_REPORT
);
238 hid_hw_wait(hsdev
->hdev
);
241 mutex_unlock(&data
->mutex
);
245 EXPORT_SYMBOL_GPL(sensor_hub_set_feature
);
247 int sensor_hub_get_feature(struct hid_sensor_hub_device
*hsdev
, u32 report_id
,
248 u32 field_index
, int buffer_size
, void *buffer
)
250 struct hid_report
*report
;
251 struct sensor_hub_data
*data
= hid_get_drvdata(hsdev
->hdev
);
255 int buffer_index
= 0;
258 mutex_lock(&data
->mutex
);
259 report
= sensor_hub_report(report_id
, hsdev
->hdev
, HID_FEATURE_REPORT
);
260 if (!report
|| (field_index
>= report
->maxfield
) ||
261 report
->field
[field_index
]->report_count
< 1) {
265 hid_hw_request(hsdev
->hdev
, report
, HID_REQ_GET_REPORT
);
266 hid_hw_wait(hsdev
->hdev
);
268 /* calculate number of bytes required to read this field */
269 report_size
= DIV_ROUND_UP(report
->field
[field_index
]->report_size
,
271 report
->field
[field_index
]->report_count
;
276 ret
= min(report_size
, buffer_size
);
278 val_ptr
= (u8
*)report
->field
[field_index
]->value
;
279 for (i
= 0; i
< report
->field
[field_index
]->report_count
; ++i
) {
280 if (buffer_index
>= ret
)
283 memcpy(&((u8
*)buffer
)[buffer_index
], val_ptr
,
284 report
->field
[field_index
]->report_size
/ 8);
285 val_ptr
+= sizeof(__s32
);
286 buffer_index
+= (report
->field
[field_index
]->report_size
/ 8);
290 mutex_unlock(&data
->mutex
);
294 EXPORT_SYMBOL_GPL(sensor_hub_get_feature
);
297 int sensor_hub_input_attr_get_raw_value(struct hid_sensor_hub_device
*hsdev
,
299 u32 attr_usage_id
, u32 report_id
,
300 enum sensor_hub_read_flags flag
)
302 struct sensor_hub_data
*data
= hid_get_drvdata(hsdev
->hdev
);
304 struct hid_report
*report
;
307 report
= sensor_hub_report(report_id
, hsdev
->hdev
,
312 mutex_lock(hsdev
->mutex_ptr
);
313 if (flag
== SENSOR_HUB_SYNC
) {
314 memset(&hsdev
->pending
, 0, sizeof(hsdev
->pending
));
315 init_completion(&hsdev
->pending
.ready
);
316 hsdev
->pending
.usage_id
= usage_id
;
317 hsdev
->pending
.attr_usage_id
= attr_usage_id
;
318 hsdev
->pending
.raw_size
= 0;
320 spin_lock_irqsave(&data
->lock
, flags
);
321 hsdev
->pending
.status
= true;
322 spin_unlock_irqrestore(&data
->lock
, flags
);
324 mutex_lock(&data
->mutex
);
325 hid_hw_request(hsdev
->hdev
, report
, HID_REQ_GET_REPORT
);
326 mutex_unlock(&data
->mutex
);
327 if (flag
== SENSOR_HUB_SYNC
) {
328 wait_for_completion_interruptible_timeout(
329 &hsdev
->pending
.ready
, HZ
*5);
330 switch (hsdev
->pending
.raw_size
) {
332 ret_val
= *(u8
*)hsdev
->pending
.raw_data
;
335 ret_val
= *(u16
*)hsdev
->pending
.raw_data
;
338 ret_val
= *(u32
*)hsdev
->pending
.raw_data
;
343 kfree(hsdev
->pending
.raw_data
);
344 hsdev
->pending
.status
= false;
346 mutex_unlock(hsdev
->mutex_ptr
);
350 EXPORT_SYMBOL_GPL(sensor_hub_input_attr_get_raw_value
);
352 int hid_sensor_get_usage_index(struct hid_sensor_hub_device
*hsdev
,
353 u32 report_id
, int field_index
, u32 usage_id
)
355 struct hid_report
*report
;
356 struct hid_field
*field
;
359 report
= sensor_hub_report(report_id
, hsdev
->hdev
, HID_FEATURE_REPORT
);
360 if (!report
|| (field_index
>= report
->maxfield
))
363 field
= report
->field
[field_index
];
364 for (i
= 0; i
< field
->maxusage
; ++i
) {
365 if (field
->usage
[i
].hid
== usage_id
)
366 return field
->usage
[i
].usage_index
;
372 EXPORT_SYMBOL_GPL(hid_sensor_get_usage_index
);
374 int sensor_hub_input_get_attribute_info(struct hid_sensor_hub_device
*hsdev
,
378 struct hid_sensor_hub_attribute_info
*info
)
382 struct hid_report
*report
;
383 struct hid_field
*field
;
384 struct hid_report_enum
*report_enum
;
385 struct hid_device
*hdev
= hsdev
->hdev
;
387 /* Initialize with defaults */
388 info
->usage_id
= usage_id
;
389 info
->attrib_id
= attr_usage_id
;
390 info
->report_id
= -1;
393 info
->unit_expo
= -1;
395 report_enum
= &hdev
->report_enum
[type
];
396 list_for_each_entry(report
, &report_enum
->report_list
, list
) {
397 for (i
= 0; i
< report
->maxfield
; ++i
) {
398 field
= report
->field
[i
];
399 if (field
->maxusage
) {
400 if (field
->physical
== usage_id
&&
401 (field
->logical
== attr_usage_id
||
402 field
->usage
[0].hid
==
404 (field
->usage
[0].collection_index
>=
405 hsdev
->start_collection_index
) &&
406 (field
->usage
[0].collection_index
<
407 hsdev
->end_collection_index
)) {
409 sensor_hub_fill_attr_info(info
, i
,
422 EXPORT_SYMBOL_GPL(sensor_hub_input_get_attribute_info
);
425 static int sensor_hub_suspend(struct hid_device
*hdev
, pm_message_t message
)
427 struct sensor_hub_data
*pdata
= hid_get_drvdata(hdev
);
428 struct hid_sensor_hub_callbacks_list
*callback
;
431 hid_dbg(hdev
, " sensor_hub_suspend\n");
432 spin_lock_irqsave(&pdata
->dyn_callback_lock
, flags
);
433 list_for_each_entry(callback
, &pdata
->dyn_callback_list
, list
) {
434 if (callback
->usage_callback
->suspend
)
435 callback
->usage_callback
->suspend(
436 callback
->hsdev
, callback
->priv
);
438 spin_unlock_irqrestore(&pdata
->dyn_callback_lock
, flags
);
443 static int sensor_hub_resume(struct hid_device
*hdev
)
445 struct sensor_hub_data
*pdata
= hid_get_drvdata(hdev
);
446 struct hid_sensor_hub_callbacks_list
*callback
;
449 hid_dbg(hdev
, " sensor_hub_resume\n");
450 spin_lock_irqsave(&pdata
->dyn_callback_lock
, flags
);
451 list_for_each_entry(callback
, &pdata
->dyn_callback_list
, list
) {
452 if (callback
->usage_callback
->resume
)
453 callback
->usage_callback
->resume(
454 callback
->hsdev
, callback
->priv
);
456 spin_unlock_irqrestore(&pdata
->dyn_callback_lock
, flags
);
461 static int sensor_hub_reset_resume(struct hid_device
*hdev
)
468 * Handle raw report as sent by device
470 static int sensor_hub_raw_event(struct hid_device
*hdev
,
471 struct hid_report
*report
, u8
*raw_data
, int size
)
476 struct sensor_hub_data
*pdata
= hid_get_drvdata(hdev
);
478 struct hid_sensor_hub_callbacks
*callback
= NULL
;
479 struct hid_collection
*collection
= NULL
;
481 struct hid_sensor_hub_device
*hsdev
= NULL
;
483 hid_dbg(hdev
, "sensor_hub_raw_event report id:0x%x size:%d type:%d\n",
484 report
->id
, size
, report
->type
);
485 hid_dbg(hdev
, "maxfield:%d\n", report
->maxfield
);
486 if (report
->type
!= HID_INPUT_REPORT
)
490 ptr
++; /* Skip report id */
492 spin_lock_irqsave(&pdata
->lock
, flags
);
494 for (i
= 0; i
< report
->maxfield
; ++i
) {
495 hid_dbg(hdev
, "%d collection_index:%x hid:%x sz:%x\n",
496 i
, report
->field
[i
]->usage
->collection_index
,
497 report
->field
[i
]->usage
->hid
,
498 (report
->field
[i
]->report_size
*
499 report
->field
[i
]->report_count
)/8);
500 sz
= (report
->field
[i
]->report_size
*
501 report
->field
[i
]->report_count
)/8;
502 collection
= &hdev
->collection
[
503 report
->field
[i
]->usage
->collection_index
];
504 hid_dbg(hdev
, "collection->usage %x\n",
507 callback
= sensor_hub_get_callback(hdev
,
508 report
->field
[i
]->physical
,
509 report
->field
[i
]->usage
[0].collection_index
,
515 if (hsdev
->pending
.status
&& (hsdev
->pending
.attr_usage_id
==
516 report
->field
[i
]->usage
->hid
||
517 hsdev
->pending
.attr_usage_id
==
518 report
->field
[i
]->logical
)) {
519 hid_dbg(hdev
, "data was pending ...\n");
520 hsdev
->pending
.raw_data
= kmemdup(ptr
, sz
, GFP_ATOMIC
);
521 if (hsdev
->pending
.raw_data
)
522 hsdev
->pending
.raw_size
= sz
;
524 hsdev
->pending
.raw_size
= 0;
525 complete(&hsdev
->pending
.ready
);
527 if (callback
->capture_sample
) {
528 if (report
->field
[i
]->logical
)
529 callback
->capture_sample(hsdev
,
530 report
->field
[i
]->logical
, sz
, ptr
,
533 callback
->capture_sample(hsdev
,
534 report
->field
[i
]->usage
->hid
, sz
, ptr
,
539 if (callback
&& collection
&& callback
->send_event
)
540 callback
->send_event(hsdev
, collection
->usage
,
542 spin_unlock_irqrestore(&pdata
->lock
, flags
);
547 int sensor_hub_device_open(struct hid_sensor_hub_device
*hsdev
)
550 struct sensor_hub_data
*data
= hid_get_drvdata(hsdev
->hdev
);
552 mutex_lock(&data
->mutex
);
553 if (!data
->ref_cnt
) {
554 ret
= hid_hw_open(hsdev
->hdev
);
556 hid_err(hsdev
->hdev
, "failed to open hid device\n");
557 mutex_unlock(&data
->mutex
);
562 mutex_unlock(&data
->mutex
);
566 EXPORT_SYMBOL_GPL(sensor_hub_device_open
);
568 void sensor_hub_device_close(struct hid_sensor_hub_device
*hsdev
)
570 struct sensor_hub_data
*data
= hid_get_drvdata(hsdev
->hdev
);
572 mutex_lock(&data
->mutex
);
575 hid_hw_close(hsdev
->hdev
);
576 mutex_unlock(&data
->mutex
);
578 EXPORT_SYMBOL_GPL(sensor_hub_device_close
);
580 static __u8
*sensor_hub_report_fixup(struct hid_device
*hdev
, __u8
*rdesc
,
584 struct sensor_hub_data
*sd
= hid_get_drvdata(hdev
);
585 unsigned char report_block
[] = {
586 0x0a, 0x16, 0x03, 0x15, 0x00, 0x25, 0x05};
587 unsigned char power_block
[] = {
588 0x0a, 0x19, 0x03, 0x15, 0x00, 0x25, 0x05};
590 if (!(sd
->quirks
& HID_SENSOR_HUB_ENUM_QUIRK
)) {
591 hid_dbg(hdev
, "No Enum quirks\n");
595 /* Looks for power and report state usage id and force to 1 */
596 for (index
= 0; index
< *rsize
; ++index
) {
597 if (((*rsize
- index
) > sizeof(report_block
)) &&
598 !memcmp(&rdesc
[index
], report_block
,
599 sizeof(report_block
))) {
600 rdesc
[index
+ 4] = 0x01;
601 index
+= sizeof(report_block
);
603 if (((*rsize
- index
) > sizeof(power_block
)) &&
604 !memcmp(&rdesc
[index
], power_block
,
605 sizeof(power_block
))) {
606 rdesc
[index
+ 4] = 0x01;
607 index
+= sizeof(power_block
);
611 /* Checks if the report descriptor of Thinkpad Helix 2 has a logical
612 * minimum for magnetic flux axis greater than the maximum */
613 if (hdev
->product
== USB_DEVICE_ID_TEXAS_INSTRUMENTS_LENOVO_YOGA
&&
614 *rsize
== 2558 && rdesc
[913] == 0x17 && rdesc
[914] == 0x40 &&
615 rdesc
[915] == 0x81 && rdesc
[916] == 0x08 &&
616 rdesc
[917] == 0x00 && rdesc
[918] == 0x27 &&
617 rdesc
[921] == 0x07 && rdesc
[922] == 0x00) {
618 /* Sets negative logical minimum for mag x, y and z */
619 rdesc
[914] = rdesc
[935] = rdesc
[956] = 0xc0;
620 rdesc
[915] = rdesc
[936] = rdesc
[957] = 0x7e;
621 rdesc
[916] = rdesc
[937] = rdesc
[958] = 0xf7;
622 rdesc
[917] = rdesc
[938] = rdesc
[959] = 0xff;
628 static int sensor_hub_probe(struct hid_device
*hdev
,
629 const struct hid_device_id
*id
)
632 struct sensor_hub_data
*sd
;
636 struct hid_sensor_hub_device
*hsdev
;
637 struct hid_sensor_hub_device
*last_hsdev
= NULL
;
638 struct hid_sensor_hub_device
*collection_hsdev
= NULL
;
640 sd
= devm_kzalloc(&hdev
->dev
, sizeof(*sd
), GFP_KERNEL
);
642 hid_err(hdev
, "cannot allocate Sensor data\n");
646 hid_set_drvdata(hdev
, sd
);
647 sd
->quirks
= id
->driver_data
;
649 spin_lock_init(&sd
->lock
);
650 spin_lock_init(&sd
->dyn_callback_lock
);
651 mutex_init(&sd
->mutex
);
652 ret
= hid_parse(hdev
);
654 hid_err(hdev
, "parse failed\n");
657 INIT_LIST_HEAD(&hdev
->inputs
);
659 ret
= hid_hw_start(hdev
, 0);
661 hid_err(hdev
, "hw start failed\n");
664 INIT_LIST_HEAD(&sd
->dyn_callback_list
);
665 sd
->hid_sensor_client_cnt
= 0;
667 dev_cnt
= sensor_hub_get_physical_device_count(hdev
);
668 if (dev_cnt
> HID_MAX_PHY_DEVICES
) {
669 hid_err(hdev
, "Invalid Physical device count\n");
673 sd
->hid_sensor_hub_client_devs
= devm_kzalloc(&hdev
->dev
, dev_cnt
*
674 sizeof(struct mfd_cell
),
676 if (sd
->hid_sensor_hub_client_devs
== NULL
) {
677 hid_err(hdev
, "Failed to allocate memory for mfd cells\n");
682 for (i
= 0; i
< hdev
->maxcollection
; ++i
) {
683 struct hid_collection
*collection
= &hdev
->collection
[i
];
685 if (collection
->type
== HID_COLLECTION_PHYSICAL
||
686 collection
->type
== HID_COLLECTION_APPLICATION
) {
688 hsdev
= devm_kzalloc(&hdev
->dev
, sizeof(*hsdev
),
691 hid_err(hdev
, "cannot allocate hid_sensor_hub_device\n");
696 hsdev
->vendor_id
= hdev
->vendor
;
697 hsdev
->product_id
= hdev
->product
;
698 hsdev
->usage
= collection
->usage
;
699 hsdev
->mutex_ptr
= devm_kzalloc(&hdev
->dev
,
700 sizeof(struct mutex
),
702 if (!hsdev
->mutex_ptr
) {
706 mutex_init(hsdev
->mutex_ptr
);
707 hsdev
->start_collection_index
= i
;
709 last_hsdev
->end_collection_index
= i
;
711 name
= devm_kasprintf(&hdev
->dev
, GFP_KERNEL
,
715 hid_err(hdev
, "Failed MFD device name\n");
719 sd
->hid_sensor_hub_client_devs
[
720 sd
->hid_sensor_client_cnt
].name
= name
;
721 sd
->hid_sensor_hub_client_devs
[
722 sd
->hid_sensor_client_cnt
].platform_data
=
724 sd
->hid_sensor_hub_client_devs
[
725 sd
->hid_sensor_client_cnt
].pdata_size
=
727 hid_dbg(hdev
, "Adding %s:%d\n", name
,
728 hsdev
->start_collection_index
);
729 sd
->hid_sensor_client_cnt
++;
730 if (collection_hsdev
)
731 collection_hsdev
->end_collection_index
= i
;
732 if (collection
->type
== HID_COLLECTION_APPLICATION
&&
733 collection
->usage
== HID_USAGE_SENSOR_COLLECTION
)
734 collection_hsdev
= hsdev
;
738 last_hsdev
->end_collection_index
= i
;
739 if (collection_hsdev
)
740 collection_hsdev
->end_collection_index
= i
;
742 ret
= mfd_add_hotplug_devices(&hdev
->dev
,
743 sd
->hid_sensor_hub_client_devs
,
744 sd
->hid_sensor_client_cnt
);
756 static void sensor_hub_remove(struct hid_device
*hdev
)
758 struct sensor_hub_data
*data
= hid_get_drvdata(hdev
);
762 hid_dbg(hdev
, " hardware removed\n");
765 spin_lock_irqsave(&data
->lock
, flags
);
766 for (i
= 0; i
< data
->hid_sensor_client_cnt
; ++i
) {
767 struct hid_sensor_hub_device
*hsdev
=
768 data
->hid_sensor_hub_client_devs
[i
].platform_data
;
769 if (hsdev
->pending
.status
)
770 complete(&hsdev
->pending
.ready
);
772 spin_unlock_irqrestore(&data
->lock
, flags
);
773 mfd_remove_devices(&hdev
->dev
);
774 hid_set_drvdata(hdev
, NULL
);
775 mutex_destroy(&data
->mutex
);
778 static const struct hid_device_id sensor_hub_devices
[] = {
779 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_INTEL_0
,
780 USB_DEVICE_ID_INTEL_HID_SENSOR_0
),
781 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
782 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_INTEL_1
,
783 USB_DEVICE_ID_INTEL_HID_SENSOR_0
),
784 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
785 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_INTEL_1
,
786 USB_DEVICE_ID_INTEL_HID_SENSOR_1
),
787 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
788 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_MICROSOFT
,
789 USB_DEVICE_ID_MS_SURFACE_PRO_2
),
790 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
791 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_MICROSOFT
,
792 USB_DEVICE_ID_MS_TOUCH_COVER_2
),
793 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
794 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_MICROSOFT
,
795 USB_DEVICE_ID_MS_TYPE_COVER_2
),
796 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
797 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_STM_0
,
798 USB_DEVICE_ID_STM_HID_SENSOR
),
799 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
800 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_STM_0
,
801 USB_DEVICE_ID_STM_HID_SENSOR_1
),
802 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
803 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_TEXAS_INSTRUMENTS
,
804 USB_DEVICE_ID_TEXAS_INSTRUMENTS_LENOVO_YOGA
),
805 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
806 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_ITE
,
807 USB_DEVICE_ID_ITE_LENOVO_YOGA
),
808 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
809 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_ITE
,
810 USB_DEVICE_ID_ITE_LENOVO_YOGA2
),
811 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
812 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_ITE
,
813 USB_DEVICE_ID_ITE_LENOVO_YOGA900
),
814 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
815 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_INTEL_0
,
817 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
818 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, HID_ANY_ID
,
822 MODULE_DEVICE_TABLE(hid
, sensor_hub_devices
);
824 static struct hid_driver sensor_hub_driver
= {
825 .name
= "hid-sensor-hub",
826 .id_table
= sensor_hub_devices
,
827 .probe
= sensor_hub_probe
,
828 .remove
= sensor_hub_remove
,
829 .raw_event
= sensor_hub_raw_event
,
830 .report_fixup
= sensor_hub_report_fixup
,
832 .suspend
= sensor_hub_suspend
,
833 .resume
= sensor_hub_resume
,
834 .reset_resume
= sensor_hub_reset_resume
,
837 module_hid_driver(sensor_hub_driver
);
839 MODULE_DESCRIPTION("HID Sensor Hub driver");
840 MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@intel.com>");
841 MODULE_LICENSE("GPL");