diff options
author | Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com> | 2014-04-18 19:22:00 -0400 |
---|---|---|
committer | Jonathan Cameron <jic23@kernel.org> | 2014-05-05 05:59:45 -0400 |
commit | 73a24988201f1bc82143ad183c79206052ef2fe8 (patch) | |
tree | 67c5ce92d486668a71f9c3e8a11f1fc4462d744e /drivers/iio/accel/hid-sensor-accel-3d.c | |
parent | 9030924510a9e7d4b7d218749533840075879f2f (diff) |
iio: hid-sensors: Accelerometer 3D: adjust scale and offset
Using units and unit exponent to calculate scale which is compliant
to IIO ABI.
Signed-off-by: Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>
Signed-off-by: Jonathan Cameron <jic23@kernel.org>
Diffstat (limited to 'drivers/iio/accel/hid-sensor-accel-3d.c')
-rw-r--r-- | drivers/iio/accel/hid-sensor-accel-3d.c | 17 |
1 files changed, 13 insertions, 4 deletions
diff --git a/drivers/iio/accel/hid-sensor-accel-3d.c b/drivers/iio/accel/hid-sensor-accel-3d.c index 3dcdbad65456..ca50a91752d8 100644 --- a/drivers/iio/accel/hid-sensor-accel-3d.c +++ b/drivers/iio/accel/hid-sensor-accel-3d.c | |||
@@ -42,6 +42,10 @@ struct accel_3d_state { | |||
42 | struct hid_sensor_common common_attributes; | 42 | struct hid_sensor_common common_attributes; |
43 | struct hid_sensor_hub_attribute_info accel[ACCEL_3D_CHANNEL_MAX]; | 43 | struct hid_sensor_hub_attribute_info accel[ACCEL_3D_CHANNEL_MAX]; |
44 | u32 accel_val[ACCEL_3D_CHANNEL_MAX]; | 44 | u32 accel_val[ACCEL_3D_CHANNEL_MAX]; |
45 | int scale_pre_decml; | ||
46 | int scale_post_decml; | ||
47 | int scale_precision; | ||
48 | int value_offset; | ||
45 | }; | 49 | }; |
46 | 50 | ||
47 | static const u32 accel_3d_addresses[ACCEL_3D_CHANNEL_MAX] = { | 51 | static const u32 accel_3d_addresses[ACCEL_3D_CHANNEL_MAX] = { |
@@ -123,12 +127,12 @@ static int accel_3d_read_raw(struct iio_dev *indio_dev, | |||
123 | ret_type = IIO_VAL_INT; | 127 | ret_type = IIO_VAL_INT; |
124 | break; | 128 | break; |
125 | case IIO_CHAN_INFO_SCALE: | 129 | case IIO_CHAN_INFO_SCALE: |
126 | *val = accel_state->accel[CHANNEL_SCAN_INDEX_X].units; | 130 | *val = accel_state->scale_pre_decml; |
127 | ret_type = IIO_VAL_INT; | 131 | *val2 = accel_state->scale_post_decml; |
132 | ret_type = accel_state->scale_precision; | ||
128 | break; | 133 | break; |
129 | case IIO_CHAN_INFO_OFFSET: | 134 | case IIO_CHAN_INFO_OFFSET: |
130 | *val = hid_sensor_convert_exponent( | 135 | *val = accel_state->value_offset; |
131 | accel_state->accel[CHANNEL_SCAN_INDEX_X].unit_expo); | ||
132 | ret_type = IIO_VAL_INT; | 136 | ret_type = IIO_VAL_INT; |
133 | break; | 137 | break; |
134 | case IIO_CHAN_INFO_SAMP_FREQ: | 138 | case IIO_CHAN_INFO_SAMP_FREQ: |
@@ -262,6 +266,11 @@ static int accel_3d_parse_report(struct platform_device *pdev, | |||
262 | st->accel[1].index, st->accel[1].report_id, | 266 | st->accel[1].index, st->accel[1].report_id, |
263 | st->accel[2].index, st->accel[2].report_id); | 267 | st->accel[2].index, st->accel[2].report_id); |
264 | 268 | ||
269 | st->scale_precision = hid_sensor_format_scale( | ||
270 | HID_USAGE_SENSOR_ACCEL_3D, | ||
271 | &st->accel[CHANNEL_SCAN_INDEX_X], | ||
272 | &st->scale_pre_decml, &st->scale_post_decml); | ||
273 | |||
265 | /* Set Sensitivity field ids, when there is no individual modifier */ | 274 | /* Set Sensitivity field ids, when there is no individual modifier */ |
266 | if (st->common_attributes.sensitivity.index < 0) { | 275 | if (st->common_attributes.sensitivity.index < 0) { |
267 | sensor_hub_input_get_attribute_info(hsdev, | 276 | sensor_hub_input_get_attribute_info(hsdev, |