Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * HID Sensors Driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  * Copyright (c) 2014, Intel Corporation.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/irq.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/hid-sensor-hub.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <linux/iio/iio.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/iio/sysfs.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <linux/iio/buffer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include "../common/hid-sensors/hid-sensor-trigger.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #define CHANNEL_SCAN_INDEX_PRESENCE 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) struct prox_state {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) 	struct hid_sensor_hub_callbacks callbacks;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) 	struct hid_sensor_common common_attributes;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 	struct hid_sensor_hub_attribute_info prox_attr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 	u32 human_presence;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) 	int scale_pre_decml;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 	int scale_post_decml;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 	int scale_precision;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) /* Channel definitions */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) static const struct iio_chan_spec prox_channels[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 	{
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 		.type = IIO_PROXIMITY,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 		.info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 		.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_OFFSET) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 		BIT(IIO_CHAN_INFO_SCALE) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 		BIT(IIO_CHAN_INFO_SAMP_FREQ) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 		BIT(IIO_CHAN_INFO_HYSTERESIS),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 		.scan_index = CHANNEL_SCAN_INDEX_PRESENCE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) /* Adjust channel real bits based on report descriptor */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) static void prox_adjust_channel_bit_mask(struct iio_chan_spec *channels,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 					int channel, int size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	channels[channel].scan_type.sign = 's';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 	/* Real storage bits will change based on the report desc. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 	channels[channel].scan_type.realbits = size * 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	/* Maximum size of a sample to capture is u32 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 	channels[channel].scan_type.storagebits = sizeof(u32) * 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) /* Channel read_raw handler */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) static int prox_read_raw(struct iio_dev *indio_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 			      struct iio_chan_spec const *chan,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 			      int *val, int *val2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 			      long mask)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	struct prox_state *prox_state = iio_priv(indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	int report_id = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 	u32 address;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	int ret_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	s32 min;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	*val = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	*val2 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	switch (mask) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	case IIO_CHAN_INFO_RAW:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 		switch (chan->scan_index) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 		case  CHANNEL_SCAN_INDEX_PRESENCE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 			report_id = prox_state->prox_attr.report_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 			min = prox_state->prox_attr.logical_minimum;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 			address = HID_USAGE_SENSOR_HUMAN_PRESENCE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 		default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 			report_id = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 		if (report_id >= 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 			hid_sensor_power_state(&prox_state->common_attributes,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 						true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 			*val = sensor_hub_input_attr_get_raw_value(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 				prox_state->common_attributes.hsdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 				HID_USAGE_SENSOR_PROX, address,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 				report_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 				SENSOR_HUB_SYNC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 				min < 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 			hid_sensor_power_state(&prox_state->common_attributes,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 						false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 			*val = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 			return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 		ret_type = IIO_VAL_INT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	case IIO_CHAN_INFO_SCALE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 		*val = prox_state->scale_pre_decml;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 		*val2 = prox_state->scale_post_decml;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 		ret_type = prox_state->scale_precision;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 	case IIO_CHAN_INFO_OFFSET:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 		*val = hid_sensor_convert_exponent(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 				prox_state->prox_attr.unit_expo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 		ret_type = IIO_VAL_INT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	case IIO_CHAN_INFO_SAMP_FREQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 		ret_type = hid_sensor_read_samp_freq_value(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 				&prox_state->common_attributes, val, val2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	case IIO_CHAN_INFO_HYSTERESIS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 		ret_type = hid_sensor_read_raw_hyst_value(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 				&prox_state->common_attributes, val, val2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 		ret_type = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 	return ret_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) /* Channel write_raw handler */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) static int prox_write_raw(struct iio_dev *indio_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 			       struct iio_chan_spec const *chan,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 			       int val,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 			       int val2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 			       long mask)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 	struct prox_state *prox_state = iio_priv(indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 	int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	switch (mask) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	case IIO_CHAN_INFO_SAMP_FREQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 		ret = hid_sensor_write_samp_freq_value(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 				&prox_state->common_attributes, val, val2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 	case IIO_CHAN_INFO_HYSTERESIS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 		ret = hid_sensor_write_raw_hyst_value(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 				&prox_state->common_attributes, val, val2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 		ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) static const struct iio_info prox_info = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 	.read_raw = &prox_read_raw,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	.write_raw = &prox_write_raw,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) /* Function to push data to buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) static void hid_sensor_push_data(struct iio_dev *indio_dev, const void *data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 					int len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 	dev_dbg(&indio_dev->dev, "hid_sensor_push_data\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	iio_push_to_buffers(indio_dev, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) /* Callback handler to send event after all samples are received and captured */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) static int prox_proc_event(struct hid_sensor_hub_device *hsdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 				unsigned usage_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 				void *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 	struct iio_dev *indio_dev = platform_get_drvdata(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	struct prox_state *prox_state = iio_priv(indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 	dev_dbg(&indio_dev->dev, "prox_proc_event\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	if (atomic_read(&prox_state->common_attributes.data_ready))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 		hid_sensor_push_data(indio_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 				&prox_state->human_presence,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 				sizeof(prox_state->human_presence));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) /* Capture samples in local storage */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) static int prox_capture_sample(struct hid_sensor_hub_device *hsdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 				unsigned usage_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 				size_t raw_len, char *raw_data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 				void *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	struct iio_dev *indio_dev = platform_get_drvdata(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	struct prox_state *prox_state = iio_priv(indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 	int ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 	switch (usage_id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	case HID_USAGE_SENSOR_HUMAN_PRESENCE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 		prox_state->human_presence = *(u32 *)raw_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 		ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) /* Parse report which is specific to an usage id*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) static int prox_parse_report(struct platform_device *pdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 				struct hid_sensor_hub_device *hsdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 				struct iio_chan_spec *channels,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 				unsigned usage_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 				struct prox_state *st)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 	ret = sensor_hub_input_get_attribute_info(hsdev, HID_INPUT_REPORT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 			usage_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 			HID_USAGE_SENSOR_HUMAN_PRESENCE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 			&st->prox_attr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 	if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 	prox_adjust_channel_bit_mask(channels, CHANNEL_SCAN_INDEX_PRESENCE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 					st->prox_attr.size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 	dev_dbg(&pdev->dev, "prox %x:%x\n", st->prox_attr.index,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 			st->prox_attr.report_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 	/* Set Sensitivity field ids, when there is no individual modifier */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 	if (st->common_attributes.sensitivity.index < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 		sensor_hub_input_get_attribute_info(hsdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 			HID_FEATURE_REPORT, usage_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 			HID_USAGE_SENSOR_DATA_MOD_CHANGE_SENSITIVITY_ABS |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 			HID_USAGE_SENSOR_DATA_PRESENCE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 			&st->common_attributes.sensitivity);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 		dev_dbg(&pdev->dev, "Sensitivity index:report %d:%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 			st->common_attributes.sensitivity.index,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 			st->common_attributes.sensitivity.report_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 	if (st->common_attributes.sensitivity.index < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 		sensor_hub_input_get_attribute_info(hsdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 			HID_FEATURE_REPORT, usage_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 			HID_USAGE_SENSOR_DATA_MOD_CHANGE_SENSITIVITY_ABS |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 			HID_USAGE_SENSOR_HUMAN_PRESENCE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 			&st->common_attributes.sensitivity);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 	st->scale_precision = hid_sensor_format_scale(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 				hsdev->usage,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 				&st->prox_attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 				&st->scale_pre_decml, &st->scale_post_decml);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) /* Function to initialize the processing for usage id */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) static int hid_prox_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 	int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 	static const char *name = "prox";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 	struct iio_dev *indio_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 	struct prox_state *prox_state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 	struct hid_sensor_hub_device *hsdev = pdev->dev.platform_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 	indio_dev = devm_iio_device_alloc(&pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 				sizeof(struct prox_state));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 	if (!indio_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 	platform_set_drvdata(pdev, indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 	prox_state = iio_priv(indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 	prox_state->common_attributes.hsdev = hsdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 	prox_state->common_attributes.pdev = pdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 	ret = hid_sensor_parse_common_attributes(hsdev, HID_USAGE_SENSOR_PROX,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 					&prox_state->common_attributes);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 		dev_err(&pdev->dev, "failed to setup common attributes\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 	indio_dev->channels = kmemdup(prox_channels, sizeof(prox_channels),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 				      GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 	if (!indio_dev->channels) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 		dev_err(&pdev->dev, "failed to duplicate channels\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 	ret = prox_parse_report(pdev, hsdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 				(struct iio_chan_spec *)indio_dev->channels,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 				HID_USAGE_SENSOR_PROX, prox_state);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 		dev_err(&pdev->dev, "failed to setup attributes\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 		goto error_free_dev_mem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 	indio_dev->num_channels = ARRAY_SIZE(prox_channels);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 	indio_dev->info = &prox_info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 	indio_dev->name = name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 	indio_dev->modes = INDIO_DIRECT_MODE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 	atomic_set(&prox_state->common_attributes.data_ready, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 	ret = hid_sensor_setup_trigger(indio_dev, name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 				&prox_state->common_attributes);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 		dev_err(&pdev->dev, "trigger setup failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 		goto error_free_dev_mem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 	ret = iio_device_register(indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 		dev_err(&pdev->dev, "device register failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 		goto error_remove_trigger;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 	prox_state->callbacks.send_event = prox_proc_event;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 	prox_state->callbacks.capture_sample = prox_capture_sample;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 	prox_state->callbacks.pdev = pdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 	ret = sensor_hub_register_callback(hsdev, HID_USAGE_SENSOR_PROX,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 					&prox_state->callbacks);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 	if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 		dev_err(&pdev->dev, "callback reg failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 		goto error_iio_unreg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) error_iio_unreg:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 	iio_device_unregister(indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) error_remove_trigger:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 	hid_sensor_remove_trigger(indio_dev, &prox_state->common_attributes);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) error_free_dev_mem:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 	kfree(indio_dev->channels);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) /* Function to deinitialize the processing for usage id */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) static int hid_prox_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 	struct hid_sensor_hub_device *hsdev = pdev->dev.platform_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) 	struct iio_dev *indio_dev = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 	struct prox_state *prox_state = iio_priv(indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 	sensor_hub_remove_callback(hsdev, HID_USAGE_SENSOR_PROX);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 	iio_device_unregister(indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 	hid_sensor_remove_trigger(indio_dev, &prox_state->common_attributes);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 	kfree(indio_dev->channels);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) static const struct platform_device_id hid_prox_ids[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) 	{
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 		/* Format: HID-SENSOR-usage_id_in_hex_lowercase */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 		.name = "HID-SENSOR-200011",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 	{ /* sentinel */ }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) MODULE_DEVICE_TABLE(platform, hid_prox_ids);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) static struct platform_driver hid_prox_platform_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 	.id_table = hid_prox_ids,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 	.driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 		.name	= KBUILD_MODNAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 		.pm	= &hid_sensor_pm_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 	.probe		= hid_prox_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 	.remove		= hid_prox_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) module_platform_driver(hid_prox_platform_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) MODULE_DESCRIPTION("HID Sensor Proximity");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) MODULE_AUTHOR("Archana Patni <archana.patni@intel.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) MODULE_LICENSE("GPL");