Browse Source

iio: hid-sensors: Inclinometer 3D: 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>
Srinivas Pandruvada 11 years ago
parent
commit
6fe588e599
1 changed files with 13 additions and 0 deletions
  1. 13 0
      drivers/iio/orientation/hid-sensor-incl-3d.c

+ 13 - 0
drivers/iio/orientation/hid-sensor-incl-3d.c

@@ -22,6 +22,7 @@
 #include <linux/interrupt.h>
 #include <linux/interrupt.h>
 #include <linux/irq.h>
 #include <linux/irq.h>
 #include <linux/slab.h>
 #include <linux/slab.h>
+#include <linux/delay.h>
 #include <linux/hid-sensor-hub.h>
 #include <linux/hid-sensor-hub.h>
 #include <linux/iio/iio.h>
 #include <linux/iio/iio.h>
 #include <linux/iio/sysfs.h>
 #include <linux/iio/sysfs.h>
@@ -110,11 +111,20 @@ static int incl_3d_read_raw(struct iio_dev *indio_dev,
 	int report_id = -1;
 	int report_id = -1;
 	u32 address;
 	u32 address;
 	int ret_type;
 	int ret_type;
+	s32 poll_value;
 
 
 	*val = 0;
 	*val = 0;
 	*val2 = 0;
 	*val2 = 0;
 	switch (mask) {
 	switch (mask) {
 	case IIO_CHAN_INFO_RAW:
 	case IIO_CHAN_INFO_RAW:
+		poll_value = hid_sensor_read_poll_value(
+					&incl_state->common_attributes);
+		if (poll_value < 0)
+			return -EINVAL;
+
+		hid_sensor_power_state(&incl_state->common_attributes, true);
+		msleep_interruptible(poll_value * 2);
+
 		report_id =
 		report_id =
 			incl_state->incl[chan->scan_index].report_id;
 			incl_state->incl[chan->scan_index].report_id;
 		address = incl_3d_addresses[chan->scan_index];
 		address = incl_3d_addresses[chan->scan_index];
@@ -124,8 +134,11 @@ static int incl_3d_read_raw(struct iio_dev *indio_dev,
 				HID_USAGE_SENSOR_INCLINOMETER_3D, address,
 				HID_USAGE_SENSOR_INCLINOMETER_3D, address,
 				report_id);
 				report_id);
 		else {
 		else {
+			hid_sensor_power_state(&incl_state->common_attributes,
+						false);
 			return -EINVAL;
 			return -EINVAL;
 		}
 		}
+		hid_sensor_power_state(&incl_state->common_attributes, false);
 		ret_type = IIO_VAL_INT;
 		ret_type = IIO_VAL_INT;
 		break;
 		break;
 	case IIO_CHAN_INFO_SCALE:
 	case IIO_CHAN_INFO_SCALE: