Commit 3d329bcd authored by Jonathan Cameron's avatar Jonathan Cameron

iio: adc: max1363: Use automatic cleanup for locks and iio mode claiming.

This simplifies error return paths.
Reviewed-by: default avatarNuno Sa <nuno.a@analog.com>
Link: https://lore.kernel.org/r/20240128150537.44592-6-jic23@kernel.orgSigned-off-by: default avatarJonathan Cameron <Jonathan.Cameron@huawei.com>
parent b6dde109
...@@ -357,62 +357,55 @@ static int max1363_read_single_chan(struct iio_dev *indio_dev, ...@@ -357,62 +357,55 @@ static int max1363_read_single_chan(struct iio_dev *indio_dev,
int *val, int *val,
long m) long m)
{ {
int ret = 0; iio_device_claim_direct_scoped(return -EBUSY, indio_dev) {
s32 data; s32 data;
u8 rxbuf[2]; u8 rxbuf[2];
struct max1363_state *st = iio_priv(indio_dev); struct max1363_state *st = iio_priv(indio_dev);
struct i2c_client *client = st->client; struct i2c_client *client = st->client;
ret = iio_device_claim_direct_mode(indio_dev); guard(mutex)(&st->lock);
if (ret)
return ret; /*
mutex_lock(&st->lock); * If monitor mode is enabled, the method for reading a single
* channel will have to be rather different and has not yet
/* * been implemented.
* If monitor mode is enabled, the method for reading a single *
* channel will have to be rather different and has not yet * Also, cannot read directly if buffered capture enabled.
* been implemented. */
* if (st->monitor_on)
* Also, cannot read directly if buffered capture enabled. return -EBUSY;
*/
if (st->monitor_on) { /* Check to see if current scan mode is correct */
ret = -EBUSY; if (st->current_mode != &max1363_mode_table[chan->address]) {
goto error_ret; int ret;
}
/* Update scan mode if needed */
/* Check to see if current scan mode is correct */ st->current_mode = &max1363_mode_table[chan->address];
if (st->current_mode != &max1363_mode_table[chan->address]) { ret = max1363_set_scan_mode(st);
/* Update scan mode if needed */ if (ret < 0)
st->current_mode = &max1363_mode_table[chan->address]; return ret;
ret = max1363_set_scan_mode(st);
if (ret < 0)
goto error_ret;
}
if (st->chip_info->bits != 8) {
/* Get reading */
data = st->recv(client, rxbuf, 2);
if (data < 0) {
ret = data;
goto error_ret;
} }
data = (rxbuf[1] | rxbuf[0] << 8) & if (st->chip_info->bits != 8) {
((1 << st->chip_info->bits) - 1); /* Get reading */
} else { data = st->recv(client, rxbuf, 2);
/* Get reading */ if (data < 0)
data = st->recv(client, rxbuf, 1); return data;
if (data < 0) {
ret = data; data = (rxbuf[1] | rxbuf[0] << 8) &
goto error_ret; ((1 << st->chip_info->bits) - 1);
} else {
/* Get reading */
data = st->recv(client, rxbuf, 1);
if (data < 0)
return data;
data = rxbuf[0];
} }
data = rxbuf[0]; *val = data;
}
*val = data;
error_ret:
mutex_unlock(&st->lock);
iio_device_release_direct_mode(indio_dev);
return ret;
return 0;
}
unreachable();
} }
static int max1363_read_raw(struct iio_dev *indio_dev, static int max1363_read_raw(struct iio_dev *indio_dev,
...@@ -710,9 +703,8 @@ static ssize_t max1363_monitor_store_freq(struct device *dev, ...@@ -710,9 +703,8 @@ static ssize_t max1363_monitor_store_freq(struct device *dev,
if (!found) if (!found)
return -EINVAL; return -EINVAL;
mutex_lock(&st->lock); scoped_guard(mutex, &st->lock)
st->monitor_speed = i; st->monitor_speed = i;
mutex_unlock(&st->lock);
return 0; return 0;
} }
...@@ -815,12 +807,11 @@ static int max1363_read_event_config(struct iio_dev *indio_dev, ...@@ -815,12 +807,11 @@ static int max1363_read_event_config(struct iio_dev *indio_dev,
int val; int val;
int number = chan->channel; int number = chan->channel;
mutex_lock(&st->lock); guard(mutex)(&st->lock);
if (dir == IIO_EV_DIR_FALLING) if (dir == IIO_EV_DIR_FALLING)
val = (1 << number) & st->mask_low; val = (1 << number) & st->mask_low;
else else
val = (1 << number) & st->mask_high; val = (1 << number) & st->mask_high;
mutex_unlock(&st->lock);
return val; return val;
} }
...@@ -962,46 +953,42 @@ static int max1363_write_event_config(struct iio_dev *indio_dev, ...@@ -962,46 +953,42 @@ static int max1363_write_event_config(struct iio_dev *indio_dev,
const struct iio_chan_spec *chan, enum iio_event_type type, const struct iio_chan_spec *chan, enum iio_event_type type,
enum iio_event_direction dir, int state) enum iio_event_direction dir, int state)
{ {
int ret = 0;
struct max1363_state *st = iio_priv(indio_dev); struct max1363_state *st = iio_priv(indio_dev);
u16 unifiedmask;
int number = chan->channel;
ret = iio_device_claim_direct_mode(indio_dev); iio_device_claim_direct_scoped(return -EBUSY, indio_dev) {
if (ret) int number = chan->channel;
return ret; u16 unifiedmask;
mutex_lock(&st->lock); int ret;
unifiedmask = st->mask_low | st->mask_high; guard(mutex)(&st->lock);
if (dir == IIO_EV_DIR_FALLING) {
unifiedmask = st->mask_low | st->mask_high;
if (state == 0) if (dir == IIO_EV_DIR_FALLING) {
st->mask_low &= ~(1 << number);
else { if (state == 0)
ret = __max1363_check_event_mask((1 << number), st->mask_low &= ~(1 << number);
unifiedmask); else {
if (ret) ret = __max1363_check_event_mask((1 << number),
goto error_ret; unifiedmask);
st->mask_low |= (1 << number); if (ret)
} return ret;
} else { st->mask_low |= (1 << number);
if (state == 0) }
st->mask_high &= ~(1 << number); } else {
else { if (state == 0)
ret = __max1363_check_event_mask((1 << number), st->mask_high &= ~(1 << number);
unifiedmask); else {
if (ret) ret = __max1363_check_event_mask((1 << number),
goto error_ret; unifiedmask);
st->mask_high |= (1 << number); if (ret)
return ret;
st->mask_high |= (1 << number);
}
} }
} }
max1363_monitor_mode_update(st, !!(st->mask_high | st->mask_low)); max1363_monitor_mode_update(st, !!(st->mask_high | st->mask_low));
error_ret:
mutex_unlock(&st->lock);
iio_device_release_direct_mode(indio_dev);
return ret; return 0;
} }
/* /*
......
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