Commit d693845d authored by Alexandru Ardelean's avatar Alexandru Ardelean Committed by Jonathan Cameron

iio: imu: adis16480: use state lock for filter freq set

It's the only operation that does 2 operations (a read & a write), so the
unlocked functions can be used under a single state lock.
Signed-off-by: default avatarAlexandru Ardelean <alexandru.ardelean@analog.com>
Signed-off-by: default avatarJonathan Cameron <Jonathan.Cameron@huawei.com>
parent 0aee99a1
...@@ -555,6 +555,7 @@ static int adis16480_set_filter_freq(struct iio_dev *indio_dev, ...@@ -555,6 +555,7 @@ static int adis16480_set_filter_freq(struct iio_dev *indio_dev,
const struct iio_chan_spec *chan, unsigned int freq) const struct iio_chan_spec *chan, unsigned int freq)
{ {
struct adis16480 *st = iio_priv(indio_dev); struct adis16480 *st = iio_priv(indio_dev);
struct mutex *slock = &st->adis.state_lock;
unsigned int enable_mask, offset, reg; unsigned int enable_mask, offset, reg;
unsigned int diff, best_diff; unsigned int diff, best_diff;
unsigned int i, best_freq; unsigned int i, best_freq;
...@@ -565,9 +566,11 @@ static int adis16480_set_filter_freq(struct iio_dev *indio_dev, ...@@ -565,9 +566,11 @@ static int adis16480_set_filter_freq(struct iio_dev *indio_dev,
offset = ad16480_filter_data[chan->scan_index][1]; offset = ad16480_filter_data[chan->scan_index][1];
enable_mask = BIT(offset + 2); enable_mask = BIT(offset + 2);
ret = adis_read_reg_16(&st->adis, reg, &val); mutex_lock(slock);
ret = __adis_read_reg_16(&st->adis, reg, &val);
if (ret) if (ret)
return ret; goto out_unlock;
if (freq == 0) { if (freq == 0) {
val &= ~enable_mask; val &= ~enable_mask;
...@@ -589,7 +592,11 @@ static int adis16480_set_filter_freq(struct iio_dev *indio_dev, ...@@ -589,7 +592,11 @@ static int adis16480_set_filter_freq(struct iio_dev *indio_dev,
val |= enable_mask; val |= enable_mask;
} }
return adis_write_reg_16(&st->adis, reg, val); ret = __adis_write_reg_16(&st->adis, reg, val);
out_unlock:
mutex_unlock(slock);
return ret;
} }
static int adis16480_read_raw(struct iio_dev *indio_dev, static int adis16480_read_raw(struct iio_dev *indio_dev,
......
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