Commit 84e2f6f9 authored by Linus Walleij's avatar Linus Walleij Committed by Jonathan Cameron

iio: accel: kxsd9: Fix up offset and scaling

This fixes several errors in the offset and scaling of the raw
values from the KXSD9 sensor:

- The code did not convert the big endian value from the sensor
  into the endianness of the host CPU. Fix this with
  be16_to_cpu() on the raw obtained value.

- The code did not regard the fact that only the upper 12 bits of
  the accelerometer values are valid. Shift these
  down four bits to yield the real raw value.

- Further the sensor provides 2048 at zero g. This means that an
  offset of 2048 must be subtracted from the raw value before
  scaling. This was not taken into account by the driver,
  yielding a weird value. Fix this by providing this offset in
  sysfs.

To house the scaling code better, the value reading code was
factored into the raw reading function.

This proper scaling and offseting is necessary to get proper
values out of triggered buffer by offsetting, shifting and scaling
them.
Signed-off-by: default avatarLinus Walleij <linus.walleij@linaro.org>
Tested-by: default avatarJonathan Cameron <jic23@kernel.org>
Signed-off-by: default avatarJonathan Cameron <jic23@kernel.org>
parent dc6ac050
...@@ -55,6 +55,8 @@ struct kxsd9_state { ...@@ -55,6 +55,8 @@ struct kxsd9_state {
/* reverse order */ /* reverse order */
static const int kxsd9_micro_scales[4] = { 47853, 35934, 23927, 11978 }; static const int kxsd9_micro_scales[4] = { 47853, 35934, 23927, 11978 };
#define KXSD9_ZERO_G_OFFSET -2048
static int kxsd9_write_scale(struct iio_dev *indio_dev, int micro) static int kxsd9_write_scale(struct iio_dev *indio_dev, int micro)
{ {
int ret, i; int ret, i;
...@@ -82,19 +84,6 @@ static int kxsd9_write_scale(struct iio_dev *indio_dev, int micro) ...@@ -82,19 +84,6 @@ static int kxsd9_write_scale(struct iio_dev *indio_dev, int micro)
return ret; return ret;
} }
static int kxsd9_read(struct iio_dev *indio_dev, u8 address)
{
int ret;
struct kxsd9_state *st = iio_priv(indio_dev);
__be16 raw_val;
ret = regmap_bulk_read(st->map, address, &raw_val, sizeof(raw_val));
if (ret)
return ret;
/* Only 12 bits are valid */
return be16_to_cpu(raw_val) & 0xfff0;
}
static IIO_CONST_ATTR(accel_scale_available, static IIO_CONST_ATTR(accel_scale_available,
KXSD9_SCALE_2G " " KXSD9_SCALE_2G " "
KXSD9_SCALE_4G " " KXSD9_SCALE_4G " "
...@@ -131,13 +120,24 @@ static int kxsd9_read_raw(struct iio_dev *indio_dev, ...@@ -131,13 +120,24 @@ static int kxsd9_read_raw(struct iio_dev *indio_dev,
int ret = -EINVAL; int ret = -EINVAL;
struct kxsd9_state *st = iio_priv(indio_dev); struct kxsd9_state *st = iio_priv(indio_dev);
unsigned int regval; unsigned int regval;
__be16 raw_val;
u16 nval;
switch (mask) { switch (mask) {
case IIO_CHAN_INFO_RAW: case IIO_CHAN_INFO_RAW:
ret = kxsd9_read(indio_dev, chan->address); ret = regmap_bulk_read(st->map, chan->address, &raw_val,
if (ret < 0) sizeof(raw_val));
if (ret)
goto error_ret; goto error_ret;
*val = ret; nval = be16_to_cpu(raw_val);
/* Only 12 bits are valid */
nval >>= 4;
*val = nval;
ret = IIO_VAL_INT;
break;
case IIO_CHAN_INFO_OFFSET:
/* This has a bias of -2048 */
*val = KXSD9_ZERO_G_OFFSET;
ret = IIO_VAL_INT; ret = IIO_VAL_INT;
break; break;
case IIO_CHAN_INFO_SCALE: case IIO_CHAN_INFO_SCALE:
...@@ -161,7 +161,8 @@ static int kxsd9_read_raw(struct iio_dev *indio_dev, ...@@ -161,7 +161,8 @@ static int kxsd9_read_raw(struct iio_dev *indio_dev,
.modified = 1, \ .modified = 1, \
.channel2 = IIO_MOD_##axis, \ .channel2 = IIO_MOD_##axis, \
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \ .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
.info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), \ .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \
BIT(IIO_CHAN_INFO_OFFSET), \
.address = KXSD9_REG_##axis, \ .address = KXSD9_REG_##axis, \
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment