|
@@ -18,6 +18,7 @@
|
|
#include <linux/delay.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/module.h>
|
|
#include <linux/module.h>
|
|
|
|
+#include <linux/bitops.h>
|
|
|
|
|
|
#include <linux/iio/iio.h>
|
|
#include <linux/iio/iio.h>
|
|
#include <linux/iio/sysfs.h>
|
|
#include <linux/iio/sysfs.h>
|
|
@@ -68,7 +69,7 @@ static int ad2s1200_read_raw(struct iio_dev *indio_dev,
|
|
break;
|
|
break;
|
|
case IIO_ANGL_VEL:
|
|
case IIO_ANGL_VEL:
|
|
vel = (((s16)(st->rx[0])) << 4) | ((st->rx[1] & 0xF0) >> 4);
|
|
vel = (((s16)(st->rx[0])) << 4) | ((st->rx[1] & 0xF0) >> 4);
|
|
- vel = (vel << 4) >> 4;
|
|
|
|
|
|
+ vel = sign_extend32(vel, 11);
|
|
*val = vel;
|
|
*val = vel;
|
|
break;
|
|
break;
|
|
default:
|
|
default:
|