1401ca24fSsrinivas pandruvada /* 2401ca24fSsrinivas pandruvada * HID Sensors Driver 3401ca24fSsrinivas pandruvada * Copyright (c) 2012, Intel Corporation. 4401ca24fSsrinivas pandruvada * 5401ca24fSsrinivas pandruvada * This program is free software; you can redistribute it and/or modify it 6401ca24fSsrinivas pandruvada * under the terms and conditions of the GNU General Public License, 7401ca24fSsrinivas pandruvada * version 2, as published by the Free Software Foundation. 8401ca24fSsrinivas pandruvada * 9401ca24fSsrinivas pandruvada * This program is distributed in the hope it will be useful, but WITHOUT 10401ca24fSsrinivas pandruvada * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 11401ca24fSsrinivas pandruvada * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 12401ca24fSsrinivas pandruvada * more details. 13401ca24fSsrinivas pandruvada * 14401ca24fSsrinivas pandruvada * You should have received a copy of the GNU General Public License along with 15401ca24fSsrinivas pandruvada * this program; if not, write to the Free Software Foundation, Inc., 16401ca24fSsrinivas pandruvada * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. 17401ca24fSsrinivas pandruvada * 18401ca24fSsrinivas pandruvada */ 19401ca24fSsrinivas pandruvada #include <linux/device.h> 20401ca24fSsrinivas pandruvada #include <linux/hid.h> 21401ca24fSsrinivas pandruvada #include <linux/module.h> 22401ca24fSsrinivas pandruvada #include <linux/slab.h> 23401ca24fSsrinivas pandruvada #include <linux/mfd/core.h> 24401ca24fSsrinivas pandruvada #include <linux/list.h> 25401ca24fSsrinivas pandruvada #include <linux/hid-sensor-ids.h> 26401ca24fSsrinivas pandruvada #include <linux/hid-sensor-hub.h> 27401ca24fSsrinivas pandruvada #include "hid-ids.h" 28401ca24fSsrinivas pandruvada 29875e36f8SSrinivas Pandruvada #define HID_SENSOR_HUB_ENUM_QUIRK 0x01 30875e36f8SSrinivas Pandruvada 31401ca24fSsrinivas pandruvada /** 32401ca24fSsrinivas pandruvada * struct sensor_hub_data - Hold a instance data for a HID hub device 33401ca24fSsrinivas pandruvada * @hsdev: Stored hid instance for current hub device. 34401ca24fSsrinivas pandruvada * @mutex: Mutex to serialize synchronous request. 35401ca24fSsrinivas pandruvada * @lock: Spin lock to protect pending request structure. 36401ca24fSsrinivas pandruvada * @dyn_callback_list: Holds callback function 37401ca24fSsrinivas pandruvada * @dyn_callback_lock: spin lock to protect callback list 38401ca24fSsrinivas pandruvada * @hid_sensor_hub_client_devs: Stores all MFD cells for a hub instance. 39401ca24fSsrinivas pandruvada * @hid_sensor_client_cnt: Number of MFD cells, (no of sensors attached). 40ca2ed12fSSrinivas Pandruvada * @ref_cnt: Number of MFD clients have opened this device 41401ca24fSsrinivas pandruvada */ 42401ca24fSsrinivas pandruvada struct sensor_hub_data { 43401ca24fSsrinivas pandruvada struct mutex mutex; 44401ca24fSsrinivas pandruvada spinlock_t lock; 45401ca24fSsrinivas pandruvada struct list_head dyn_callback_list; 46401ca24fSsrinivas pandruvada spinlock_t dyn_callback_lock; 47401ca24fSsrinivas pandruvada struct mfd_cell *hid_sensor_hub_client_devs; 48401ca24fSsrinivas pandruvada int hid_sensor_client_cnt; 49875e36f8SSrinivas Pandruvada unsigned long quirks; 50ca2ed12fSSrinivas Pandruvada int ref_cnt; 51401ca24fSsrinivas pandruvada }; 52401ca24fSsrinivas pandruvada 53401ca24fSsrinivas pandruvada /** 54401ca24fSsrinivas pandruvada * struct hid_sensor_hub_callbacks_list - Stores callback list 55401ca24fSsrinivas pandruvada * @list: list head. 56401ca24fSsrinivas pandruvada * @usage_id: usage id for a physical device. 57401ca24fSsrinivas pandruvada * @usage_callback: Stores registered callback functions. 58401ca24fSsrinivas pandruvada * @priv: Private data for a physical device. 59401ca24fSsrinivas pandruvada */ 60401ca24fSsrinivas pandruvada struct hid_sensor_hub_callbacks_list { 61401ca24fSsrinivas pandruvada struct list_head list; 62401ca24fSsrinivas pandruvada u32 usage_id; 63ca2ed12fSSrinivas Pandruvada struct hid_sensor_hub_device *hsdev; 64401ca24fSsrinivas pandruvada struct hid_sensor_hub_callbacks *usage_callback; 65401ca24fSsrinivas pandruvada void *priv; 66401ca24fSsrinivas pandruvada }; 67401ca24fSsrinivas pandruvada 68401ca24fSsrinivas pandruvada static struct hid_report *sensor_hub_report(int id, struct hid_device *hdev, 69401ca24fSsrinivas pandruvada int dir) 70401ca24fSsrinivas pandruvada { 71401ca24fSsrinivas pandruvada struct hid_report *report; 72401ca24fSsrinivas pandruvada 73401ca24fSsrinivas pandruvada list_for_each_entry(report, &hdev->report_enum[dir].report_list, list) { 74401ca24fSsrinivas pandruvada if (report->id == id) 75401ca24fSsrinivas pandruvada return report; 76401ca24fSsrinivas pandruvada } 77401ca24fSsrinivas pandruvada hid_warn(hdev, "No report with id 0x%x found\n", id); 78401ca24fSsrinivas pandruvada 79401ca24fSsrinivas pandruvada return NULL; 80401ca24fSsrinivas pandruvada } 81401ca24fSsrinivas pandruvada 82ca2ed12fSSrinivas Pandruvada static int sensor_hub_get_physical_device_count(struct hid_device *hdev) 83401ca24fSsrinivas pandruvada { 84ca2ed12fSSrinivas Pandruvada int i; 85ca2ed12fSSrinivas Pandruvada int count = 0; 86401ca24fSsrinivas pandruvada 87ca2ed12fSSrinivas Pandruvada for (i = 0; i < hdev->maxcollection; ++i) { 88ca2ed12fSSrinivas Pandruvada struct hid_collection *collection = &hdev->collection[i]; 89cb67126fSSrinivas Pandruvada if (collection->type == HID_COLLECTION_PHYSICAL || 90cb67126fSSrinivas Pandruvada collection->type == HID_COLLECTION_APPLICATION) 91ca2ed12fSSrinivas Pandruvada ++count; 92401ca24fSsrinivas pandruvada } 93401ca24fSsrinivas pandruvada 94ca2ed12fSSrinivas Pandruvada return count; 95401ca24fSsrinivas pandruvada } 96401ca24fSsrinivas pandruvada 97401ca24fSsrinivas pandruvada static void sensor_hub_fill_attr_info( 98401ca24fSsrinivas pandruvada struct hid_sensor_hub_attribute_info *info, 999f740ffaSSrinivas Pandruvada s32 index, s32 report_id, struct hid_field *field) 100401ca24fSsrinivas pandruvada { 101401ca24fSsrinivas pandruvada info->index = index; 102401ca24fSsrinivas pandruvada info->report_id = report_id; 1039f740ffaSSrinivas Pandruvada info->units = field->unit; 1049f740ffaSSrinivas Pandruvada info->unit_expo = field->unit_exponent; 1059f740ffaSSrinivas Pandruvada info->size = (field->report_size * field->report_count)/8; 1069f740ffaSSrinivas Pandruvada info->logical_minimum = field->logical_minimum; 1079f740ffaSSrinivas Pandruvada info->logical_maximum = field->logical_maximum; 108401ca24fSsrinivas pandruvada } 109401ca24fSsrinivas pandruvada 110401ca24fSsrinivas pandruvada static struct hid_sensor_hub_callbacks *sensor_hub_get_callback( 111401ca24fSsrinivas pandruvada struct hid_device *hdev, 112ca2ed12fSSrinivas Pandruvada u32 usage_id, 113ca2ed12fSSrinivas Pandruvada int collection_index, 114ca2ed12fSSrinivas Pandruvada struct hid_sensor_hub_device **hsdev, 115ca2ed12fSSrinivas Pandruvada void **priv) 116401ca24fSsrinivas pandruvada { 117401ca24fSsrinivas pandruvada struct hid_sensor_hub_callbacks_list *callback; 118401ca24fSsrinivas pandruvada struct sensor_hub_data *pdata = hid_get_drvdata(hdev); 119401ca24fSsrinivas pandruvada 120401ca24fSsrinivas pandruvada spin_lock(&pdata->dyn_callback_lock); 121401ca24fSsrinivas pandruvada list_for_each_entry(callback, &pdata->dyn_callback_list, list) 122cb67126fSSrinivas Pandruvada if ((callback->usage_id == usage_id || 123cb67126fSSrinivas Pandruvada callback->usage_id == HID_USAGE_SENSOR_COLLECTION) && 124ca2ed12fSSrinivas Pandruvada (collection_index >= 125ca2ed12fSSrinivas Pandruvada callback->hsdev->start_collection_index) && 126ca2ed12fSSrinivas Pandruvada (collection_index < 127ca2ed12fSSrinivas Pandruvada callback->hsdev->end_collection_index)) { 128401ca24fSsrinivas pandruvada *priv = callback->priv; 129ca2ed12fSSrinivas Pandruvada *hsdev = callback->hsdev; 130401ca24fSsrinivas pandruvada spin_unlock(&pdata->dyn_callback_lock); 131401ca24fSsrinivas pandruvada return callback->usage_callback; 132401ca24fSsrinivas pandruvada } 133401ca24fSsrinivas pandruvada spin_unlock(&pdata->dyn_callback_lock); 134401ca24fSsrinivas pandruvada 135401ca24fSsrinivas pandruvada return NULL; 136401ca24fSsrinivas pandruvada } 137401ca24fSsrinivas pandruvada 138401ca24fSsrinivas pandruvada int sensor_hub_register_callback(struct hid_sensor_hub_device *hsdev, 139401ca24fSsrinivas pandruvada u32 usage_id, 140401ca24fSsrinivas pandruvada struct hid_sensor_hub_callbacks *usage_callback) 141401ca24fSsrinivas pandruvada { 142401ca24fSsrinivas pandruvada struct hid_sensor_hub_callbacks_list *callback; 143401ca24fSsrinivas pandruvada struct sensor_hub_data *pdata = hid_get_drvdata(hsdev->hdev); 1440ccf091dSJiri Kosina unsigned long flags; 145401ca24fSsrinivas pandruvada 1460ccf091dSJiri Kosina spin_lock_irqsave(&pdata->dyn_callback_lock, flags); 147401ca24fSsrinivas pandruvada list_for_each_entry(callback, &pdata->dyn_callback_list, list) 148ca2ed12fSSrinivas Pandruvada if (callback->usage_id == usage_id && 149ca2ed12fSSrinivas Pandruvada callback->hsdev == hsdev) { 1500ccf091dSJiri Kosina spin_unlock_irqrestore(&pdata->dyn_callback_lock, flags); 151401ca24fSsrinivas pandruvada return -EINVAL; 152401ca24fSsrinivas pandruvada } 1532b7c4b8eSDan Carpenter callback = kzalloc(sizeof(*callback), GFP_ATOMIC); 154401ca24fSsrinivas pandruvada if (!callback) { 1550ccf091dSJiri Kosina spin_unlock_irqrestore(&pdata->dyn_callback_lock, flags); 156401ca24fSsrinivas pandruvada return -ENOMEM; 157401ca24fSsrinivas pandruvada } 158ca2ed12fSSrinivas Pandruvada callback->hsdev = hsdev; 159401ca24fSsrinivas pandruvada callback->usage_callback = usage_callback; 160401ca24fSsrinivas pandruvada callback->usage_id = usage_id; 161401ca24fSsrinivas pandruvada callback->priv = NULL; 162cb67126fSSrinivas Pandruvada /* 163cb67126fSSrinivas Pandruvada * If there is a handler registered for the collection type, then 164cb67126fSSrinivas Pandruvada * it will handle all reports for sensors in this collection. If 165cb67126fSSrinivas Pandruvada * there is also an individual sensor handler registration, then 166cb67126fSSrinivas Pandruvada * we want to make sure that the reports are directed to collection 167cb67126fSSrinivas Pandruvada * handler, as this may be a fusion sensor. So add collection handlers 168cb67126fSSrinivas Pandruvada * to the beginning of the list, so that they are matched first. 169cb67126fSSrinivas Pandruvada */ 170cb67126fSSrinivas Pandruvada if (usage_id == HID_USAGE_SENSOR_COLLECTION) 171cb67126fSSrinivas Pandruvada list_add(&callback->list, &pdata->dyn_callback_list); 172cb67126fSSrinivas Pandruvada else 173401ca24fSsrinivas pandruvada list_add_tail(&callback->list, &pdata->dyn_callback_list); 1740ccf091dSJiri Kosina spin_unlock_irqrestore(&pdata->dyn_callback_lock, flags); 175401ca24fSsrinivas pandruvada 176401ca24fSsrinivas pandruvada return 0; 177401ca24fSsrinivas pandruvada } 178401ca24fSsrinivas pandruvada EXPORT_SYMBOL_GPL(sensor_hub_register_callback); 179401ca24fSsrinivas pandruvada 180401ca24fSsrinivas pandruvada int sensor_hub_remove_callback(struct hid_sensor_hub_device *hsdev, 181401ca24fSsrinivas pandruvada u32 usage_id) 182401ca24fSsrinivas pandruvada { 183401ca24fSsrinivas pandruvada struct hid_sensor_hub_callbacks_list *callback; 184401ca24fSsrinivas pandruvada struct sensor_hub_data *pdata = hid_get_drvdata(hsdev->hdev); 1850ccf091dSJiri Kosina unsigned long flags; 186401ca24fSsrinivas pandruvada 1870ccf091dSJiri Kosina spin_lock_irqsave(&pdata->dyn_callback_lock, flags); 188401ca24fSsrinivas pandruvada list_for_each_entry(callback, &pdata->dyn_callback_list, list) 189ca2ed12fSSrinivas Pandruvada if (callback->usage_id == usage_id && 190ca2ed12fSSrinivas Pandruvada callback->hsdev == hsdev) { 191401ca24fSsrinivas pandruvada list_del(&callback->list); 192401ca24fSsrinivas pandruvada kfree(callback); 193401ca24fSsrinivas pandruvada break; 194401ca24fSsrinivas pandruvada } 1950ccf091dSJiri Kosina spin_unlock_irqrestore(&pdata->dyn_callback_lock, flags); 196401ca24fSsrinivas pandruvada 197401ca24fSsrinivas pandruvada return 0; 198401ca24fSsrinivas pandruvada } 199401ca24fSsrinivas pandruvada EXPORT_SYMBOL_GPL(sensor_hub_remove_callback); 200401ca24fSsrinivas pandruvada 201401ca24fSsrinivas pandruvada int sensor_hub_set_feature(struct hid_sensor_hub_device *hsdev, u32 report_id, 202401ca24fSsrinivas pandruvada u32 field_index, s32 value) 203401ca24fSsrinivas pandruvada { 204401ca24fSsrinivas pandruvada struct hid_report *report; 205401ca24fSsrinivas pandruvada struct sensor_hub_data *data = hid_get_drvdata(hsdev->hdev); 206401ca24fSsrinivas pandruvada int ret = 0; 207401ca24fSsrinivas pandruvada 208401ca24fSsrinivas pandruvada mutex_lock(&data->mutex); 209401ca24fSsrinivas pandruvada report = sensor_hub_report(report_id, hsdev->hdev, HID_FEATURE_REPORT); 210401ca24fSsrinivas pandruvada if (!report || (field_index >= report->maxfield)) { 211401ca24fSsrinivas pandruvada ret = -EINVAL; 212401ca24fSsrinivas pandruvada goto done_proc; 213401ca24fSsrinivas pandruvada } 214401ca24fSsrinivas pandruvada hid_set_field(report->field[field_index], 0, value); 215d8814272SBenjamin Tissoires hid_hw_request(hsdev->hdev, report, HID_REQ_SET_REPORT); 216b7966a4dSBenjamin Tissoires hid_hw_wait(hsdev->hdev); 217401ca24fSsrinivas pandruvada 218401ca24fSsrinivas pandruvada done_proc: 219401ca24fSsrinivas pandruvada mutex_unlock(&data->mutex); 220401ca24fSsrinivas pandruvada 221401ca24fSsrinivas pandruvada return ret; 222401ca24fSsrinivas pandruvada } 223401ca24fSsrinivas pandruvada EXPORT_SYMBOL_GPL(sensor_hub_set_feature); 224401ca24fSsrinivas pandruvada 225401ca24fSsrinivas pandruvada int sensor_hub_get_feature(struct hid_sensor_hub_device *hsdev, u32 report_id, 226401ca24fSsrinivas pandruvada u32 field_index, s32 *value) 227401ca24fSsrinivas pandruvada { 228401ca24fSsrinivas pandruvada struct hid_report *report; 229401ca24fSsrinivas pandruvada struct sensor_hub_data *data = hid_get_drvdata(hsdev->hdev); 230401ca24fSsrinivas pandruvada int ret = 0; 231401ca24fSsrinivas pandruvada 232401ca24fSsrinivas pandruvada mutex_lock(&data->mutex); 233401ca24fSsrinivas pandruvada report = sensor_hub_report(report_id, hsdev->hdev, HID_FEATURE_REPORT); 2349e891025SKees Cook if (!report || (field_index >= report->maxfield) || 2359e891025SKees Cook report->field[field_index]->report_count < 1) { 236401ca24fSsrinivas pandruvada ret = -EINVAL; 237401ca24fSsrinivas pandruvada goto done_proc; 238401ca24fSsrinivas pandruvada } 239d8814272SBenjamin Tissoires hid_hw_request(hsdev->hdev, report, HID_REQ_GET_REPORT); 240b7966a4dSBenjamin Tissoires hid_hw_wait(hsdev->hdev); 241401ca24fSsrinivas pandruvada *value = report->field[field_index]->value[0]; 242401ca24fSsrinivas pandruvada 243401ca24fSsrinivas pandruvada done_proc: 244401ca24fSsrinivas pandruvada mutex_unlock(&data->mutex); 245401ca24fSsrinivas pandruvada 246401ca24fSsrinivas pandruvada return ret; 247401ca24fSsrinivas pandruvada } 248401ca24fSsrinivas pandruvada EXPORT_SYMBOL_GPL(sensor_hub_get_feature); 249401ca24fSsrinivas pandruvada 250401ca24fSsrinivas pandruvada 251401ca24fSsrinivas pandruvada int sensor_hub_input_attr_get_raw_value(struct hid_sensor_hub_device *hsdev, 252401ca24fSsrinivas pandruvada u32 usage_id, 253*b3f4737dSSrinivas Pandruvada u32 attr_usage_id, u32 report_id, 254*b3f4737dSSrinivas Pandruvada enum sensor_hub_read_flags flag) 255401ca24fSsrinivas pandruvada { 256401ca24fSsrinivas pandruvada struct sensor_hub_data *data = hid_get_drvdata(hsdev->hdev); 257401ca24fSsrinivas pandruvada unsigned long flags; 258401ca24fSsrinivas pandruvada struct hid_report *report; 259401ca24fSsrinivas pandruvada int ret_val = 0; 260401ca24fSsrinivas pandruvada 261*b3f4737dSSrinivas Pandruvada report = sensor_hub_report(report_id, hsdev->hdev, 262*b3f4737dSSrinivas Pandruvada HID_INPUT_REPORT); 263*b3f4737dSSrinivas Pandruvada if (!report) 264*b3f4737dSSrinivas Pandruvada return -EINVAL; 265*b3f4737dSSrinivas Pandruvada 266e651a1daSSrinivas Pandruvada mutex_lock(&hsdev->mutex); 267*b3f4737dSSrinivas Pandruvada if (flag == SENSOR_HUB_SYNC) { 268e651a1daSSrinivas Pandruvada memset(&hsdev->pending, 0, sizeof(hsdev->pending)); 269e651a1daSSrinivas Pandruvada init_completion(&hsdev->pending.ready); 270e651a1daSSrinivas Pandruvada hsdev->pending.usage_id = usage_id; 271e651a1daSSrinivas Pandruvada hsdev->pending.attr_usage_id = attr_usage_id; 272e651a1daSSrinivas Pandruvada hsdev->pending.raw_size = 0; 273401ca24fSsrinivas pandruvada 274401ca24fSsrinivas pandruvada spin_lock_irqsave(&data->lock, flags); 275e651a1daSSrinivas Pandruvada hsdev->pending.status = true; 276f74346a0SSrinivas Pandruvada spin_unlock_irqrestore(&data->lock, flags); 277*b3f4737dSSrinivas Pandruvada } 278e651a1daSSrinivas Pandruvada mutex_lock(&data->mutex); 279d8814272SBenjamin Tissoires hid_hw_request(hsdev->hdev, report, HID_REQ_GET_REPORT); 280e651a1daSSrinivas Pandruvada mutex_unlock(&data->mutex); 281*b3f4737dSSrinivas Pandruvada if (flag == SENSOR_HUB_SYNC) { 282*b3f4737dSSrinivas Pandruvada wait_for_completion_interruptible_timeout( 283*b3f4737dSSrinivas Pandruvada &hsdev->pending.ready, HZ*5); 284e651a1daSSrinivas Pandruvada switch (hsdev->pending.raw_size) { 285401ca24fSsrinivas pandruvada case 1: 286e651a1daSSrinivas Pandruvada ret_val = *(u8 *)hsdev->pending.raw_data; 287401ca24fSsrinivas pandruvada break; 288401ca24fSsrinivas pandruvada case 2: 289e651a1daSSrinivas Pandruvada ret_val = *(u16 *)hsdev->pending.raw_data; 290401ca24fSsrinivas pandruvada break; 291401ca24fSsrinivas pandruvada case 4: 292e651a1daSSrinivas Pandruvada ret_val = *(u32 *)hsdev->pending.raw_data; 293401ca24fSsrinivas pandruvada break; 294401ca24fSsrinivas pandruvada default: 295401ca24fSsrinivas pandruvada ret_val = 0; 296401ca24fSsrinivas pandruvada } 297e651a1daSSrinivas Pandruvada kfree(hsdev->pending.raw_data); 298e651a1daSSrinivas Pandruvada hsdev->pending.status = false; 299*b3f4737dSSrinivas Pandruvada } 300e651a1daSSrinivas Pandruvada mutex_unlock(&hsdev->mutex); 301401ca24fSsrinivas pandruvada 302401ca24fSsrinivas pandruvada return ret_val; 303401ca24fSsrinivas pandruvada } 304401ca24fSsrinivas pandruvada EXPORT_SYMBOL_GPL(sensor_hub_input_attr_get_raw_value); 305401ca24fSsrinivas pandruvada 306e02cee48SSrinivas Pandruvada int hid_sensor_get_usage_index(struct hid_sensor_hub_device *hsdev, 307e02cee48SSrinivas Pandruvada u32 report_id, int field_index, u32 usage_id) 308e02cee48SSrinivas Pandruvada { 309e02cee48SSrinivas Pandruvada struct hid_report *report; 310e02cee48SSrinivas Pandruvada struct hid_field *field; 311e02cee48SSrinivas Pandruvada int i; 312e02cee48SSrinivas Pandruvada 313e02cee48SSrinivas Pandruvada report = sensor_hub_report(report_id, hsdev->hdev, HID_FEATURE_REPORT); 314e02cee48SSrinivas Pandruvada if (!report || (field_index >= report->maxfield)) 315e02cee48SSrinivas Pandruvada goto done_proc; 316e02cee48SSrinivas Pandruvada 317e02cee48SSrinivas Pandruvada field = report->field[field_index]; 318e02cee48SSrinivas Pandruvada for (i = 0; i < field->maxusage; ++i) { 319e02cee48SSrinivas Pandruvada if (field->usage[i].hid == usage_id) 320e02cee48SSrinivas Pandruvada return field->usage[i].usage_index; 321e02cee48SSrinivas Pandruvada } 322e02cee48SSrinivas Pandruvada 323e02cee48SSrinivas Pandruvada done_proc: 324e02cee48SSrinivas Pandruvada return -EINVAL; 325e02cee48SSrinivas Pandruvada } 326e02cee48SSrinivas Pandruvada EXPORT_SYMBOL_GPL(hid_sensor_get_usage_index); 327e02cee48SSrinivas Pandruvada 328401ca24fSsrinivas pandruvada int sensor_hub_input_get_attribute_info(struct hid_sensor_hub_device *hsdev, 329401ca24fSsrinivas pandruvada u8 type, 330401ca24fSsrinivas pandruvada u32 usage_id, 331401ca24fSsrinivas pandruvada u32 attr_usage_id, 332401ca24fSsrinivas pandruvada struct hid_sensor_hub_attribute_info *info) 333401ca24fSsrinivas pandruvada { 334401ca24fSsrinivas pandruvada int ret = -1; 335ca2ed12fSSrinivas Pandruvada int i; 336401ca24fSsrinivas pandruvada struct hid_report *report; 337401ca24fSsrinivas pandruvada struct hid_field *field; 338401ca24fSsrinivas pandruvada struct hid_report_enum *report_enum; 339401ca24fSsrinivas pandruvada struct hid_device *hdev = hsdev->hdev; 340401ca24fSsrinivas pandruvada 341401ca24fSsrinivas pandruvada /* Initialize with defaults */ 342401ca24fSsrinivas pandruvada info->usage_id = usage_id; 343401ca24fSsrinivas pandruvada info->attrib_id = attr_usage_id; 344401ca24fSsrinivas pandruvada info->report_id = -1; 345401ca24fSsrinivas pandruvada info->index = -1; 346401ca24fSsrinivas pandruvada info->units = -1; 347401ca24fSsrinivas pandruvada info->unit_expo = -1; 348401ca24fSsrinivas pandruvada 349401ca24fSsrinivas pandruvada report_enum = &hdev->report_enum[type]; 350401ca24fSsrinivas pandruvada list_for_each_entry(report, &report_enum->report_list, list) { 351401ca24fSsrinivas pandruvada for (i = 0; i < report->maxfield; ++i) { 352401ca24fSsrinivas pandruvada field = report->field[i]; 353ca2ed12fSSrinivas Pandruvada if (field->maxusage) { 354401ca24fSsrinivas pandruvada if (field->physical == usage_id && 355ca2ed12fSSrinivas Pandruvada (field->logical == attr_usage_id || 356ca2ed12fSSrinivas Pandruvada field->usage[0].hid == 357ca2ed12fSSrinivas Pandruvada attr_usage_id) && 358ca2ed12fSSrinivas Pandruvada (field->usage[0].collection_index >= 359ca2ed12fSSrinivas Pandruvada hsdev->start_collection_index) && 360ca2ed12fSSrinivas Pandruvada (field->usage[0].collection_index < 361ca2ed12fSSrinivas Pandruvada hsdev->end_collection_index)) { 362ca2ed12fSSrinivas Pandruvada 363ca2ed12fSSrinivas Pandruvada sensor_hub_fill_attr_info(info, i, 364ca2ed12fSSrinivas Pandruvada report->id, 3659f740ffaSSrinivas Pandruvada field); 366401ca24fSsrinivas pandruvada ret = 0; 367401ca24fSsrinivas pandruvada break; 368401ca24fSsrinivas pandruvada } 369401ca24fSsrinivas pandruvada } 370401ca24fSsrinivas pandruvada } 371401ca24fSsrinivas pandruvada 372ca2ed12fSSrinivas Pandruvada } 373ca2ed12fSSrinivas Pandruvada 374401ca24fSsrinivas pandruvada return ret; 375401ca24fSsrinivas pandruvada } 376401ca24fSsrinivas pandruvada EXPORT_SYMBOL_GPL(sensor_hub_input_get_attribute_info); 377401ca24fSsrinivas pandruvada 378401ca24fSsrinivas pandruvada #ifdef CONFIG_PM 379401ca24fSsrinivas pandruvada static int sensor_hub_suspend(struct hid_device *hdev, pm_message_t message) 380401ca24fSsrinivas pandruvada { 381401ca24fSsrinivas pandruvada struct sensor_hub_data *pdata = hid_get_drvdata(hdev); 382401ca24fSsrinivas pandruvada struct hid_sensor_hub_callbacks_list *callback; 3830ccf091dSJiri Kosina unsigned long flags; 384401ca24fSsrinivas pandruvada 385401ca24fSsrinivas pandruvada hid_dbg(hdev, " sensor_hub_suspend\n"); 3860ccf091dSJiri Kosina spin_lock_irqsave(&pdata->dyn_callback_lock, flags); 387401ca24fSsrinivas pandruvada list_for_each_entry(callback, &pdata->dyn_callback_list, list) { 388401ca24fSsrinivas pandruvada if (callback->usage_callback->suspend) 389401ca24fSsrinivas pandruvada callback->usage_callback->suspend( 390ca2ed12fSSrinivas Pandruvada callback->hsdev, callback->priv); 391401ca24fSsrinivas pandruvada } 3920ccf091dSJiri Kosina spin_unlock_irqrestore(&pdata->dyn_callback_lock, flags); 393401ca24fSsrinivas pandruvada 394401ca24fSsrinivas pandruvada return 0; 395401ca24fSsrinivas pandruvada } 396401ca24fSsrinivas pandruvada 397401ca24fSsrinivas pandruvada static int sensor_hub_resume(struct hid_device *hdev) 398401ca24fSsrinivas pandruvada { 399401ca24fSsrinivas pandruvada struct sensor_hub_data *pdata = hid_get_drvdata(hdev); 400401ca24fSsrinivas pandruvada struct hid_sensor_hub_callbacks_list *callback; 4010ccf091dSJiri Kosina unsigned long flags; 402401ca24fSsrinivas pandruvada 403401ca24fSsrinivas pandruvada hid_dbg(hdev, " sensor_hub_resume\n"); 4040ccf091dSJiri Kosina spin_lock_irqsave(&pdata->dyn_callback_lock, flags); 405401ca24fSsrinivas pandruvada list_for_each_entry(callback, &pdata->dyn_callback_list, list) { 406401ca24fSsrinivas pandruvada if (callback->usage_callback->resume) 407401ca24fSsrinivas pandruvada callback->usage_callback->resume( 408ca2ed12fSSrinivas Pandruvada callback->hsdev, callback->priv); 409401ca24fSsrinivas pandruvada } 4100ccf091dSJiri Kosina spin_unlock_irqrestore(&pdata->dyn_callback_lock, flags); 411401ca24fSsrinivas pandruvada 412401ca24fSsrinivas pandruvada return 0; 413401ca24fSsrinivas pandruvada } 414401ca24fSsrinivas pandruvada 415401ca24fSsrinivas pandruvada static int sensor_hub_reset_resume(struct hid_device *hdev) 416401ca24fSsrinivas pandruvada { 417401ca24fSsrinivas pandruvada return 0; 418401ca24fSsrinivas pandruvada } 419401ca24fSsrinivas pandruvada #endif 4205902fde1SAndy Shevchenko 421401ca24fSsrinivas pandruvada /* 422401ca24fSsrinivas pandruvada * Handle raw report as sent by device 423401ca24fSsrinivas pandruvada */ 424401ca24fSsrinivas pandruvada static int sensor_hub_raw_event(struct hid_device *hdev, 425401ca24fSsrinivas pandruvada struct hid_report *report, u8 *raw_data, int size) 426401ca24fSsrinivas pandruvada { 427401ca24fSsrinivas pandruvada int i; 428401ca24fSsrinivas pandruvada u8 *ptr; 429401ca24fSsrinivas pandruvada int sz; 430401ca24fSsrinivas pandruvada struct sensor_hub_data *pdata = hid_get_drvdata(hdev); 431401ca24fSsrinivas pandruvada unsigned long flags; 432401ca24fSsrinivas pandruvada struct hid_sensor_hub_callbacks *callback = NULL; 433401ca24fSsrinivas pandruvada struct hid_collection *collection = NULL; 434401ca24fSsrinivas pandruvada void *priv = NULL; 435ca2ed12fSSrinivas Pandruvada struct hid_sensor_hub_device *hsdev = NULL; 436401ca24fSsrinivas pandruvada 437401ca24fSsrinivas pandruvada hid_dbg(hdev, "sensor_hub_raw_event report id:0x%x size:%d type:%d\n", 438401ca24fSsrinivas pandruvada report->id, size, report->type); 439401ca24fSsrinivas pandruvada hid_dbg(hdev, "maxfield:%d\n", report->maxfield); 440401ca24fSsrinivas pandruvada if (report->type != HID_INPUT_REPORT) 441401ca24fSsrinivas pandruvada return 1; 442401ca24fSsrinivas pandruvada 443401ca24fSsrinivas pandruvada ptr = raw_data; 444401ca24fSsrinivas pandruvada ptr++; /* Skip report id */ 445401ca24fSsrinivas pandruvada 446401ca24fSsrinivas pandruvada spin_lock_irqsave(&pdata->lock, flags); 447401ca24fSsrinivas pandruvada 448401ca24fSsrinivas pandruvada for (i = 0; i < report->maxfield; ++i) { 449401ca24fSsrinivas pandruvada hid_dbg(hdev, "%d collection_index:%x hid:%x sz:%x\n", 450401ca24fSsrinivas pandruvada i, report->field[i]->usage->collection_index, 451401ca24fSsrinivas pandruvada report->field[i]->usage->hid, 452d4b1bba7SSrinivas Pandruvada (report->field[i]->report_size * 453d4b1bba7SSrinivas Pandruvada report->field[i]->report_count)/8); 454d4b1bba7SSrinivas Pandruvada sz = (report->field[i]->report_size * 455d4b1bba7SSrinivas Pandruvada report->field[i]->report_count)/8; 456401ca24fSsrinivas pandruvada collection = &hdev->collection[ 457401ca24fSsrinivas pandruvada report->field[i]->usage->collection_index]; 458401ca24fSsrinivas pandruvada hid_dbg(hdev, "collection->usage %x\n", 459401ca24fSsrinivas pandruvada collection->usage); 460ca2ed12fSSrinivas Pandruvada 461ca2ed12fSSrinivas Pandruvada callback = sensor_hub_get_callback(hdev, 462401ca24fSsrinivas pandruvada report->field[i]->physical, 463ca2ed12fSSrinivas Pandruvada report->field[i]->usage[0].collection_index, 464ca2ed12fSSrinivas Pandruvada &hsdev, &priv); 465e651a1daSSrinivas Pandruvada if (!callback) { 466e651a1daSSrinivas Pandruvada ptr += sz; 467e651a1daSSrinivas Pandruvada continue; 468e651a1daSSrinivas Pandruvada } 469e651a1daSSrinivas Pandruvada if (hsdev->pending.status && hsdev->pending.attr_usage_id == 470e651a1daSSrinivas Pandruvada report->field[i]->usage->hid) { 471e651a1daSSrinivas Pandruvada hid_dbg(hdev, "data was pending ...\n"); 472e651a1daSSrinivas Pandruvada hsdev->pending.raw_data = kmemdup(ptr, sz, GFP_ATOMIC); 473e651a1daSSrinivas Pandruvada if (hsdev->pending.raw_data) 474e651a1daSSrinivas Pandruvada hsdev->pending.raw_size = sz; 475e651a1daSSrinivas Pandruvada else 476e651a1daSSrinivas Pandruvada hsdev->pending.raw_size = 0; 477e651a1daSSrinivas Pandruvada complete(&hsdev->pending.ready); 478e651a1daSSrinivas Pandruvada } 479e651a1daSSrinivas Pandruvada if (callback->capture_sample) { 480401ca24fSsrinivas pandruvada if (report->field[i]->logical) 481ca2ed12fSSrinivas Pandruvada callback->capture_sample(hsdev, 482401ca24fSsrinivas pandruvada report->field[i]->logical, sz, ptr, 483401ca24fSsrinivas pandruvada callback->pdev); 484401ca24fSsrinivas pandruvada else 485ca2ed12fSSrinivas Pandruvada callback->capture_sample(hsdev, 486401ca24fSsrinivas pandruvada report->field[i]->usage->hid, sz, ptr, 487401ca24fSsrinivas pandruvada callback->pdev); 488401ca24fSsrinivas pandruvada } 489401ca24fSsrinivas pandruvada ptr += sz; 490401ca24fSsrinivas pandruvada } 491401ca24fSsrinivas pandruvada if (callback && collection && callback->send_event) 492ca2ed12fSSrinivas Pandruvada callback->send_event(hsdev, collection->usage, 493401ca24fSsrinivas pandruvada callback->pdev); 494401ca24fSsrinivas pandruvada spin_unlock_irqrestore(&pdata->lock, flags); 495401ca24fSsrinivas pandruvada 496401ca24fSsrinivas pandruvada return 1; 497401ca24fSsrinivas pandruvada } 498401ca24fSsrinivas pandruvada 4991df3a401SSrinivas Pandruvada int sensor_hub_device_open(struct hid_sensor_hub_device *hsdev) 5001df3a401SSrinivas Pandruvada { 5011df3a401SSrinivas Pandruvada int ret = 0; 5021df3a401SSrinivas Pandruvada struct sensor_hub_data *data = hid_get_drvdata(hsdev->hdev); 5031df3a401SSrinivas Pandruvada 5041df3a401SSrinivas Pandruvada mutex_lock(&data->mutex); 505ca2ed12fSSrinivas Pandruvada if (!data->ref_cnt) { 5061df3a401SSrinivas Pandruvada ret = hid_hw_open(hsdev->hdev); 5071df3a401SSrinivas Pandruvada if (ret) { 5081df3a401SSrinivas Pandruvada hid_err(hsdev->hdev, "failed to open hid device\n"); 5091df3a401SSrinivas Pandruvada mutex_unlock(&data->mutex); 5101df3a401SSrinivas Pandruvada return ret; 5111df3a401SSrinivas Pandruvada } 5121df3a401SSrinivas Pandruvada } 513ca2ed12fSSrinivas Pandruvada data->ref_cnt++; 5141df3a401SSrinivas Pandruvada mutex_unlock(&data->mutex); 5151df3a401SSrinivas Pandruvada 5161df3a401SSrinivas Pandruvada return ret; 5171df3a401SSrinivas Pandruvada } 5181df3a401SSrinivas Pandruvada EXPORT_SYMBOL_GPL(sensor_hub_device_open); 5191df3a401SSrinivas Pandruvada 5201df3a401SSrinivas Pandruvada void sensor_hub_device_close(struct hid_sensor_hub_device *hsdev) 5211df3a401SSrinivas Pandruvada { 5221df3a401SSrinivas Pandruvada struct sensor_hub_data *data = hid_get_drvdata(hsdev->hdev); 5231df3a401SSrinivas Pandruvada 5241df3a401SSrinivas Pandruvada mutex_lock(&data->mutex); 525ca2ed12fSSrinivas Pandruvada data->ref_cnt--; 526ca2ed12fSSrinivas Pandruvada if (!data->ref_cnt) 5271df3a401SSrinivas Pandruvada hid_hw_close(hsdev->hdev); 5281df3a401SSrinivas Pandruvada mutex_unlock(&data->mutex); 5291df3a401SSrinivas Pandruvada } 5301df3a401SSrinivas Pandruvada EXPORT_SYMBOL_GPL(sensor_hub_device_close); 5311df3a401SSrinivas Pandruvada 532875e36f8SSrinivas Pandruvada static __u8 *sensor_hub_report_fixup(struct hid_device *hdev, __u8 *rdesc, 533875e36f8SSrinivas Pandruvada unsigned int *rsize) 534875e36f8SSrinivas Pandruvada { 535875e36f8SSrinivas Pandruvada int index; 536875e36f8SSrinivas Pandruvada struct sensor_hub_data *sd = hid_get_drvdata(hdev); 537875e36f8SSrinivas Pandruvada unsigned char report_block[] = { 538875e36f8SSrinivas Pandruvada 0x0a, 0x16, 0x03, 0x15, 0x00, 0x25, 0x05}; 539875e36f8SSrinivas Pandruvada unsigned char power_block[] = { 540875e36f8SSrinivas Pandruvada 0x0a, 0x19, 0x03, 0x15, 0x00, 0x25, 0x05}; 541875e36f8SSrinivas Pandruvada 542875e36f8SSrinivas Pandruvada if (!(sd->quirks & HID_SENSOR_HUB_ENUM_QUIRK)) { 543875e36f8SSrinivas Pandruvada hid_dbg(hdev, "No Enum quirks\n"); 544875e36f8SSrinivas Pandruvada return rdesc; 545875e36f8SSrinivas Pandruvada } 546875e36f8SSrinivas Pandruvada 547875e36f8SSrinivas Pandruvada /* Looks for power and report state usage id and force to 1 */ 548875e36f8SSrinivas Pandruvada for (index = 0; index < *rsize; ++index) { 549875e36f8SSrinivas Pandruvada if (((*rsize - index) > sizeof(report_block)) && 550875e36f8SSrinivas Pandruvada !memcmp(&rdesc[index], report_block, 551875e36f8SSrinivas Pandruvada sizeof(report_block))) { 552875e36f8SSrinivas Pandruvada rdesc[index + 4] = 0x01; 553875e36f8SSrinivas Pandruvada index += sizeof(report_block); 554875e36f8SSrinivas Pandruvada } 555875e36f8SSrinivas Pandruvada if (((*rsize - index) > sizeof(power_block)) && 556875e36f8SSrinivas Pandruvada !memcmp(&rdesc[index], power_block, 557875e36f8SSrinivas Pandruvada sizeof(power_block))) { 558875e36f8SSrinivas Pandruvada rdesc[index + 4] = 0x01; 559875e36f8SSrinivas Pandruvada index += sizeof(power_block); 560875e36f8SSrinivas Pandruvada } 561875e36f8SSrinivas Pandruvada } 562875e36f8SSrinivas Pandruvada 563875e36f8SSrinivas Pandruvada return rdesc; 564875e36f8SSrinivas Pandruvada } 565875e36f8SSrinivas Pandruvada 566401ca24fSsrinivas pandruvada static int sensor_hub_probe(struct hid_device *hdev, 567401ca24fSsrinivas pandruvada const struct hid_device_id *id) 568401ca24fSsrinivas pandruvada { 569401ca24fSsrinivas pandruvada int ret; 570401ca24fSsrinivas pandruvada struct sensor_hub_data *sd; 571401ca24fSsrinivas pandruvada int i; 572401ca24fSsrinivas pandruvada char *name; 573401ca24fSsrinivas pandruvada int dev_cnt; 574ca2ed12fSSrinivas Pandruvada struct hid_sensor_hub_device *hsdev; 575ca2ed12fSSrinivas Pandruvada struct hid_sensor_hub_device *last_hsdev = NULL; 576cb67126fSSrinivas Pandruvada struct hid_sensor_hub_device *collection_hsdev = NULL; 577401ca24fSsrinivas pandruvada 578905cc199SAndy Shevchenko sd = devm_kzalloc(&hdev->dev, sizeof(*sd), GFP_KERNEL); 579401ca24fSsrinivas pandruvada if (!sd) { 580401ca24fSsrinivas pandruvada hid_err(hdev, "cannot allocate Sensor data\n"); 581401ca24fSsrinivas pandruvada return -ENOMEM; 582401ca24fSsrinivas pandruvada } 583ca2ed12fSSrinivas Pandruvada 584401ca24fSsrinivas pandruvada hid_set_drvdata(hdev, sd); 585875e36f8SSrinivas Pandruvada sd->quirks = id->driver_data; 586ca2ed12fSSrinivas Pandruvada 587401ca24fSsrinivas pandruvada spin_lock_init(&sd->lock); 588401ca24fSsrinivas pandruvada spin_lock_init(&sd->dyn_callback_lock); 589401ca24fSsrinivas pandruvada mutex_init(&sd->mutex); 590401ca24fSsrinivas pandruvada ret = hid_parse(hdev); 591401ca24fSsrinivas pandruvada if (ret) { 592401ca24fSsrinivas pandruvada hid_err(hdev, "parse failed\n"); 593905cc199SAndy Shevchenko return ret; 594401ca24fSsrinivas pandruvada } 595401ca24fSsrinivas pandruvada INIT_LIST_HEAD(&hdev->inputs); 596401ca24fSsrinivas pandruvada 597401ca24fSsrinivas pandruvada ret = hid_hw_start(hdev, 0); 598401ca24fSsrinivas pandruvada if (ret) { 599401ca24fSsrinivas pandruvada hid_err(hdev, "hw start failed\n"); 600905cc199SAndy Shevchenko return ret; 601401ca24fSsrinivas pandruvada } 602401ca24fSsrinivas pandruvada INIT_LIST_HEAD(&sd->dyn_callback_list); 603401ca24fSsrinivas pandruvada sd->hid_sensor_client_cnt = 0; 604401ca24fSsrinivas pandruvada 605ca2ed12fSSrinivas Pandruvada dev_cnt = sensor_hub_get_physical_device_count(hdev); 606401ca24fSsrinivas pandruvada if (dev_cnt > HID_MAX_PHY_DEVICES) { 607401ca24fSsrinivas pandruvada hid_err(hdev, "Invalid Physical device count\n"); 608401ca24fSsrinivas pandruvada ret = -EINVAL; 6091df3a401SSrinivas Pandruvada goto err_stop_hw; 610401ca24fSsrinivas pandruvada } 6115be5db24SHimangi Saraogi sd->hid_sensor_hub_client_devs = devm_kzalloc(&hdev->dev, dev_cnt * 612401ca24fSsrinivas pandruvada sizeof(struct mfd_cell), 613401ca24fSsrinivas pandruvada GFP_KERNEL); 614401ca24fSsrinivas pandruvada if (sd->hid_sensor_hub_client_devs == NULL) { 615f2f13a68SAxel Lin hid_err(hdev, "Failed to allocate memory for mfd cells\n"); 616401ca24fSsrinivas pandruvada ret = -ENOMEM; 6171df3a401SSrinivas Pandruvada goto err_stop_hw; 618401ca24fSsrinivas pandruvada } 619ca2ed12fSSrinivas Pandruvada 620ca2ed12fSSrinivas Pandruvada for (i = 0; i < hdev->maxcollection; ++i) { 621ca2ed12fSSrinivas Pandruvada struct hid_collection *collection = &hdev->collection[i]; 622ca2ed12fSSrinivas Pandruvada 623cb67126fSSrinivas Pandruvada if (collection->type == HID_COLLECTION_PHYSICAL || 624cb67126fSSrinivas Pandruvada collection->type == HID_COLLECTION_APPLICATION) { 625ca2ed12fSSrinivas Pandruvada 6265be5db24SHimangi Saraogi hsdev = devm_kzalloc(&hdev->dev, sizeof(*hsdev), 6275be5db24SHimangi Saraogi GFP_KERNEL); 628ca2ed12fSSrinivas Pandruvada if (!hsdev) { 629ca2ed12fSSrinivas Pandruvada hid_err(hdev, "cannot allocate hid_sensor_hub_device\n"); 630ca2ed12fSSrinivas Pandruvada ret = -ENOMEM; 6315be5db24SHimangi Saraogi goto err_stop_hw; 632ca2ed12fSSrinivas Pandruvada } 633ca2ed12fSSrinivas Pandruvada hsdev->hdev = hdev; 634ca2ed12fSSrinivas Pandruvada hsdev->vendor_id = hdev->vendor; 635ca2ed12fSSrinivas Pandruvada hsdev->product_id = hdev->product; 636e651a1daSSrinivas Pandruvada hsdev->usage = collection->usage; 637e651a1daSSrinivas Pandruvada mutex_init(&hsdev->mutex); 638ca2ed12fSSrinivas Pandruvada hsdev->start_collection_index = i; 639ca2ed12fSSrinivas Pandruvada if (last_hsdev) 640ca2ed12fSSrinivas Pandruvada last_hsdev->end_collection_index = i; 641ca2ed12fSSrinivas Pandruvada last_hsdev = hsdev; 6425be5db24SHimangi Saraogi name = devm_kasprintf(&hdev->dev, GFP_KERNEL, 6435be5db24SHimangi Saraogi "HID-SENSOR-%x", 644ca2ed12fSSrinivas Pandruvada collection->usage); 645401ca24fSsrinivas pandruvada if (name == NULL) { 646f2f13a68SAxel Lin hid_err(hdev, "Failed MFD device name\n"); 647401ca24fSsrinivas pandruvada ret = -ENOMEM; 6485be5db24SHimangi Saraogi goto err_stop_hw; 649401ca24fSsrinivas pandruvada } 650401ca24fSsrinivas pandruvada sd->hid_sensor_hub_client_devs[ 651401ca24fSsrinivas pandruvada sd->hid_sensor_client_cnt].name = name; 652401ca24fSsrinivas pandruvada sd->hid_sensor_hub_client_devs[ 653401ca24fSsrinivas pandruvada sd->hid_sensor_client_cnt].platform_data = 654ca2ed12fSSrinivas Pandruvada hsdev; 655401ca24fSsrinivas pandruvada sd->hid_sensor_hub_client_devs[ 656401ca24fSsrinivas pandruvada sd->hid_sensor_client_cnt].pdata_size = 657ca2ed12fSSrinivas Pandruvada sizeof(*hsdev); 658ca2ed12fSSrinivas Pandruvada hid_dbg(hdev, "Adding %s:%d\n", name, 659ca2ed12fSSrinivas Pandruvada hsdev->start_collection_index); 660401ca24fSsrinivas pandruvada sd->hid_sensor_client_cnt++; 661cb67126fSSrinivas Pandruvada if (collection_hsdev) 662cb67126fSSrinivas Pandruvada collection_hsdev->end_collection_index = i; 663cb67126fSSrinivas Pandruvada if (collection->type == HID_COLLECTION_APPLICATION && 664cb67126fSSrinivas Pandruvada collection->usage == HID_USAGE_SENSOR_COLLECTION) 665cb67126fSSrinivas Pandruvada collection_hsdev = hsdev; 666401ca24fSsrinivas pandruvada } 667401ca24fSsrinivas pandruvada } 668ca2ed12fSSrinivas Pandruvada if (last_hsdev) 669ca2ed12fSSrinivas Pandruvada last_hsdev->end_collection_index = i; 670cb67126fSSrinivas Pandruvada if (collection_hsdev) 671cb67126fSSrinivas Pandruvada collection_hsdev->end_collection_index = i; 672ca2ed12fSSrinivas Pandruvada 67316b5fe29SJohan Hovold ret = mfd_add_hotplug_devices(&hdev->dev, 67416b5fe29SJohan Hovold sd->hid_sensor_hub_client_devs, 67516b5fe29SJohan Hovold sd->hid_sensor_client_cnt); 676401ca24fSsrinivas pandruvada if (ret < 0) 6775be5db24SHimangi Saraogi goto err_stop_hw; 678401ca24fSsrinivas pandruvada 679401ca24fSsrinivas pandruvada return ret; 680401ca24fSsrinivas pandruvada 681401ca24fSsrinivas pandruvada err_stop_hw: 682401ca24fSsrinivas pandruvada hid_hw_stop(hdev); 683401ca24fSsrinivas pandruvada 684401ca24fSsrinivas pandruvada return ret; 685401ca24fSsrinivas pandruvada } 686401ca24fSsrinivas pandruvada 687401ca24fSsrinivas pandruvada static void sensor_hub_remove(struct hid_device *hdev) 688401ca24fSsrinivas pandruvada { 689401ca24fSsrinivas pandruvada struct sensor_hub_data *data = hid_get_drvdata(hdev); 690401ca24fSsrinivas pandruvada unsigned long flags; 691e651a1daSSrinivas Pandruvada int i; 692401ca24fSsrinivas pandruvada 693401ca24fSsrinivas pandruvada hid_dbg(hdev, " hardware removed\n"); 694401ca24fSsrinivas pandruvada hid_hw_close(hdev); 695f2f13a68SAxel Lin hid_hw_stop(hdev); 696401ca24fSsrinivas pandruvada spin_lock_irqsave(&data->lock, flags); 697e651a1daSSrinivas Pandruvada for (i = 0; i < data->hid_sensor_client_cnt; ++i) { 698e651a1daSSrinivas Pandruvada struct hid_sensor_hub_device *hsdev = 699e651a1daSSrinivas Pandruvada data->hid_sensor_hub_client_devs[i].platform_data; 700e651a1daSSrinivas Pandruvada if (hsdev->pending.status) 701e651a1daSSrinivas Pandruvada complete(&hsdev->pending.ready); 702e651a1daSSrinivas Pandruvada } 703401ca24fSsrinivas pandruvada spin_unlock_irqrestore(&data->lock, flags); 704401ca24fSsrinivas pandruvada mfd_remove_devices(&hdev->dev); 705401ca24fSsrinivas pandruvada hid_set_drvdata(hdev, NULL); 706401ca24fSsrinivas pandruvada mutex_destroy(&data->mutex); 707401ca24fSsrinivas pandruvada } 708401ca24fSsrinivas pandruvada 709401ca24fSsrinivas pandruvada static const struct hid_device_id sensor_hub_devices[] = { 710875e36f8SSrinivas Pandruvada { HID_DEVICE(HID_BUS_ANY, HID_GROUP_SENSOR_HUB, USB_VENDOR_ID_INTEL_0, 71130f58877SStephen Chandler Paul USB_DEVICE_ID_INTEL_HID_SENSOR_0), 712875e36f8SSrinivas Pandruvada .driver_data = HID_SENSOR_HUB_ENUM_QUIRK}, 713875e36f8SSrinivas Pandruvada { HID_DEVICE(HID_BUS_ANY, HID_GROUP_SENSOR_HUB, USB_VENDOR_ID_INTEL_1, 71430f58877SStephen Chandler Paul USB_DEVICE_ID_INTEL_HID_SENSOR_0), 71530f58877SStephen Chandler Paul .driver_data = HID_SENSOR_HUB_ENUM_QUIRK}, 71630f58877SStephen Chandler Paul { HID_DEVICE(HID_BUS_ANY, HID_GROUP_SENSOR_HUB, USB_VENDOR_ID_INTEL_1, 71730f58877SStephen Chandler Paul USB_DEVICE_ID_INTEL_HID_SENSOR_1), 718875e36f8SSrinivas Pandruvada .driver_data = HID_SENSOR_HUB_ENUM_QUIRK}, 71900478ee8SReyad Attiyat { HID_DEVICE(HID_BUS_ANY, HID_GROUP_SENSOR_HUB, USB_VENDOR_ID_MICROSOFT, 72000478ee8SReyad Attiyat USB_DEVICE_ID_MS_SURFACE_PRO_2), 72100478ee8SReyad Attiyat .driver_data = HID_SENSOR_HUB_ENUM_QUIRK}, 72200478ee8SReyad Attiyat { HID_DEVICE(HID_BUS_ANY, HID_GROUP_SENSOR_HUB, USB_VENDOR_ID_MICROSOFT, 72300478ee8SReyad Attiyat USB_DEVICE_ID_MS_TOUCH_COVER_2), 72400478ee8SReyad Attiyat .driver_data = HID_SENSOR_HUB_ENUM_QUIRK}, 72500478ee8SReyad Attiyat { HID_DEVICE(HID_BUS_ANY, HID_GROUP_SENSOR_HUB, USB_VENDOR_ID_MICROSOFT, 72600478ee8SReyad Attiyat USB_DEVICE_ID_MS_TYPE_COVER_2), 72700478ee8SReyad Attiyat .driver_data = HID_SENSOR_HUB_ENUM_QUIRK}, 728218eb9edSArchana Patni { HID_DEVICE(HID_BUS_ANY, HID_GROUP_SENSOR_HUB, USB_VENDOR_ID_STM_0, 729467669c5SSrinivas Pandruvada USB_DEVICE_ID_STM_HID_SENSOR), 730467669c5SSrinivas Pandruvada .driver_data = HID_SENSOR_HUB_ENUM_QUIRK}, 731467669c5SSrinivas Pandruvada { HID_DEVICE(HID_BUS_ANY, HID_GROUP_SENSOR_HUB, USB_VENDOR_ID_STM_0, 732dde3b45cSArchana Patni USB_DEVICE_ID_STM_HID_SENSOR_1), 733218eb9edSArchana Patni .driver_data = HID_SENSOR_HUB_ENUM_QUIRK}, 734825747bbSPeter F. Patel-Schneider { HID_DEVICE(HID_BUS_ANY, HID_GROUP_SENSOR_HUB, USB_VENDOR_ID_TEXAS_INSTRUMENTS, 735825747bbSPeter F. Patel-Schneider USB_DEVICE_ID_TEXAS_INSTRUMENTS_LENOVO_YOGA), 736825747bbSPeter F. Patel-Schneider .driver_data = HID_SENSOR_HUB_ENUM_QUIRK}, 7370d1e4b02SMika Westerberg { HID_DEVICE(HID_BUS_ANY, HID_GROUP_SENSOR_HUB, HID_ANY_ID, 7380d1e4b02SMika Westerberg HID_ANY_ID) }, 739401ca24fSsrinivas pandruvada { } 740401ca24fSsrinivas pandruvada }; 741401ca24fSsrinivas pandruvada MODULE_DEVICE_TABLE(hid, sensor_hub_devices); 742401ca24fSsrinivas pandruvada 743401ca24fSsrinivas pandruvada static struct hid_driver sensor_hub_driver = { 744401ca24fSsrinivas pandruvada .name = "hid-sensor-hub", 745401ca24fSsrinivas pandruvada .id_table = sensor_hub_devices, 746401ca24fSsrinivas pandruvada .probe = sensor_hub_probe, 747401ca24fSsrinivas pandruvada .remove = sensor_hub_remove, 748401ca24fSsrinivas pandruvada .raw_event = sensor_hub_raw_event, 749875e36f8SSrinivas Pandruvada .report_fixup = sensor_hub_report_fixup, 750401ca24fSsrinivas pandruvada #ifdef CONFIG_PM 751401ca24fSsrinivas pandruvada .suspend = sensor_hub_suspend, 752401ca24fSsrinivas pandruvada .resume = sensor_hub_resume, 753401ca24fSsrinivas pandruvada .reset_resume = sensor_hub_reset_resume, 754401ca24fSsrinivas pandruvada #endif 755401ca24fSsrinivas pandruvada }; 756f425458eSH Hartley Sweeten module_hid_driver(sensor_hub_driver); 757401ca24fSsrinivas pandruvada 758401ca24fSsrinivas pandruvada MODULE_DESCRIPTION("HID Sensor Hub driver"); 759401ca24fSsrinivas pandruvada MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@intel.com>"); 760401ca24fSsrinivas pandruvada MODULE_LICENSE("GPL"); 761