iio: adc: at91-sama5d2_adc: check return status for pressure and touch

[platform/kernel/linux-rpi.git] / drivers / iio / adc / at91-sama5d2_adc.c

diff --git a/drivers/iio/adc/at91-sama5d2_adc.c b/drivers/iio/adc/at91-sama5d2_adc.c
index 92e2e74..6eb72ba 100644 (file)
--- a/drivers/iio/adc/at91-sama5d2_adc.c
+++ b/drivers/iio/adc/at91-sama5d2_adc.c
@@ -1331,8 +1331,10 @@ static int at91_adc_read_info_raw(struct iio_dev *indio_dev,
                *val = tmp_val;
                mutex_unlock(&st->lock);
                iio_device_release_direct_mode(indio_dev);
+               if (ret > 0)
+                       ret = at91_adc_adjust_val_osr(st, val);
 
-               return at91_adc_adjust_val_osr(st, val);
+               return ret;
        }
        if (chan->type == IIO_PRESSURE) {
                ret = iio_device_claim_direct_mode(indio_dev);
@@ -1345,8 +1347,10 @@ static int at91_adc_read_info_raw(struct iio_dev *indio_dev,
                *val = tmp_val;
                mutex_unlock(&st->lock);
                iio_device_release_direct_mode(indio_dev);
+               if (ret > 0)
+                       ret = at91_adc_adjust_val_osr(st, val);
 
-               return at91_adc_adjust_val_osr(st, val);
+               return ret;
        }
 
        /* in this case we have a voltage channel */