mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-30 11:41:38 -04:00
iio: imu: kmx61: Use correct base when reading data
We have two IIO devices and we need to adjust the base when reading data. Signed-off-by: Daniel Baluta <[email protected]> Reviewed-by: Hartmut Knaack <[email protected]> Signed-off-by: Jonathan Cameron <[email protected]>
This commit is contained in:
parent
ea04d29658
commit
6a191c7025
1 changed files with 7 additions and 1 deletions
|
|
@ -1218,12 +1218,18 @@ static irqreturn_t kmx61_trigger_handler(int irq, void *p)
|
|||
struct iio_dev *indio_dev = pf->indio_dev;
|
||||
struct kmx61_data *data = kmx61_get_data(indio_dev);
|
||||
int bit, ret, i = 0;
|
||||
u8 base;
|
||||
s16 buffer[8];
|
||||
|
||||
if (indio_dev == data->acc_indio_dev)
|
||||
base = KMX61_ACC_XOUT_L;
|
||||
else
|
||||
base = KMX61_MAG_XOUT_L;
|
||||
|
||||
mutex_lock(&data->lock);
|
||||
for_each_set_bit(bit, indio_dev->buffer->scan_mask,
|
||||
indio_dev->masklength) {
|
||||
ret = kmx61_read_measurement(data, KMX61_ACC_XOUT_L, bit);
|
||||
ret = kmx61_read_measurement(data, base, bit);
|
||||
if (ret < 0) {
|
||||
mutex_unlock(&data->lock);
|
||||
goto err;
|
||||
|
|
|
|||
Loading…
Reference in a new issue