Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 2acbe15f authored by Adriana Reus's avatar Adriana Reus Committed by Jonathan Cameron
Browse files

iio: inv-mpu: Specify the expected format/precision for write channels 



The gyroscope needs IIO_VAL_INT_PLUS_NANO for the scale channel and
unless specified write returns MICRO by default.
This needs to be properly specified so that write operations into scale
have the expected behaviour.

Signed-off-by: default avatarAdriana Reus <adriana.reus@intel.com>
Cc: <Stable@vger.kernel.org>
Signed-off-by: default avatarJonathan Cameron <jic23@kernel.org>
parent b220da65

drivers/iio/imu/inv_mpu6050/inv_mpu_core.c

+18 −0
Original line number Diff line number Diff line
@@ -431,6 +431,23 @@ static int inv_mpu6050_write_gyro_scale(struct inv_mpu6050_state *st, int val) 
	return -EINVAL;

}



static int inv_write_raw_get_fmt(struct iio_dev *indio_dev,

				 struct iio_chan_spec const *chan, long mask)

{

	switch (mask) {

	case IIO_CHAN_INFO_SCALE:

		switch (chan->type) {

		case IIO_ANGL_VEL:

			return IIO_VAL_INT_PLUS_NANO;

		default:

			return IIO_VAL_INT_PLUS_MICRO;

		}

	default:

		return IIO_VAL_INT_PLUS_MICRO;

	}



	return -EINVAL;

}

static int inv_mpu6050_write_accel_scale(struct inv_mpu6050_state *st, int val)

{

	int result, i;
@@ -696,6 +713,7 @@ static const struct iio_info mpu_info = { 
	.driver_module = THIS_MODULE,

	.read_raw = &inv_mpu6050_read_raw,

	.write_raw = &inv_mpu6050_write_raw,

	.write_raw_get_fmt = &inv_write_raw_get_fmt,

	.attrs = &inv_attribute_group,

	.validate_trigger = inv_mpu6050_validate_trigger,

};