iio: hid-sensors: Proximity: Raw read support

Added support for raw reading of channel. If the sensor is powered
off, it will turn on for reading value.

Signed-off-by: Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>
Signed-off-by: Jonathan Cameron <jic23@kernel.org>

diff --git a/drivers/iio/light/hid-sensor-prox.c b/drivers/iio/light/hid-sensor-prox.c
index 07e98ec8e9f1c1d5ec040f940583e826e99f6628..d203ef4d892f26acd72992cd46a0dbeea7048944 100644 (file)
--- a/drivers/iio/light/hid-sensor-prox.c
+++ b/drivers/iio/light/hid-sensor-prox.c
@@ -21,6 +21,7 @@
 #include <linux/interrupt.h>
 #include <linux/irq.h>
 #include <linux/slab.h>
+#include <linux/delay.h>
 #include <linux/hid-sensor-hub.h>
 #include <linux/iio/iio.h>
 #include <linux/iio/sysfs.h>
@@ -75,6 +76,7 @@ static int prox_read_raw(struct iio_dev *indio_dev,
        u32 address;
        int ret;
        int ret_type;
+       s32 poll_value;
 
        *val = 0;
        *val2 = 0;
@@ -90,12 +92,24 @@ static int prox_read_raw(struct iio_dev *indio_dev,
                        report_id = -1;
                        break;
                }
-               if (report_id >= 0)
+               if (report_id >= 0) {
+                       poll_value = hid_sensor_read_poll_value(
+                                       &prox_state->common_attributes);
+                       if (poll_value < 0)
+                               return -EINVAL;
+
+                       hid_sensor_power_state(&prox_state->common_attributes,
+                                               true);
+
+                       msleep_interruptible(poll_value * 2);
+
                        *val = sensor_hub_input_attr_get_raw_value(
                                prox_state->common_attributes.hsdev,
                                HID_USAGE_SENSOR_PROX, address,
                                report_id);
-               else {
+                       hid_sensor_power_state(&prox_state->common_attributes,
+                                               false);
+               } else {
                        *val = 0;
                        return -EINVAL;
                }