1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * hid-sensor-custom.c
4  * Copyright (c) 2015, Intel Corporation.
5  */
6 
7 #include <linux/ctype.h>
8 #include <linux/dmi.h>
9 #include <linux/kernel.h>
10 #include <linux/module.h>
11 #include <linux/init.h>
12 #include <linux/miscdevice.h>
13 #include <linux/kfifo.h>
14 #include <linux/sched.h>
15 #include <linux/wait.h>
16 #include <linux/poll.h>
17 #include <linux/bsearch.h>
18 #include <linux/platform_device.h>
19 #include <linux/hid-sensor-hub.h>
20 
21 #define HID_CUSTOM_NAME_LENGTH		64
22 #define HID_CUSTOM_MAX_CORE_ATTRS	10
23 #define HID_CUSTOM_TOTAL_ATTRS		(HID_CUSTOM_MAX_CORE_ATTRS + 1)
24 #define HID_CUSTOM_FIFO_SIZE		4096
25 #define HID_CUSTOM_MAX_FEATURE_BYTES	64
26 #define HID_SENSOR_USAGE_LENGTH (4 + 1)
27 
28 struct hid_sensor_custom_field {
29 	int report_id;
30 	char group_name[HID_CUSTOM_NAME_LENGTH];
31 	struct hid_sensor_hub_attribute_info attribute;
32 	struct device_attribute sd_attrs[HID_CUSTOM_MAX_CORE_ATTRS];
33 	char attr_name[HID_CUSTOM_TOTAL_ATTRS][HID_CUSTOM_NAME_LENGTH];
34 	struct attribute *attrs[HID_CUSTOM_TOTAL_ATTRS];
35 	struct attribute_group hid_custom_attribute_group;
36 };
37 
38 struct hid_sensor_custom {
39 	struct mutex mutex;
40 	struct platform_device *pdev;
41 	struct hid_sensor_hub_device *hsdev;
42 	struct hid_sensor_hub_callbacks callbacks;
43 	int sensor_field_count;
44 	struct hid_sensor_custom_field *fields;
45 	int input_field_count;
46 	int input_report_size;
47 	int input_report_recd_size;
48 	bool input_skip_sample;
49 	bool enable;
50 	struct hid_sensor_custom_field *power_state;
51 	struct hid_sensor_custom_field *report_state;
52 	struct miscdevice custom_dev;
53 	struct kfifo data_fifo;
54 	unsigned long misc_opened;
55 	wait_queue_head_t wait;
56 	struct platform_device *custom_pdev;
57 };
58 
59 /* Header for each sample to user space via dev interface */
60 struct hid_sensor_sample {
61 	u32 usage_id;
62 	u64 timestamp;
63 	u32 raw_len;
64 } __packed;
65 
66 static struct attribute hid_custom_attrs[HID_CUSTOM_TOTAL_ATTRS] = {
67 	{.name = "name", .mode = S_IRUGO},
68 	{.name = "units", .mode = S_IRUGO},
69 	{.name = "unit-expo", .mode = S_IRUGO},
70 	{.name = "minimum", .mode = S_IRUGO},
71 	{.name = "maximum", .mode = S_IRUGO},
72 	{.name = "size", .mode = S_IRUGO},
73 	{.name = "value", .mode = S_IWUSR | S_IRUGO},
74 	{.name = NULL}
75 };
76 
77 static const struct hid_custom_usage_desc {
78 	int usage_id;
79 	char *desc;
80 } hid_custom_usage_desc_table[] = {
81 	{0x200201,	"event-sensor-state"},
82 	{0x200202,	"event-sensor-event"},
83 	{0x200301,	"property-friendly-name"},
84 	{0x200302,	"property-persistent-unique-id"},
85 	{0x200303,	"property-sensor-status"},
86 	{0x200304,	"property-min-report-interval"},
87 	{0x200305,	"property-sensor-manufacturer"},
88 	{0x200306,	"property-sensor-model"},
89 	{0x200307,	"property-sensor-serial-number"},
90 	{0x200308,	"property-sensor-description"},
91 	{0x200309,	"property-sensor-connection-type"},
92 	{0x20030A,	"property-sensor-device-path"},
93 	{0x20030B,	"property-hardware-revision"},
94 	{0x20030C,	"property-firmware-version"},
95 	{0x20030D,	"property-release-date"},
96 	{0x20030E,	"property-report-interval"},
97 	{0x20030F,	"property-change-sensitivity-absolute"},
98 	{0x200310,	"property-change-sensitivity-percent-range"},
99 	{0x200311,	"property-change-sensitivity-percent-relative"},
100 	{0x200312,	"property-accuracy"},
101 	{0x200313,	"property-resolution"},
102 	{0x200314,	"property-maximum"},
103 	{0x200315,	"property-minimum"},
104 	{0x200316,	"property-reporting-state"},
105 	{0x200317,	"property-sampling-rate"},
106 	{0x200318,	"property-response-curve"},
107 	{0x200319,	"property-power-state"},
108 	{0x200540,	"data-field-custom"},
109 	{0x200541,	"data-field-custom-usage"},
110 	{0x200542,	"data-field-custom-boolean-array"},
111 	{0x200543,	"data-field-custom-value"},
112 	{0x200544,	"data-field-custom-value_1"},
113 	{0x200545,	"data-field-custom-value_2"},
114 	{0x200546,	"data-field-custom-value_3"},
115 	{0x200547,	"data-field-custom-value_4"},
116 	{0x200548,	"data-field-custom-value_5"},
117 	{0x200549,	"data-field-custom-value_6"},
118 	{0x20054A,	"data-field-custom-value_7"},
119 	{0x20054B,	"data-field-custom-value_8"},
120 	{0x20054C,	"data-field-custom-value_9"},
121 	{0x20054D,	"data-field-custom-value_10"},
122 	{0x20054E,	"data-field-custom-value_11"},
123 	{0x20054F,	"data-field-custom-value_12"},
124 	{0x200550,	"data-field-custom-value_13"},
125 	{0x200551,	"data-field-custom-value_14"},
126 	{0x200552,	"data-field-custom-value_15"},
127 	{0x200553,	"data-field-custom-value_16"},
128 	{0x200554,	"data-field-custom-value_17"},
129 	{0x200555,	"data-field-custom-value_18"},
130 	{0x200556,	"data-field-custom-value_19"},
131 	{0x200557,	"data-field-custom-value_20"},
132 	{0x200558,	"data-field-custom-value_21"},
133 	{0x200559,	"data-field-custom-value_22"},
134 	{0x20055A,	"data-field-custom-value_23"},
135 	{0x20055B,	"data-field-custom-value_24"},
136 	{0x20055C,	"data-field-custom-value_25"},
137 	{0x20055D,	"data-field-custom-value_26"},
138 	{0x20055E,	"data-field-custom-value_27"},
139 	{0x20055F,	"data-field-custom-value_28"},
140 };
141 
142 static int usage_id_cmp(const void *p1, const void *p2)
143 {
144 	if (*(int *)p1 < *(int *)p2)
145 		return -1;
146 
147 	if (*(int *)p1 > *(int *)p2)
148 		return 1;
149 
150 	return 0;
151 }
152 
153 static ssize_t enable_sensor_show(struct device *dev,
154 				  struct device_attribute *attr, char *buf)
155 {
156 	struct hid_sensor_custom *sensor_inst = dev_get_drvdata(dev);
157 
158 	return sprintf(buf, "%d\n", sensor_inst->enable);
159 }
160 
161 static int set_power_report_state(struct hid_sensor_custom *sensor_inst,
162 				  bool state)
163 {
164 	int power_val = -1;
165 	int report_val = -1;
166 	u32 power_state_usage_id;
167 	u32 report_state_usage_id;
168 	int ret;
169 
170 	/*
171 	 * It is possible that the power/report state ids are not present.
172 	 * In this case this function will return success. But if the
173 	 * ids are present, then it will return error if set fails.
174 	 */
175 	if (state) {
176 		power_state_usage_id =
177 			HID_USAGE_SENSOR_PROP_POWER_STATE_D0_FULL_POWER_ENUM;
178 		report_state_usage_id =
179 			HID_USAGE_SENSOR_PROP_REPORTING_STATE_ALL_EVENTS_ENUM;
180 	} else {
181 		power_state_usage_id =
182 			HID_USAGE_SENSOR_PROP_POWER_STATE_D4_POWER_OFF_ENUM;
183 		report_state_usage_id =
184 			HID_USAGE_SENSOR_PROP_REPORTING_STATE_NO_EVENTS_ENUM;
185 	}
186 
187 	if (sensor_inst->power_state)
188 		power_val = hid_sensor_get_usage_index(sensor_inst->hsdev,
189 				sensor_inst->power_state->attribute.report_id,
190 				sensor_inst->power_state->attribute.index,
191 				power_state_usage_id);
192 	if (sensor_inst->report_state)
193 		report_val = hid_sensor_get_usage_index(sensor_inst->hsdev,
194 				sensor_inst->report_state->attribute.report_id,
195 				sensor_inst->report_state->attribute.index,
196 				report_state_usage_id);
197 
198 	if (power_val >= 0) {
199 		power_val +=
200 			sensor_inst->power_state->attribute.logical_minimum;
201 		ret = sensor_hub_set_feature(sensor_inst->hsdev,
202 				sensor_inst->power_state->attribute.report_id,
203 				sensor_inst->power_state->attribute.index,
204 				sizeof(power_val),
205 				&power_val);
206 		if (ret) {
207 			hid_err(sensor_inst->hsdev->hdev,
208 				"Set power state failed\n");
209 			return ret;
210 		}
211 	}
212 
213 	if (report_val >= 0) {
214 		report_val +=
215 			sensor_inst->report_state->attribute.logical_minimum;
216 		ret = sensor_hub_set_feature(sensor_inst->hsdev,
217 				sensor_inst->report_state->attribute.report_id,
218 				sensor_inst->report_state->attribute.index,
219 				sizeof(report_val),
220 				&report_val);
221 		if (ret) {
222 			hid_err(sensor_inst->hsdev->hdev,
223 				"Set report state failed\n");
224 			return ret;
225 		}
226 	}
227 
228 	return 0;
229 }
230 
231 static ssize_t enable_sensor_store(struct device *dev,
232 				   struct device_attribute *attr,
233 				   const char *buf, size_t count)
234 {
235 	struct hid_sensor_custom *sensor_inst = dev_get_drvdata(dev);
236 	int value;
237 	int ret = -EINVAL;
238 
239 	if (kstrtoint(buf, 0, &value) != 0)
240 		return -EINVAL;
241 
242 	mutex_lock(&sensor_inst->mutex);
243 	if (value && !sensor_inst->enable) {
244 		ret = sensor_hub_device_open(sensor_inst->hsdev);
245 		if (ret)
246 			goto unlock_state;
247 
248 		ret = set_power_report_state(sensor_inst, true);
249 		if (ret) {
250 			sensor_hub_device_close(sensor_inst->hsdev);
251 			goto unlock_state;
252 		}
253 		sensor_inst->enable = true;
254 	} else if (!value && sensor_inst->enable) {
255 		ret = set_power_report_state(sensor_inst, false);
256 		sensor_hub_device_close(sensor_inst->hsdev);
257 		sensor_inst->enable = false;
258 	}
259 unlock_state:
260 	mutex_unlock(&sensor_inst->mutex);
261 	if (ret < 0)
262 		return ret;
263 
264 	return count;
265 }
266 static DEVICE_ATTR_RW(enable_sensor);
267 
268 static struct attribute *enable_sensor_attrs[] = {
269 	&dev_attr_enable_sensor.attr,
270 	NULL,
271 };
272 
273 static const struct attribute_group enable_sensor_attr_group = {
274 	.attrs = enable_sensor_attrs,
275 };
276 
277 static ssize_t show_value(struct device *dev, struct device_attribute *attr,
278 			  char *buf)
279 {
280 	struct hid_sensor_custom *sensor_inst = dev_get_drvdata(dev);
281 	struct hid_sensor_hub_attribute_info *attribute;
282 	int index, usage, field_index;
283 	char name[HID_CUSTOM_NAME_LENGTH];
284 	bool feature = false;
285 	bool input = false;
286 	int value = 0;
287 
288 	if (sscanf(attr->attr.name, "feature-%x-%x-%s", &index, &usage,
289 		   name) == 3) {
290 		feature = true;
291 		field_index = index + sensor_inst->input_field_count;
292 	} else if (sscanf(attr->attr.name, "input-%x-%x-%s", &index, &usage,
293 		   name) == 3) {
294 		input = true;
295 		field_index = index;
296 	} else
297 		return -EINVAL;
298 
299 	if (!strncmp(name, "value", strlen("value"))) {
300 		u32 report_id;
301 		int ret;
302 
303 		attribute = &sensor_inst->fields[field_index].attribute;
304 		report_id = attribute->report_id;
305 		if (feature) {
306 			u8 values[HID_CUSTOM_MAX_FEATURE_BYTES];
307 			int len = 0;
308 			u64 value = 0;
309 			int i = 0;
310 
311 			ret = sensor_hub_get_feature(sensor_inst->hsdev,
312 						     report_id,
313 						     index,
314 						     sizeof(values), values);
315 			if (ret < 0)
316 				return ret;
317 
318 			while (i < ret) {
319 				if (i + attribute->size > ret) {
320 					len += scnprintf(&buf[len],
321 							PAGE_SIZE - len,
322 							"%d ", values[i]);
323 					break;
324 				}
325 				switch (attribute->size) {
326 				case 2:
327 					value = (u64) *(u16 *)&values[i];
328 					i += attribute->size;
329 					break;
330 				case 4:
331 					value = (u64) *(u32 *)&values[i];
332 					i += attribute->size;
333 					break;
334 				case 8:
335 					value = *(u64 *)&values[i];
336 					i += attribute->size;
337 					break;
338 				default:
339 					value = (u64) values[i];
340 					++i;
341 					break;
342 				}
343 				len += scnprintf(&buf[len], PAGE_SIZE - len,
344 						"%lld ", value);
345 			}
346 			len += scnprintf(&buf[len], PAGE_SIZE - len, "\n");
347 
348 			return len;
349 		} else if (input)
350 			value = sensor_hub_input_attr_get_raw_value(
351 						sensor_inst->hsdev,
352 						sensor_inst->hsdev->usage,
353 						usage, report_id,
354 						SENSOR_HUB_SYNC, false);
355 	} else if (!strncmp(name, "units", strlen("units")))
356 		value = sensor_inst->fields[field_index].attribute.units;
357 	else if (!strncmp(name, "unit-expo", strlen("unit-expo")))
358 		value = sensor_inst->fields[field_index].attribute.unit_expo;
359 	else if (!strncmp(name, "size", strlen("size")))
360 		value = sensor_inst->fields[field_index].attribute.size;
361 	else if (!strncmp(name, "minimum", strlen("minimum")))
362 		value = sensor_inst->fields[field_index].attribute.
363 							logical_minimum;
364 	else if (!strncmp(name, "maximum", strlen("maximum")))
365 		value = sensor_inst->fields[field_index].attribute.
366 							logical_maximum;
367 	else if (!strncmp(name, "name", strlen("name"))) {
368 		struct hid_custom_usage_desc *usage_desc;
369 
370 		usage_desc = bsearch(&usage, hid_custom_usage_desc_table,
371 				     ARRAY_SIZE(hid_custom_usage_desc_table),
372 				     sizeof(struct hid_custom_usage_desc),
373 				     usage_id_cmp);
374 		if (usage_desc)
375 			return snprintf(buf, PAGE_SIZE, "%s\n",
376 					usage_desc->desc);
377 		else
378 			return sprintf(buf, "not-specified\n");
379 	 } else
380 		return -EINVAL;
381 
382 	return sprintf(buf, "%d\n", value);
383 }
384 
385 static ssize_t store_value(struct device *dev, struct device_attribute *attr,
386 			   const char *buf, size_t count)
387 {
388 	struct hid_sensor_custom *sensor_inst = dev_get_drvdata(dev);
389 	int index, field_index, usage;
390 	char name[HID_CUSTOM_NAME_LENGTH];
391 	int value, ret;
392 
393 	if (sscanf(attr->attr.name, "feature-%x-%x-%s", &index, &usage,
394 		   name) == 3) {
395 		field_index = index + sensor_inst->input_field_count;
396 	} else
397 		return -EINVAL;
398 
399 	if (!strncmp(name, "value", strlen("value"))) {
400 		u32 report_id;
401 
402 		if (kstrtoint(buf, 0, &value) != 0)
403 			return -EINVAL;
404 
405 		report_id = sensor_inst->fields[field_index].attribute.
406 								report_id;
407 		ret = sensor_hub_set_feature(sensor_inst->hsdev, report_id,
408 					     index, sizeof(value), &value);
409 		if (ret)
410 			return ret;
411 	} else
412 		return -EINVAL;
413 
414 	return count;
415 }
416 
417 static int hid_sensor_capture_sample(struct hid_sensor_hub_device *hsdev,
418 				  unsigned usage_id, size_t raw_len,
419 				  char *raw_data, void *priv)
420 {
421 	struct hid_sensor_custom *sensor_inst = platform_get_drvdata(priv);
422 	struct hid_sensor_sample header;
423 
424 	/* If any error occurs in a sample, rest of the fields are ignored */
425 	if (sensor_inst->input_skip_sample) {
426 		hid_err(sensor_inst->hsdev->hdev, "Skipped remaining data\n");
427 		return 0;
428 	}
429 
430 	hid_dbg(sensor_inst->hsdev->hdev, "%s received %d of %d\n", __func__,
431 		(int) (sensor_inst->input_report_recd_size + raw_len),
432 		sensor_inst->input_report_size);
433 
434 	if (!test_bit(0, &sensor_inst->misc_opened))
435 		return 0;
436 
437 	if (!sensor_inst->input_report_recd_size) {
438 		int required_size = sizeof(struct hid_sensor_sample) +
439 						sensor_inst->input_report_size;
440 		header.usage_id = hsdev->usage;
441 		header.raw_len = sensor_inst->input_report_size;
442 		header.timestamp = ktime_get_real_ns();
443 		if (kfifo_avail(&sensor_inst->data_fifo) >= required_size) {
444 			kfifo_in(&sensor_inst->data_fifo,
445 				 (unsigned char *)&header,
446 				 sizeof(header));
447 		} else
448 			sensor_inst->input_skip_sample = true;
449 	}
450 	if (kfifo_avail(&sensor_inst->data_fifo) >= raw_len)
451 		kfifo_in(&sensor_inst->data_fifo, (unsigned char *)raw_data,
452 			 raw_len);
453 
454 	sensor_inst->input_report_recd_size += raw_len;
455 
456 	return 0;
457 }
458 
459 static int hid_sensor_send_event(struct hid_sensor_hub_device *hsdev,
460 				 unsigned usage_id, void *priv)
461 {
462 	struct hid_sensor_custom *sensor_inst = platform_get_drvdata(priv);
463 
464 	if (!test_bit(0, &sensor_inst->misc_opened))
465 		return 0;
466 
467 	sensor_inst->input_report_recd_size = 0;
468 	sensor_inst->input_skip_sample = false;
469 
470 	wake_up(&sensor_inst->wait);
471 
472 	return 0;
473 }
474 
475 static int hid_sensor_custom_add_field(struct hid_sensor_custom *sensor_inst,
476 				       int index, int report_type,
477 				       struct hid_report *report,
478 				       struct hid_field *field)
479 {
480 	struct hid_sensor_custom_field *sensor_field;
481 	void *fields;
482 
483 	fields = krealloc(sensor_inst->fields,
484 			  (sensor_inst->sensor_field_count + 1) *
485 			   sizeof(struct hid_sensor_custom_field), GFP_KERNEL);
486 	if (!fields) {
487 		kfree(sensor_inst->fields);
488 		return -ENOMEM;
489 	}
490 	sensor_inst->fields = fields;
491 	sensor_field = &sensor_inst->fields[sensor_inst->sensor_field_count];
492 	sensor_field->attribute.usage_id = sensor_inst->hsdev->usage;
493 	if (field->logical)
494 		sensor_field->attribute.attrib_id = field->logical;
495 	else
496 		sensor_field->attribute.attrib_id = field->usage[0].hid;
497 
498 	sensor_field->attribute.index = index;
499 	sensor_field->attribute.report_id = report->id;
500 	sensor_field->attribute.units = field->unit;
501 	sensor_field->attribute.unit_expo = field->unit_exponent;
502 	sensor_field->attribute.size = (field->report_size / 8);
503 	sensor_field->attribute.logical_minimum = field->logical_minimum;
504 	sensor_field->attribute.logical_maximum = field->logical_maximum;
505 
506 	if (report_type == HID_FEATURE_REPORT)
507 		snprintf(sensor_field->group_name,
508 			 sizeof(sensor_field->group_name), "feature-%x-%x",
509 			 sensor_field->attribute.index,
510 			 sensor_field->attribute.attrib_id);
511 	else if (report_type == HID_INPUT_REPORT) {
512 		snprintf(sensor_field->group_name,
513 			 sizeof(sensor_field->group_name),
514 			 "input-%x-%x", sensor_field->attribute.index,
515 			 sensor_field->attribute.attrib_id);
516 		sensor_inst->input_field_count++;
517 		sensor_inst->input_report_size += (field->report_size *
518 						   field->report_count) / 8;
519 	}
520 
521 	memset(&sensor_field->hid_custom_attribute_group, 0,
522 	       sizeof(struct attribute_group));
523 	sensor_inst->sensor_field_count++;
524 
525 	return 0;
526 }
527 
528 static int hid_sensor_custom_add_fields(struct hid_sensor_custom *sensor_inst,
529 					struct hid_report_enum *report_enum,
530 					int report_type)
531 {
532 	int i;
533 	int ret;
534 	struct hid_report *report;
535 	struct hid_field *field;
536 	struct hid_sensor_hub_device *hsdev = sensor_inst->hsdev;
537 
538 	list_for_each_entry(report, &report_enum->report_list, list) {
539 		for (i = 0; i < report->maxfield; ++i) {
540 			field = report->field[i];
541 			if (field->maxusage &&
542 			    ((field->usage[0].collection_index >=
543 			      hsdev->start_collection_index) &&
544 			      (field->usage[0].collection_index <
545 			       hsdev->end_collection_index))) {
546 
547 				ret = hid_sensor_custom_add_field(sensor_inst,
548 								  i,
549 								  report_type,
550 								  report,
551 								  field);
552 				if (ret)
553 					return ret;
554 
555 			}
556 		}
557 	}
558 
559 	return 0;
560 }
561 
562 static int hid_sensor_custom_add_attributes(struct hid_sensor_custom
563 								*sensor_inst)
564 {
565 	struct hid_sensor_hub_device *hsdev = sensor_inst->hsdev;
566 	struct hid_device *hdev = hsdev->hdev;
567 	int ret = -1;
568 	int i, j;
569 
570 	for (j = 0; j < HID_REPORT_TYPES; ++j) {
571 		if (j == HID_OUTPUT_REPORT)
572 			continue;
573 
574 		ret = hid_sensor_custom_add_fields(sensor_inst,
575 						   &hdev->report_enum[j], j);
576 		if (ret)
577 			return ret;
578 
579 	}
580 
581 	/* Create sysfs attributes */
582 	for (i = 0; i < sensor_inst->sensor_field_count; ++i) {
583 		j = 0;
584 		while (j < HID_CUSTOM_TOTAL_ATTRS &&
585 		       hid_custom_attrs[j].name) {
586 			struct device_attribute *device_attr;
587 
588 			device_attr = &sensor_inst->fields[i].sd_attrs[j];
589 
590 			snprintf((char *)&sensor_inst->fields[i].attr_name[j],
591 				 HID_CUSTOM_NAME_LENGTH, "%s-%s",
592 				 sensor_inst->fields[i].group_name,
593 				 hid_custom_attrs[j].name);
594 			sysfs_attr_init(&device_attr->attr);
595 			device_attr->attr.name =
596 				(char *)&sensor_inst->fields[i].attr_name[j];
597 			device_attr->attr.mode = hid_custom_attrs[j].mode;
598 			device_attr->show = show_value;
599 			if (hid_custom_attrs[j].mode & S_IWUSR)
600 				device_attr->store = store_value;
601 			sensor_inst->fields[i].attrs[j] = &device_attr->attr;
602 			++j;
603 		}
604 		sensor_inst->fields[i].attrs[j] = NULL;
605 		sensor_inst->fields[i].hid_custom_attribute_group.attrs =
606 						sensor_inst->fields[i].attrs;
607 		sensor_inst->fields[i].hid_custom_attribute_group.name =
608 					sensor_inst->fields[i].group_name;
609 		ret = sysfs_create_group(&sensor_inst->pdev->dev.kobj,
610 					 &sensor_inst->fields[i].
611 					 hid_custom_attribute_group);
612 		if (ret)
613 			break;
614 
615 		/* For power or report field store indexes */
616 		if (sensor_inst->fields[i].attribute.attrib_id ==
617 					HID_USAGE_SENSOR_PROY_POWER_STATE)
618 			sensor_inst->power_state = &sensor_inst->fields[i];
619 		else if (sensor_inst->fields[i].attribute.attrib_id ==
620 					HID_USAGE_SENSOR_PROP_REPORT_STATE)
621 			sensor_inst->report_state = &sensor_inst->fields[i];
622 	}
623 
624 	return ret;
625 }
626 
627 static void hid_sensor_custom_remove_attributes(struct hid_sensor_custom *
628 								sensor_inst)
629 {
630 	int i;
631 
632 	for (i = 0; i < sensor_inst->sensor_field_count; ++i)
633 		sysfs_remove_group(&sensor_inst->pdev->dev.kobj,
634 				   &sensor_inst->fields[i].
635 				   hid_custom_attribute_group);
636 
637 	kfree(sensor_inst->fields);
638 }
639 
640 static ssize_t hid_sensor_custom_read(struct file *file, char __user *buf,
641 				      size_t count, loff_t *f_ps)
642 {
643 	struct hid_sensor_custom *sensor_inst;
644 	unsigned int copied;
645 	int ret;
646 
647 	sensor_inst = container_of(file->private_data,
648 				   struct hid_sensor_custom, custom_dev);
649 
650 	if (count < sizeof(struct hid_sensor_sample))
651 		return -EINVAL;
652 
653 	do {
654 		if (kfifo_is_empty(&sensor_inst->data_fifo)) {
655 			if (file->f_flags & O_NONBLOCK)
656 				return -EAGAIN;
657 
658 			ret = wait_event_interruptible(sensor_inst->wait,
659 				!kfifo_is_empty(&sensor_inst->data_fifo));
660 			if (ret)
661 				return ret;
662 		}
663 		ret = kfifo_to_user(&sensor_inst->data_fifo, buf, count,
664 				    &copied);
665 		if (ret)
666 			return ret;
667 
668 	} while (copied == 0);
669 
670 	return copied;
671 }
672 
673 static int hid_sensor_custom_release(struct inode *inode, struct file *file)
674 {
675 	struct hid_sensor_custom *sensor_inst;
676 
677 	sensor_inst = container_of(file->private_data,
678 				   struct hid_sensor_custom, custom_dev);
679 
680 	clear_bit(0, &sensor_inst->misc_opened);
681 
682 	return 0;
683 }
684 
685 static int hid_sensor_custom_open(struct inode *inode, struct file *file)
686 {
687 	struct hid_sensor_custom *sensor_inst;
688 
689 	sensor_inst = container_of(file->private_data,
690 				   struct hid_sensor_custom, custom_dev);
691 	/* We essentially have single reader and writer */
692 	if (test_and_set_bit(0, &sensor_inst->misc_opened))
693 		return -EBUSY;
694 
695 	return stream_open(inode, file);
696 }
697 
698 static __poll_t hid_sensor_custom_poll(struct file *file,
699 					   struct poll_table_struct *wait)
700 {
701 	struct hid_sensor_custom *sensor_inst;
702 	__poll_t mask = 0;
703 
704 	sensor_inst = container_of(file->private_data,
705 				   struct hid_sensor_custom, custom_dev);
706 
707 	poll_wait(file, &sensor_inst->wait, wait);
708 
709 	if (!kfifo_is_empty(&sensor_inst->data_fifo))
710 		mask = EPOLLIN | EPOLLRDNORM;
711 
712 	return mask;
713 }
714 
715 static const struct file_operations hid_sensor_custom_fops = {
716 	.open =  hid_sensor_custom_open,
717 	.read =  hid_sensor_custom_read,
718 	.release = hid_sensor_custom_release,
719 	.poll = hid_sensor_custom_poll,
720 	.llseek = noop_llseek,
721 };
722 
723 static int hid_sensor_custom_dev_if_add(struct hid_sensor_custom *sensor_inst)
724 {
725 	int ret;
726 
727 	ret = kfifo_alloc(&sensor_inst->data_fifo, HID_CUSTOM_FIFO_SIZE,
728 			  GFP_KERNEL);
729 	if (ret)
730 		return ret;
731 
732 	init_waitqueue_head(&sensor_inst->wait);
733 
734 	sensor_inst->custom_dev.minor = MISC_DYNAMIC_MINOR;
735 	sensor_inst->custom_dev.name = dev_name(&sensor_inst->pdev->dev);
736 	sensor_inst->custom_dev.fops = &hid_sensor_custom_fops,
737 	ret = misc_register(&sensor_inst->custom_dev);
738 	if (ret) {
739 		kfifo_free(&sensor_inst->data_fifo);
740 		return ret;
741 	}
742 	return 0;
743 }
744 
745 static void hid_sensor_custom_dev_if_remove(struct hid_sensor_custom
746 								*sensor_inst)
747 {
748 	wake_up(&sensor_inst->wait);
749 	misc_deregister(&sensor_inst->custom_dev);
750 	kfifo_free(&sensor_inst->data_fifo);
751 
752 }
753 
754 /*
755  * Match a known custom sensor.
756  * tag and luid is mandatory.
757  */
758 struct hid_sensor_custom_match {
759 	const char *tag;
760 	const char *luid;
761 	const char *model;
762 	const char *manufacturer;
763 	bool check_dmi;
764 	struct dmi_system_id dmi;
765 };
766 
767 /*
768  * Custom sensor properties used for matching.
769  */
770 struct hid_sensor_custom_properties {
771 	u16 serial_num[HID_CUSTOM_MAX_FEATURE_BYTES];
772 	u16 model[HID_CUSTOM_MAX_FEATURE_BYTES];
773 	u16 manufacturer[HID_CUSTOM_MAX_FEATURE_BYTES];
774 };
775 
776 static const struct hid_sensor_custom_match hid_sensor_custom_known_table[] = {
777 	/*
778 	 * Intel Integrated Sensor Hub (ISH)
779 	 */
780 	{	/* Intel ISH hinge */
781 		.tag = "INT",
782 		.luid = "020B000000000000",
783 		.manufacturer = "INTEL",
784 	},
785 	/*
786 	 * Lenovo Intelligent Sensing Solution (LISS)
787 	 */
788 	{	/* ambient light */
789 		.tag = "LISS",
790 		.luid = "0041010200000082",
791 		.model = "STK3X3X Sensor",
792 		.manufacturer = "Vendor 258",
793 		.check_dmi = true,
794 		.dmi.matches = {
795 			DMI_MATCH(DMI_SYS_VENDOR, "LENOVO"),
796 		}
797 	},
798 	{	/* human presence */
799 		.tag = "LISS",
800 		.luid = "0226000171AC0081",
801 		.model = "VL53L1_HOD Sensor",
802 		.manufacturer = "ST_MICRO",
803 		.check_dmi = true,
804 		.dmi.matches = {
805 			DMI_MATCH(DMI_SYS_VENDOR, "LENOVO"),
806 		}
807 	},
808 	{}
809 };
810 
811 static bool hid_sensor_custom_prop_match_str(const u16 *prop, const char *match,
812 					     size_t count)
813 {
814 	while (count-- && *prop && *match) {
815 		if (*prop != (u16) *match)
816 			return false;
817 		prop++;
818 		match++;
819 	}
820 
821 	return (count == -1) || *prop == (u16)*match;
822 }
823 
824 static int hid_sensor_custom_get_prop(struct hid_sensor_hub_device *hsdev,
825 				      u32 prop_usage_id, size_t prop_size,
826 				      u16 *prop)
827 {
828 	struct hid_sensor_hub_attribute_info prop_attr = { 0 };
829 	int ret;
830 
831 	memset(prop, 0, prop_size);
832 
833 	ret = sensor_hub_input_get_attribute_info(hsdev, HID_FEATURE_REPORT,
834 						  hsdev->usage, prop_usage_id,
835 						  &prop_attr);
836 	if (ret < 0)
837 		return ret;
838 
839 	ret = sensor_hub_get_feature(hsdev, prop_attr.report_id,
840 				     prop_attr.index, prop_size, prop);
841 	if (ret < 0) {
842 		hid_err(hsdev->hdev, "Failed to get sensor property %08x %d\n",
843 			prop_usage_id, ret);
844 		return ret;
845 	}
846 
847 	return 0;
848 }
849 
850 static bool
851 hid_sensor_custom_do_match(struct hid_sensor_hub_device *hsdev,
852 			   const struct hid_sensor_custom_match *match,
853 			   const struct hid_sensor_custom_properties *prop)
854 {
855 	struct dmi_system_id dmi[] = { match->dmi, { 0 } };
856 
857 	if (!hid_sensor_custom_prop_match_str(prop->serial_num, "LUID:", 5) ||
858 	    !hid_sensor_custom_prop_match_str(prop->serial_num + 5, match->luid,
859 					      HID_CUSTOM_MAX_FEATURE_BYTES - 5))
860 		return false;
861 
862 	if (match->model &&
863 	    !hid_sensor_custom_prop_match_str(prop->model, match->model,
864 					      HID_CUSTOM_MAX_FEATURE_BYTES))
865 		return false;
866 
867 	if (match->manufacturer &&
868 	    !hid_sensor_custom_prop_match_str(prop->manufacturer, match->manufacturer,
869 					      HID_CUSTOM_MAX_FEATURE_BYTES))
870 		return false;
871 
872 	if (match->check_dmi && !dmi_check_system(dmi))
873 		return false;
874 
875 	return true;
876 }
877 
878 static int
879 hid_sensor_custom_properties_get(struct hid_sensor_hub_device *hsdev,
880 				 struct hid_sensor_custom_properties *prop)
881 {
882 	int ret;
883 
884 	ret = hid_sensor_custom_get_prop(hsdev,
885 					 HID_USAGE_SENSOR_PROP_SERIAL_NUM,
886 					 HID_CUSTOM_MAX_FEATURE_BYTES,
887 					 prop->serial_num);
888 	if (ret < 0)
889 		return ret;
890 
891 	/*
892 	 * Ignore errors on the following model and manufacturer properties.
893 	 * Because these are optional, it is not an error if they are missing.
894 	 */
895 
896 	hid_sensor_custom_get_prop(hsdev, HID_USAGE_SENSOR_PROP_MODEL,
897 				   HID_CUSTOM_MAX_FEATURE_BYTES,
898 				   prop->model);
899 
900 	hid_sensor_custom_get_prop(hsdev, HID_USAGE_SENSOR_PROP_MANUFACTURER,
901 				   HID_CUSTOM_MAX_FEATURE_BYTES,
902 				   prop->manufacturer);
903 
904 	return 0;
905 }
906 
907 static int
908 hid_sensor_custom_get_known(struct hid_sensor_hub_device *hsdev,
909 			    const struct hid_sensor_custom_match **known)
910 {
911 	int ret;
912 	const struct hid_sensor_custom_match *match =
913 		hid_sensor_custom_known_table;
914 	struct hid_sensor_custom_properties *prop;
915 
916 	prop = kmalloc(sizeof(struct hid_sensor_custom_properties), GFP_KERNEL);
917 	if (!prop)
918 		return -ENOMEM;
919 
920 	ret = hid_sensor_custom_properties_get(hsdev, prop);
921 	if (ret < 0)
922 		goto out;
923 
924 	while (match->tag) {
925 		if (hid_sensor_custom_do_match(hsdev, match, prop)) {
926 			*known = match;
927 			ret = 0;
928 			goto out;
929 		}
930 		match++;
931 	}
932 	ret = -ENODATA;
933 out:
934 	kfree(prop);
935 	return ret;
936 }
937 
938 static struct platform_device *
939 hid_sensor_register_platform_device(struct platform_device *pdev,
940 				    struct hid_sensor_hub_device *hsdev,
941 				    const struct hid_sensor_custom_match *match)
942 {
943 	char real_usage[HID_SENSOR_USAGE_LENGTH];
944 	struct platform_device *custom_pdev;
945 	const char *dev_name;
946 	char *c;
947 
948 	memcpy(real_usage, match->luid, 4);
949 
950 	/* usage id are all lowcase */
951 	for (c = real_usage; *c != '\0'; c++)
952 		*c = tolower(*c);
953 
954 	/* HID-SENSOR-TAG-REAL_USAGE_ID */
955 	dev_name = kasprintf(GFP_KERNEL, "HID-SENSOR-%s-%s",
956 			     match->tag, real_usage);
957 	if (!dev_name)
958 		return ERR_PTR(-ENOMEM);
959 
960 	custom_pdev = platform_device_register_data(pdev->dev.parent, dev_name,
961 						    PLATFORM_DEVID_AUTO, hsdev,
962 						    sizeof(*hsdev));
963 	kfree(dev_name);
964 	return custom_pdev;
965 }
966 
967 static int hid_sensor_custom_probe(struct platform_device *pdev)
968 {
969 	struct hid_sensor_custom *sensor_inst;
970 	struct hid_sensor_hub_device *hsdev = pdev->dev.platform_data;
971 	int ret;
972 	const struct hid_sensor_custom_match *match;
973 
974 	sensor_inst = devm_kzalloc(&pdev->dev, sizeof(*sensor_inst),
975 				   GFP_KERNEL);
976 	if (!sensor_inst)
977 		return -ENOMEM;
978 
979 	sensor_inst->callbacks.capture_sample = hid_sensor_capture_sample;
980 	sensor_inst->callbacks.send_event = hid_sensor_send_event;
981 	sensor_inst->callbacks.pdev = pdev;
982 	sensor_inst->hsdev = hsdev;
983 	sensor_inst->pdev = pdev;
984 	mutex_init(&sensor_inst->mutex);
985 	platform_set_drvdata(pdev, sensor_inst);
986 
987 	ret = hid_sensor_custom_get_known(hsdev, &match);
988 	if (!ret) {
989 		sensor_inst->custom_pdev =
990 			hid_sensor_register_platform_device(pdev, hsdev, match);
991 
992 		ret = PTR_ERR_OR_ZERO(sensor_inst->custom_pdev);
993 		if (ret) {
994 			dev_err(&pdev->dev,
995 				"register_platform_device failed\n");
996 			return ret;
997 		}
998 
999 		return 0;
1000 	}
1001 
1002 	ret = sensor_hub_register_callback(hsdev, hsdev->usage,
1003 					   &sensor_inst->callbacks);
1004 	if (ret < 0) {
1005 		dev_err(&pdev->dev, "callback reg failed\n");
1006 		return ret;
1007 	}
1008 
1009 	ret = sysfs_create_group(&sensor_inst->pdev->dev.kobj,
1010 				 &enable_sensor_attr_group);
1011 	if (ret)
1012 		goto err_remove_callback;
1013 
1014 	ret = hid_sensor_custom_add_attributes(sensor_inst);
1015 	if (ret)
1016 		goto err_remove_group;
1017 
1018 	ret = hid_sensor_custom_dev_if_add(sensor_inst);
1019 	if (ret)
1020 		goto err_remove_attributes;
1021 
1022 	return 0;
1023 
1024 err_remove_attributes:
1025 	hid_sensor_custom_remove_attributes(sensor_inst);
1026 err_remove_group:
1027 	sysfs_remove_group(&sensor_inst->pdev->dev.kobj,
1028 			   &enable_sensor_attr_group);
1029 err_remove_callback:
1030 	sensor_hub_remove_callback(hsdev, hsdev->usage);
1031 
1032 	return ret;
1033 }
1034 
1035 static int hid_sensor_custom_remove(struct platform_device *pdev)
1036 {
1037 	struct hid_sensor_custom *sensor_inst = platform_get_drvdata(pdev);
1038 	struct hid_sensor_hub_device *hsdev = pdev->dev.platform_data;
1039 
1040 	if (sensor_inst->custom_pdev) {
1041 		platform_device_unregister(sensor_inst->custom_pdev);
1042 		return 0;
1043 	}
1044 
1045 	hid_sensor_custom_dev_if_remove(sensor_inst);
1046 	hid_sensor_custom_remove_attributes(sensor_inst);
1047 	sysfs_remove_group(&sensor_inst->pdev->dev.kobj,
1048 			   &enable_sensor_attr_group);
1049 	sensor_hub_remove_callback(hsdev, hsdev->usage);
1050 
1051 	return 0;
1052 }
1053 
1054 static const struct platform_device_id hid_sensor_custom_ids[] = {
1055 	{
1056 		.name = "HID-SENSOR-2000e1",
1057 	},
1058 	{
1059 		.name = "HID-SENSOR-2000e2",
1060 	},
1061 	{ /* sentinel */ }
1062 };
1063 MODULE_DEVICE_TABLE(platform, hid_sensor_custom_ids);
1064 
1065 static struct platform_driver hid_sensor_custom_platform_driver = {
1066 	.id_table = hid_sensor_custom_ids,
1067 	.driver = {
1068 		.name	= KBUILD_MODNAME,
1069 	},
1070 	.probe		= hid_sensor_custom_probe,
1071 	.remove		= hid_sensor_custom_remove,
1072 };
1073 module_platform_driver(hid_sensor_custom_platform_driver);
1074 
1075 MODULE_DESCRIPTION("HID Sensor Custom and Generic sensor Driver");
1076 MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");
1077 MODULE_LICENSE("GPL");
1078