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 mutex_lock(&data
->mutex
);
256 report
= sensor_hub_report(report_id
, hsdev
->hdev
, HID_FEATURE_REPORT
);
257 if (!report
|| (field_index
>= report
->maxfield
) ||
258 report
->field
[field_index
]->report_count
< 1) {
262 hid_hw_request(hsdev
->hdev
, report
, HID_REQ_GET_REPORT
);
263 hid_hw_wait(hsdev
->hdev
);
265 /* calculate number of bytes required to read this field */
266 report_size
= DIV_ROUND_UP(report
->field
[field_index
]->report_size
,
268 report
->field
[field_index
]->report_count
;
273 ret
= min(report_size
, buffer_size
);
274 memcpy(buffer
, report
->field
[field_index
]->value
, ret
);
277 mutex_unlock(&data
->mutex
);
281 EXPORT_SYMBOL_GPL(sensor_hub_get_feature
);
284 int sensor_hub_input_attr_get_raw_value(struct hid_sensor_hub_device
*hsdev
,
286 u32 attr_usage_id
, u32 report_id
,
287 enum sensor_hub_read_flags flag
)
289 struct sensor_hub_data
*data
= hid_get_drvdata(hsdev
->hdev
);
291 struct hid_report
*report
;
294 report
= sensor_hub_report(report_id
, hsdev
->hdev
,
299 mutex_lock(hsdev
->mutex_ptr
);
300 if (flag
== SENSOR_HUB_SYNC
) {
301 memset(&hsdev
->pending
, 0, sizeof(hsdev
->pending
));
302 init_completion(&hsdev
->pending
.ready
);
303 hsdev
->pending
.usage_id
= usage_id
;
304 hsdev
->pending
.attr_usage_id
= attr_usage_id
;
305 hsdev
->pending
.raw_size
= 0;
307 spin_lock_irqsave(&data
->lock
, flags
);
308 hsdev
->pending
.status
= true;
309 spin_unlock_irqrestore(&data
->lock
, flags
);
311 mutex_lock(&data
->mutex
);
312 hid_hw_request(hsdev
->hdev
, report
, HID_REQ_GET_REPORT
);
313 mutex_unlock(&data
->mutex
);
314 if (flag
== SENSOR_HUB_SYNC
) {
315 wait_for_completion_interruptible_timeout(
316 &hsdev
->pending
.ready
, HZ
*5);
317 switch (hsdev
->pending
.raw_size
) {
319 ret_val
= *(u8
*)hsdev
->pending
.raw_data
;
322 ret_val
= *(u16
*)hsdev
->pending
.raw_data
;
325 ret_val
= *(u32
*)hsdev
->pending
.raw_data
;
330 kfree(hsdev
->pending
.raw_data
);
331 hsdev
->pending
.status
= false;
333 mutex_unlock(hsdev
->mutex_ptr
);
337 EXPORT_SYMBOL_GPL(sensor_hub_input_attr_get_raw_value
);
339 int hid_sensor_get_usage_index(struct hid_sensor_hub_device
*hsdev
,
340 u32 report_id
, int field_index
, u32 usage_id
)
342 struct hid_report
*report
;
343 struct hid_field
*field
;
346 report
= sensor_hub_report(report_id
, hsdev
->hdev
, HID_FEATURE_REPORT
);
347 if (!report
|| (field_index
>= report
->maxfield
))
350 field
= report
->field
[field_index
];
351 for (i
= 0; i
< field
->maxusage
; ++i
) {
352 if (field
->usage
[i
].hid
== usage_id
)
353 return field
->usage
[i
].usage_index
;
359 EXPORT_SYMBOL_GPL(hid_sensor_get_usage_index
);
361 int sensor_hub_input_get_attribute_info(struct hid_sensor_hub_device
*hsdev
,
365 struct hid_sensor_hub_attribute_info
*info
)
369 struct hid_report
*report
;
370 struct hid_field
*field
;
371 struct hid_report_enum
*report_enum
;
372 struct hid_device
*hdev
= hsdev
->hdev
;
374 /* Initialize with defaults */
375 info
->usage_id
= usage_id
;
376 info
->attrib_id
= attr_usage_id
;
377 info
->report_id
= -1;
380 info
->unit_expo
= -1;
382 report_enum
= &hdev
->report_enum
[type
];
383 list_for_each_entry(report
, &report_enum
->report_list
, list
) {
384 for (i
= 0; i
< report
->maxfield
; ++i
) {
385 field
= report
->field
[i
];
386 if (field
->maxusage
) {
387 if (field
->physical
== usage_id
&&
388 (field
->logical
== attr_usage_id
||
389 field
->usage
[0].hid
==
391 (field
->usage
[0].collection_index
>=
392 hsdev
->start_collection_index
) &&
393 (field
->usage
[0].collection_index
<
394 hsdev
->end_collection_index
)) {
396 sensor_hub_fill_attr_info(info
, i
,
409 EXPORT_SYMBOL_GPL(sensor_hub_input_get_attribute_info
);
412 static int sensor_hub_suspend(struct hid_device
*hdev
, pm_message_t message
)
414 struct sensor_hub_data
*pdata
= hid_get_drvdata(hdev
);
415 struct hid_sensor_hub_callbacks_list
*callback
;
418 hid_dbg(hdev
, " sensor_hub_suspend\n");
419 spin_lock_irqsave(&pdata
->dyn_callback_lock
, flags
);
420 list_for_each_entry(callback
, &pdata
->dyn_callback_list
, list
) {
421 if (callback
->usage_callback
->suspend
)
422 callback
->usage_callback
->suspend(
423 callback
->hsdev
, callback
->priv
);
425 spin_unlock_irqrestore(&pdata
->dyn_callback_lock
, flags
);
430 static int sensor_hub_resume(struct hid_device
*hdev
)
432 struct sensor_hub_data
*pdata
= hid_get_drvdata(hdev
);
433 struct hid_sensor_hub_callbacks_list
*callback
;
436 hid_dbg(hdev
, " sensor_hub_resume\n");
437 spin_lock_irqsave(&pdata
->dyn_callback_lock
, flags
);
438 list_for_each_entry(callback
, &pdata
->dyn_callback_list
, list
) {
439 if (callback
->usage_callback
->resume
)
440 callback
->usage_callback
->resume(
441 callback
->hsdev
, callback
->priv
);
443 spin_unlock_irqrestore(&pdata
->dyn_callback_lock
, flags
);
448 static int sensor_hub_reset_resume(struct hid_device
*hdev
)
455 * Handle raw report as sent by device
457 static int sensor_hub_raw_event(struct hid_device
*hdev
,
458 struct hid_report
*report
, u8
*raw_data
, int size
)
463 struct sensor_hub_data
*pdata
= hid_get_drvdata(hdev
);
465 struct hid_sensor_hub_callbacks
*callback
= NULL
;
466 struct hid_collection
*collection
= NULL
;
468 struct hid_sensor_hub_device
*hsdev
= NULL
;
470 hid_dbg(hdev
, "sensor_hub_raw_event report id:0x%x size:%d type:%d\n",
471 report
->id
, size
, report
->type
);
472 hid_dbg(hdev
, "maxfield:%d\n", report
->maxfield
);
473 if (report
->type
!= HID_INPUT_REPORT
)
477 ptr
++; /* Skip report id */
479 spin_lock_irqsave(&pdata
->lock
, flags
);
481 for (i
= 0; i
< report
->maxfield
; ++i
) {
482 hid_dbg(hdev
, "%d collection_index:%x hid:%x sz:%x\n",
483 i
, report
->field
[i
]->usage
->collection_index
,
484 report
->field
[i
]->usage
->hid
,
485 (report
->field
[i
]->report_size
*
486 report
->field
[i
]->report_count
)/8);
487 sz
= (report
->field
[i
]->report_size
*
488 report
->field
[i
]->report_count
)/8;
489 collection
= &hdev
->collection
[
490 report
->field
[i
]->usage
->collection_index
];
491 hid_dbg(hdev
, "collection->usage %x\n",
494 callback
= sensor_hub_get_callback(hdev
,
495 report
->field
[i
]->physical
,
496 report
->field
[i
]->usage
[0].collection_index
,
502 if (hsdev
->pending
.status
&& (hsdev
->pending
.attr_usage_id
==
503 report
->field
[i
]->usage
->hid
||
504 hsdev
->pending
.attr_usage_id
==
505 report
->field
[i
]->logical
)) {
506 hid_dbg(hdev
, "data was pending ...\n");
507 hsdev
->pending
.raw_data
= kmemdup(ptr
, sz
, GFP_ATOMIC
);
508 if (hsdev
->pending
.raw_data
)
509 hsdev
->pending
.raw_size
= sz
;
511 hsdev
->pending
.raw_size
= 0;
512 complete(&hsdev
->pending
.ready
);
514 if (callback
->capture_sample
) {
515 if (report
->field
[i
]->logical
)
516 callback
->capture_sample(hsdev
,
517 report
->field
[i
]->logical
, sz
, ptr
,
520 callback
->capture_sample(hsdev
,
521 report
->field
[i
]->usage
->hid
, sz
, ptr
,
526 if (callback
&& collection
&& callback
->send_event
)
527 callback
->send_event(hsdev
, collection
->usage
,
529 spin_unlock_irqrestore(&pdata
->lock
, flags
);
534 int sensor_hub_device_open(struct hid_sensor_hub_device
*hsdev
)
537 struct sensor_hub_data
*data
= hid_get_drvdata(hsdev
->hdev
);
539 mutex_lock(&data
->mutex
);
540 if (!data
->ref_cnt
) {
541 ret
= hid_hw_open(hsdev
->hdev
);
543 hid_err(hsdev
->hdev
, "failed to open hid device\n");
544 mutex_unlock(&data
->mutex
);
549 mutex_unlock(&data
->mutex
);
553 EXPORT_SYMBOL_GPL(sensor_hub_device_open
);
555 void sensor_hub_device_close(struct hid_sensor_hub_device
*hsdev
)
557 struct sensor_hub_data
*data
= hid_get_drvdata(hsdev
->hdev
);
559 mutex_lock(&data
->mutex
);
562 hid_hw_close(hsdev
->hdev
);
563 mutex_unlock(&data
->mutex
);
565 EXPORT_SYMBOL_GPL(sensor_hub_device_close
);
567 static __u8
*sensor_hub_report_fixup(struct hid_device
*hdev
, __u8
*rdesc
,
571 struct sensor_hub_data
*sd
= hid_get_drvdata(hdev
);
572 unsigned char report_block
[] = {
573 0x0a, 0x16, 0x03, 0x15, 0x00, 0x25, 0x05};
574 unsigned char power_block
[] = {
575 0x0a, 0x19, 0x03, 0x15, 0x00, 0x25, 0x05};
577 if (!(sd
->quirks
& HID_SENSOR_HUB_ENUM_QUIRK
)) {
578 hid_dbg(hdev
, "No Enum quirks\n");
582 /* Looks for power and report state usage id and force to 1 */
583 for (index
= 0; index
< *rsize
; ++index
) {
584 if (((*rsize
- index
) > sizeof(report_block
)) &&
585 !memcmp(&rdesc
[index
], report_block
,
586 sizeof(report_block
))) {
587 rdesc
[index
+ 4] = 0x01;
588 index
+= sizeof(report_block
);
590 if (((*rsize
- index
) > sizeof(power_block
)) &&
591 !memcmp(&rdesc
[index
], power_block
,
592 sizeof(power_block
))) {
593 rdesc
[index
+ 4] = 0x01;
594 index
+= sizeof(power_block
);
598 /* Checks if the report descriptor of Thinkpad Helix 2 has a logical
599 * minimum for magnetic flux axis greater than the maximum */
600 if (hdev
->product
== USB_DEVICE_ID_TEXAS_INSTRUMENTS_LENOVO_YOGA
&&
601 *rsize
== 2558 && rdesc
[913] == 0x17 && rdesc
[914] == 0x40 &&
602 rdesc
[915] == 0x81 && rdesc
[916] == 0x08 &&
603 rdesc
[917] == 0x00 && rdesc
[918] == 0x27 &&
604 rdesc
[921] == 0x07 && rdesc
[922] == 0x00) {
605 /* Sets negative logical minimum for mag x, y and z */
606 rdesc
[914] = rdesc
[935] = rdesc
[956] = 0xc0;
607 rdesc
[915] = rdesc
[936] = rdesc
[957] = 0x7e;
608 rdesc
[916] = rdesc
[937] = rdesc
[958] = 0xf7;
609 rdesc
[917] = rdesc
[938] = rdesc
[959] = 0xff;
615 static int sensor_hub_probe(struct hid_device
*hdev
,
616 const struct hid_device_id
*id
)
619 struct sensor_hub_data
*sd
;
623 struct hid_sensor_hub_device
*hsdev
;
624 struct hid_sensor_hub_device
*last_hsdev
= NULL
;
625 struct hid_sensor_hub_device
*collection_hsdev
= NULL
;
627 sd
= devm_kzalloc(&hdev
->dev
, sizeof(*sd
), GFP_KERNEL
);
629 hid_err(hdev
, "cannot allocate Sensor data\n");
633 hid_set_drvdata(hdev
, sd
);
634 sd
->quirks
= id
->driver_data
;
636 spin_lock_init(&sd
->lock
);
637 spin_lock_init(&sd
->dyn_callback_lock
);
638 mutex_init(&sd
->mutex
);
639 ret
= hid_parse(hdev
);
641 hid_err(hdev
, "parse failed\n");
644 INIT_LIST_HEAD(&hdev
->inputs
);
646 ret
= hid_hw_start(hdev
, 0);
648 hid_err(hdev
, "hw start failed\n");
651 INIT_LIST_HEAD(&sd
->dyn_callback_list
);
652 sd
->hid_sensor_client_cnt
= 0;
654 dev_cnt
= sensor_hub_get_physical_device_count(hdev
);
655 if (dev_cnt
> HID_MAX_PHY_DEVICES
) {
656 hid_err(hdev
, "Invalid Physical device count\n");
660 sd
->hid_sensor_hub_client_devs
= devm_kzalloc(&hdev
->dev
, dev_cnt
*
661 sizeof(struct mfd_cell
),
663 if (sd
->hid_sensor_hub_client_devs
== NULL
) {
664 hid_err(hdev
, "Failed to allocate memory for mfd cells\n");
669 for (i
= 0; i
< hdev
->maxcollection
; ++i
) {
670 struct hid_collection
*collection
= &hdev
->collection
[i
];
672 if (collection
->type
== HID_COLLECTION_PHYSICAL
||
673 collection
->type
== HID_COLLECTION_APPLICATION
) {
675 hsdev
= devm_kzalloc(&hdev
->dev
, sizeof(*hsdev
),
678 hid_err(hdev
, "cannot allocate hid_sensor_hub_device\n");
683 hsdev
->vendor_id
= hdev
->vendor
;
684 hsdev
->product_id
= hdev
->product
;
685 hsdev
->usage
= collection
->usage
;
686 hsdev
->mutex_ptr
= devm_kzalloc(&hdev
->dev
,
687 sizeof(struct mutex
),
689 if (!hsdev
->mutex_ptr
) {
693 mutex_init(hsdev
->mutex_ptr
);
694 hsdev
->start_collection_index
= i
;
696 last_hsdev
->end_collection_index
= i
;
698 name
= devm_kasprintf(&hdev
->dev
, GFP_KERNEL
,
702 hid_err(hdev
, "Failed MFD device name\n");
706 sd
->hid_sensor_hub_client_devs
[
707 sd
->hid_sensor_client_cnt
].name
= name
;
708 sd
->hid_sensor_hub_client_devs
[
709 sd
->hid_sensor_client_cnt
].platform_data
=
711 sd
->hid_sensor_hub_client_devs
[
712 sd
->hid_sensor_client_cnt
].pdata_size
=
714 hid_dbg(hdev
, "Adding %s:%d\n", name
,
715 hsdev
->start_collection_index
);
716 sd
->hid_sensor_client_cnt
++;
717 if (collection_hsdev
)
718 collection_hsdev
->end_collection_index
= i
;
719 if (collection
->type
== HID_COLLECTION_APPLICATION
&&
720 collection
->usage
== HID_USAGE_SENSOR_COLLECTION
)
721 collection_hsdev
= hsdev
;
725 last_hsdev
->end_collection_index
= i
;
726 if (collection_hsdev
)
727 collection_hsdev
->end_collection_index
= i
;
729 ret
= mfd_add_hotplug_devices(&hdev
->dev
,
730 sd
->hid_sensor_hub_client_devs
,
731 sd
->hid_sensor_client_cnt
);
743 static void sensor_hub_remove(struct hid_device
*hdev
)
745 struct sensor_hub_data
*data
= hid_get_drvdata(hdev
);
749 hid_dbg(hdev
, " hardware removed\n");
752 spin_lock_irqsave(&data
->lock
, flags
);
753 for (i
= 0; i
< data
->hid_sensor_client_cnt
; ++i
) {
754 struct hid_sensor_hub_device
*hsdev
=
755 data
->hid_sensor_hub_client_devs
[i
].platform_data
;
756 if (hsdev
->pending
.status
)
757 complete(&hsdev
->pending
.ready
);
759 spin_unlock_irqrestore(&data
->lock
, flags
);
760 mfd_remove_devices(&hdev
->dev
);
761 hid_set_drvdata(hdev
, NULL
);
762 mutex_destroy(&data
->mutex
);
765 static const struct hid_device_id sensor_hub_devices
[] = {
766 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_INTEL_0
,
767 USB_DEVICE_ID_INTEL_HID_SENSOR_0
),
768 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
769 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_INTEL_1
,
770 USB_DEVICE_ID_INTEL_HID_SENSOR_0
),
771 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
772 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_INTEL_1
,
773 USB_DEVICE_ID_INTEL_HID_SENSOR_1
),
774 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
775 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_MICROSOFT
,
776 USB_DEVICE_ID_MS_SURFACE_PRO_2
),
777 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
778 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_MICROSOFT
,
779 USB_DEVICE_ID_MS_TOUCH_COVER_2
),
780 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
781 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_MICROSOFT
,
782 USB_DEVICE_ID_MS_TYPE_COVER_2
),
783 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
784 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_STM_0
,
785 USB_DEVICE_ID_STM_HID_SENSOR
),
786 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
787 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_STM_0
,
788 USB_DEVICE_ID_STM_HID_SENSOR_1
),
789 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
790 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_TEXAS_INSTRUMENTS
,
791 USB_DEVICE_ID_TEXAS_INSTRUMENTS_LENOVO_YOGA
),
792 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
793 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_ITE
,
794 USB_DEVICE_ID_ITE_LENOVO_YOGA
),
795 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
796 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_ITE
,
797 USB_DEVICE_ID_ITE_LENOVO_YOGA2
),
798 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
799 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_ITE
,
800 USB_DEVICE_ID_ITE_LENOVO_YOGA900
),
801 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
802 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, USB_VENDOR_ID_INTEL_0
,
804 .driver_data
= HID_SENSOR_HUB_ENUM_QUIRK
},
805 { HID_DEVICE(HID_BUS_ANY
, HID_GROUP_SENSOR_HUB
, HID_ANY_ID
,
809 MODULE_DEVICE_TABLE(hid
, sensor_hub_devices
);
811 static struct hid_driver sensor_hub_driver
= {
812 .name
= "hid-sensor-hub",
813 .id_table
= sensor_hub_devices
,
814 .probe
= sensor_hub_probe
,
815 .remove
= sensor_hub_remove
,
816 .raw_event
= sensor_hub_raw_event
,
817 .report_fixup
= sensor_hub_report_fixup
,
819 .suspend
= sensor_hub_suspend
,
820 .resume
= sensor_hub_resume
,
821 .reset_resume
= sensor_hub_reset_resume
,
824 module_hid_driver(sensor_hub_driver
);
826 MODULE_DESCRIPTION("HID Sensor Hub driver");
827 MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@intel.com>");
828 MODULE_LICENSE("GPL");