diff mbox series

iio: inv_mpu6050: Fully validate gyro and accel scale writes

Message ID 20210405114441.24167-1-lars@metafoo.de (mailing list archive)
State New, archived
Headers show
Series iio: inv_mpu6050: Fully validate gyro and accel scale writes | expand

Commit Message

Lars-Peter Clausen April 5, 2021, 11:44 a.m. UTC
When setting the gyro or accelerometer scale the inv_mpu6050 driver ignores
the integer part of the value. As a result e.g. all of 0.13309, 1.13309,
12345.13309, ... are accepted as a valid gyro scale and 0.13309 is the
scale that gets set in all those cases.

Make sure to check that the integer part of the scale value is 0 and reject
it otherwise.

Fixes: 09a642b78523 ("Invensense MPU6050 Device Driver.")
Signed-off-by: Lars-Peter Clausen <lars@metafoo.de>
---
 drivers/iio/imu/inv_mpu6050/inv_mpu_core.c | 20 ++++++++++++++------
 1 file changed, 14 insertions(+), 6 deletions(-)

Comments

Jonathan Cameron April 5, 2021, 2:55 p.m. UTC | #1
On Mon,  5 Apr 2021 13:44:41 +0200
Lars-Peter Clausen <lars@metafoo.de> wrote:

> When setting the gyro or accelerometer scale the inv_mpu6050 driver ignores
> the integer part of the value. As a result e.g. all of 0.13309, 1.13309,
> 12345.13309, ... are accepted as a valid gyro scale and 0.13309 is the
> scale that gets set in all those cases.
> 
> Make sure to check that the integer part of the scale value is 0 and reject
> it otherwise.
> 
> Fixes: 09a642b78523 ("Invensense MPU6050 Device Driver.")
> Signed-off-by: Lars-Peter Clausen <lars@metafoo.de>
Looks like this is in the 'obviously' correct category to me but
will leave it on list to give Jean-Baptiste a chance to look at it.

As ever, give me a poke if I seem to have lost it down the back of the
sofa in a few weeks time.

Thanks

Jonathan

> ---
>  drivers/iio/imu/inv_mpu6050/inv_mpu_core.c | 20 ++++++++++++++------
>  1 file changed, 14 insertions(+), 6 deletions(-)
> 
> diff --git a/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c b/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c
> index 453c51c79655..69ab94ab7297 100644
> --- a/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c
> +++ b/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c
> @@ -731,12 +731,16 @@ inv_mpu6050_read_raw(struct iio_dev *indio_dev,
>  	}
>  }
>  
> -static int inv_mpu6050_write_gyro_scale(struct inv_mpu6050_state *st, int val)
> +static int inv_mpu6050_write_gyro_scale(struct inv_mpu6050_state *st, int val,
> +					int val2)
>  {
>  	int result, i;
>  
> +	if (val != 0)
> +		return -EINVAL;
> +
>  	for (i = 0; i < ARRAY_SIZE(gyro_scale_6050); ++i) {
> -		if (gyro_scale_6050[i] == val) {
> +		if (gyro_scale_6050[i] == val2) {
>  			result = inv_mpu6050_set_gyro_fsr(st, i);
>  			if (result)
>  				return result;
> @@ -767,13 +771,17 @@ static int inv_write_raw_get_fmt(struct iio_dev *indio_dev,
>  	return -EINVAL;
>  }
>  
> -static int inv_mpu6050_write_accel_scale(struct inv_mpu6050_state *st, int val)
> +static int inv_mpu6050_write_accel_scale(struct inv_mpu6050_state *st, int val,
> +					 int val2)
>  {
>  	int result, i;
>  	u8 d;
>  
> +	if (val != 0)
> +		return -EINVAL;
> +
>  	for (i = 0; i < ARRAY_SIZE(accel_scale); ++i) {
> -		if (accel_scale[i] == val) {
> +		if (accel_scale[i] == val2) {
>  			d = (i << INV_MPU6050_ACCL_CONFIG_FSR_SHIFT);
>  			result = regmap_write(st->map, st->reg->accl_config, d);
>  			if (result)
> @@ -814,10 +822,10 @@ static int inv_mpu6050_write_raw(struct iio_dev *indio_dev,
>  	case IIO_CHAN_INFO_SCALE:
>  		switch (chan->type) {
>  		case IIO_ANGL_VEL:
> -			result = inv_mpu6050_write_gyro_scale(st, val2);
> +			result = inv_mpu6050_write_gyro_scale(st, val, val2);
>  			break;
>  		case IIO_ACCEL:
> -			result = inv_mpu6050_write_accel_scale(st, val2);
> +			result = inv_mpu6050_write_accel_scale(st, val, val2);
>  			break;
>  		default:
>  			result = -EINVAL;
Jean-Baptiste Maneyrol April 6, 2021, 7:51 a.m. UTC | #2
Hi Jonathan, Lars-Peter,

thanks for letting me having a look. This is effectively as obvious as it looks.
Never think of testing that, thanks for the patch.

Acked-by: Jean-Baptiste Maneyrol <jmaneyrol@invensense.com>

Thanks,
JB

From: Jonathan Cameron <jic23@kernel.org>
Sent: Monday, April 5, 2021 16:55
To: Lars-Peter Clausen <lars@metafoo.de>
Cc: Jean-Baptiste Maneyrol <JManeyrol@invensense.com>; linux-iio@vger.kernel.org <linux-iio@vger.kernel.org>
Subject: Re: [PATCH] iio: inv_mpu6050: Fully validate gyro and accel scale writes 
 
 CAUTION: This email originated from outside of the organization. Please make sure the sender is who they say they are and do not click links or open attachments unless you recognize the sender and know the content is safe.

On Mon,  5 Apr 2021 13:44:41 +0200
Lars-Peter Clausen <lars@metafoo.de> wrote:

> When setting the gyro or accelerometer scale the inv_mpu6050 driver ignores
> the integer part of the value. As a result e.g. all of 0.13309, 1.13309,
> 12345.13309, ... are accepted as a valid gyro scale and 0.13309 is the
> scale that gets set in all those cases.
> 
> Make sure to check that the integer part of the scale value is 0 and reject
> it otherwise.
> 
> Fixes: 09a642b78523 ("Invensense MPU6050 Device Driver.")
> Signed-off-by: Lars-Peter Clausen <lars@metafoo.de>
Looks like this is in the 'obviously' correct category to me but
will leave it on list to give Jean-Baptiste a chance to look at it.

As ever, give me a poke if I seem to have lost it down the back of the
sofa in a few weeks time.

Thanks

Jonathan

> ---
>  drivers/iio/imu/inv_mpu6050/inv_mpu_core.c | 20 ++++++++++++++------
>  1 file changed, 14 insertions(+), 6 deletions(-)
> 
> diff --git a/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c b/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c
> index 453c51c79655..69ab94ab7297 100644
> --- a/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c
> +++ b/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c
> @@ -731,12 +731,16 @@ inv_mpu6050_read_raw(struct iio_dev *indio_dev,
>        }
>  }

> -static int inv_mpu6050_write_gyro_scale(struct inv_mpu6050_state *st, int val)
> +static int inv_mpu6050_write_gyro_scale(struct inv_mpu6050_state *st, int val,
> +                                     int val2)
>  {
>        int result, i;

> +     if (val != 0)
> +             return -EINVAL;
> +
>        for (i = 0; i < ARRAY_SIZE(gyro_scale_6050); ++i) {
> -             if (gyro_scale_6050[i] == val) {
> +             if (gyro_scale_6050[i] == val2) {
>                        result = inv_mpu6050_set_gyro_fsr(st, i);
>                        if (result)
>                                return result;
> @@ -767,13 +771,17 @@ static int inv_write_raw_get_fmt(struct iio_dev *indio_dev,
>        return -EINVAL;
>  }

> -static int inv_mpu6050_write_accel_scale(struct inv_mpu6050_state *st, int val)
> +static int inv_mpu6050_write_accel_scale(struct inv_mpu6050_state *st, int val,
> +                                      int val2)
>  {
>        int result, i;
>        u8 d;

> +     if (val != 0)
> +             return -EINVAL;
> +
>        for (i = 0; i < ARRAY_SIZE(accel_scale); ++i) {
> -             if (accel_scale[i] == val) {
> +             if (accel_scale[i] == val2) {
>                        d = (i << INV_MPU6050_ACCL_CONFIG_FSR_SHIFT);
>                        result = regmap_write(st->map, st->reg->accl_config, d);
>                        if (result)
> @@ -814,10 +822,10 @@ static int inv_mpu6050_write_raw(struct iio_dev *indio_dev,
>        case IIO_CHAN_INFO_SCALE:
>                switch (chan->type) {
>                case IIO_ANGL_VEL:
> -                     result = inv_mpu6050_write_gyro_scale(st, val2);
> +                     result = inv_mpu6050_write_gyro_scale(st, val, val2);
>                        break;
>                case IIO_ACCEL:
> -                     result = inv_mpu6050_write_accel_scale(st, val2);
> +                     result = inv_mpu6050_write_accel_scale(st, val, val2);
>                        break;
>                default:
>                        result = -EINVAL;
Jonathan Cameron April 6, 2021, 8:37 a.m. UTC | #3
On Tue, 6 Apr 2021 07:51:05 +0000
Jean-Baptiste Maneyrol <JManeyrol@invensense.com> wrote:

> Hi Jonathan, Lars-Peter,
> 
> thanks for letting me having a look. This is effectively as obvious as it looks.
> Never think of testing that, thanks for the patch.
> 
> Acked-by: Jean-Baptiste Maneyrol <jmaneyrol@invensense.com>

Applied to the togreg branch of iio.git and marked for stable.

Thanks,

Jonathan

> 
> Thanks,
> JB
> 
> From: Jonathan Cameron <jic23@kernel.org>
> Sent: Monday, April 5, 2021 16:55
> To: Lars-Peter Clausen <lars@metafoo.de>
> Cc: Jean-Baptiste Maneyrol <JManeyrol@invensense.com>; linux-iio@vger.kernel.org <linux-iio@vger.kernel.org>
> Subject: Re: [PATCH] iio: inv_mpu6050: Fully validate gyro and accel scale writes 
>  
>  CAUTION: This email originated from outside of the organization. Please make sure the sender is who they say they are and do not click links or open attachments unless you recognize the sender and know the content is safe.
> 
> On Mon,  5 Apr 2021 13:44:41 +0200
> Lars-Peter Clausen <lars@metafoo.de> wrote:
> 
> > When setting the gyro or accelerometer scale the inv_mpu6050 driver ignores
> > the integer part of the value. As a result e.g. all of 0.13309, 1.13309,
> > 12345.13309, ... are accepted as a valid gyro scale and 0.13309 is the
> > scale that gets set in all those cases.
> > 
> > Make sure to check that the integer part of the scale value is 0 and reject
> > it otherwise.
> > 
> > Fixes: 09a642b78523 ("Invensense MPU6050 Device Driver.")
> > Signed-off-by: Lars-Peter Clausen <lars@metafoo.de>  
> Looks like this is in the 'obviously' correct category to me but
> will leave it on list to give Jean-Baptiste a chance to look at it.
> 
> As ever, give me a poke if I seem to have lost it down the back of the
> sofa in a few weeks time.
> 
> Thanks
> 
> Jonathan
> 
> > ---
> >  drivers/iio/imu/inv_mpu6050/inv_mpu_core.c | 20 ++++++++++++++------
> >  1 file changed, 14 insertions(+), 6 deletions(-)
> > 
> > diff --git a/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c b/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c
> > index 453c51c79655..69ab94ab7297 100644
> > --- a/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c
> > +++ b/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c
> > @@ -731,12 +731,16 @@ inv_mpu6050_read_raw(struct iio_dev *indio_dev,
> >        }
> >  }
> >  
> > -static int inv_mpu6050_write_gyro_scale(struct inv_mpu6050_state *st, int val)
> > +static int inv_mpu6050_write_gyro_scale(struct inv_mpu6050_state *st, int val,
> > +                                     int val2)
> >  {
> >        int result, i;
> >  
> > +     if (val != 0)
> > +             return -EINVAL;
> > +
> >        for (i = 0; i < ARRAY_SIZE(gyro_scale_6050); ++i) {
> > -             if (gyro_scale_6050[i] == val) {
> > +             if (gyro_scale_6050[i] == val2) {
> >                        result = inv_mpu6050_set_gyro_fsr(st, i);
> >                        if (result)
> >                                return result;
> > @@ -767,13 +771,17 @@ static int inv_write_raw_get_fmt(struct iio_dev *indio_dev,
> >        return -EINVAL;
> >  }
> >  
> > -static int inv_mpu6050_write_accel_scale(struct inv_mpu6050_state *st, int val)
> > +static int inv_mpu6050_write_accel_scale(struct inv_mpu6050_state *st, int val,
> > +                                      int val2)
> >  {
> >        int result, i;
> >        u8 d;
> >  
> > +     if (val != 0)
> > +             return -EINVAL;
> > +
> >        for (i = 0; i < ARRAY_SIZE(accel_scale); ++i) {
> > -             if (accel_scale[i] == val) {
> > +             if (accel_scale[i] == val2) {
> >                        d = (i << INV_MPU6050_ACCL_CONFIG_FSR_SHIFT);
> >                        result = regmap_write(st->map, st->reg->accl_config, d);
> >                        if (result)
> > @@ -814,10 +822,10 @@ static int inv_mpu6050_write_raw(struct iio_dev *indio_dev,
> >        case IIO_CHAN_INFO_SCALE:
> >                switch (chan->type) {
> >                case IIO_ANGL_VEL:
> > -                     result = inv_mpu6050_write_gyro_scale(st, val2);
> > +                     result = inv_mpu6050_write_gyro_scale(st, val, val2);
> >                        break;
> >                case IIO_ACCEL:
> > -                     result = inv_mpu6050_write_accel_scale(st, val2);
> > +                     result = inv_mpu6050_write_accel_scale(st, val, val2);
> >                        break;
> >                default:
> >                        result = -EINVAL;
diff mbox series

Patch

diff --git a/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c b/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c
index 453c51c79655..69ab94ab7297 100644
--- a/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c
+++ b/drivers/iio/imu/inv_mpu6050/inv_mpu_core.c
@@ -731,12 +731,16 @@  inv_mpu6050_read_raw(struct iio_dev *indio_dev,
 	}
 }
 
-static int inv_mpu6050_write_gyro_scale(struct inv_mpu6050_state *st, int val)
+static int inv_mpu6050_write_gyro_scale(struct inv_mpu6050_state *st, int val,
+					int val2)
 {
 	int result, i;
 
+	if (val != 0)
+		return -EINVAL;
+
 	for (i = 0; i < ARRAY_SIZE(gyro_scale_6050); ++i) {
-		if (gyro_scale_6050[i] == val) {
+		if (gyro_scale_6050[i] == val2) {
 			result = inv_mpu6050_set_gyro_fsr(st, i);
 			if (result)
 				return result;
@@ -767,13 +771,17 @@  static int inv_write_raw_get_fmt(struct iio_dev *indio_dev,
 	return -EINVAL;
 }
 
-static int inv_mpu6050_write_accel_scale(struct inv_mpu6050_state *st, int val)
+static int inv_mpu6050_write_accel_scale(struct inv_mpu6050_state *st, int val,
+					 int val2)
 {
 	int result, i;
 	u8 d;
 
+	if (val != 0)
+		return -EINVAL;
+
 	for (i = 0; i < ARRAY_SIZE(accel_scale); ++i) {
-		if (accel_scale[i] == val) {
+		if (accel_scale[i] == val2) {
 			d = (i << INV_MPU6050_ACCL_CONFIG_FSR_SHIFT);
 			result = regmap_write(st->map, st->reg->accl_config, d);
 			if (result)
@@ -814,10 +822,10 @@  static int inv_mpu6050_write_raw(struct iio_dev *indio_dev,
 	case IIO_CHAN_INFO_SCALE:
 		switch (chan->type) {
 		case IIO_ANGL_VEL:
-			result = inv_mpu6050_write_gyro_scale(st, val2);
+			result = inv_mpu6050_write_gyro_scale(st, val, val2);
 			break;
 		case IIO_ACCEL:
-			result = inv_mpu6050_write_accel_scale(st, val2);
+			result = inv_mpu6050_write_accel_scale(st, val, val2);
 			break;
 		default:
 			result = -EINVAL;