Commit c660abab authored by Karim Eshapa's avatar Karim Eshapa Committed by Jonathan Cameron

staging:iio:accel:adis16203: sign extend function rather code duplication

Use sign_extend32 kernel function instead of code duplication.
This function is also safe for 16 bits.
Signed-off-by: default avatarKarim Eshapa <karim.eshapa@gmail.com>
Signed-off-by: default avatarJonathan Cameron <Jonathan.Cameron@huawei.com>
parent 727198f9
...@@ -168,7 +168,6 @@ static int adis16203_read_raw(struct iio_dev *indio_dev, ...@@ -168,7 +168,6 @@ static int adis16203_read_raw(struct iio_dev *indio_dev,
{ {
struct adis *st = iio_priv(indio_dev); struct adis *st = iio_priv(indio_dev);
int ret; int ret;
int bits;
u8 addr; u8 addr;
s16 val16; s16 val16;
...@@ -202,14 +201,11 @@ static int adis16203_read_raw(struct iio_dev *indio_dev, ...@@ -202,14 +201,11 @@ static int adis16203_read_raw(struct iio_dev *indio_dev,
*val = 25000 / -470 - 1278; /* 25 C = 1278 */ *val = 25000 / -470 - 1278; /* 25 C = 1278 */
return IIO_VAL_INT; return IIO_VAL_INT;
case IIO_CHAN_INFO_CALIBBIAS: case IIO_CHAN_INFO_CALIBBIAS:
bits = 14;
addr = adis16203_addresses[chan->scan_index]; addr = adis16203_addresses[chan->scan_index];
ret = adis_read_reg_16(st, addr, &val16); ret = adis_read_reg_16(st, addr, &val16);
if (ret) if (ret)
return ret; return ret;
val16 &= (1 << bits) - 1; *val = sign_extend32(val16, 13);
val16 = (s16)(val16 << (16 - bits)) >> (16 - bits);
*val = val16;
return IIO_VAL_INT; return IIO_VAL_INT;
default: default:
return -EINVAL; return -EINVAL;
......
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