iio: pressure: mpl3115: factor out core of IIO_INFO_RAW read to simplify code flow

Apply guard(mutex) to remove the need for manual release of the lock.
Factor out the code that occurs under the direct claim.
These two changes allow for direct returns simplifying code flow.

Reviewed-by: David Lechner <dlechner@baylibre.com>
Reviewed-by: Marcelo Schmitt <marcelo.schmitt1@gmail.com>
Link: https://patch.msgid.link/20250331121317.1694135-27-jic23@kernel.org
Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>

diff --git a/drivers/iio/pressure/mpl3115.c b/drivers/iio/pressure/mpl3115.c
index 71ded2eee060f8d3be9c793d3e48a717eda1803e..207031b5ff726fecc4e63610f95a101b25c0b3dc 100644 (file)
--- a/drivers/iio/pressure/mpl3115.c
+++ b/drivers/iio/pressure/mpl3115.c
@@ -69,6 +69,52 @@ static int mpl3115_request(struct mpl3115_data *data)
        return 0;
 }
 
+static int mpl3115_read_info_raw(struct mpl3115_data *data,
+                                struct iio_chan_spec const *chan, int *val)
+{
+       int ret;
+
+       switch (chan->type) {
+       case IIO_PRESSURE: { /* in 0.25 pascal / LSB */
+               __be32 tmp = 0;
+
+               guard(mutex)(&data->lock);
+               ret = mpl3115_request(data);
+               if (ret < 0)
+                       return ret;
+
+               ret = i2c_smbus_read_i2c_block_data(data->client,
+                                                   MPL3115_OUT_PRESS,
+                                                   3, (u8 *) &tmp);
+               if (ret < 0)
+                       return ret;
+
+               *val = be32_to_cpu(tmp) >> chan->scan_type.shift;
+               return IIO_VAL_INT;
+       }
+       case IIO_TEMP: { /* in 0.0625 celsius / LSB */
+               __be16 tmp;
+
+               guard(mutex)(&data->lock);
+               ret = mpl3115_request(data);
+               if (ret < 0)
+                       return ret;
+
+               ret = i2c_smbus_read_i2c_block_data(data->client,
+                                                   MPL3115_OUT_TEMP,
+                                                   2, (u8 *) &tmp);
+               if (ret < 0)
+                       return ret;
+
+               *val = sign_extend32(be16_to_cpu(tmp) >> chan->scan_type.shift,
+                                    chan->scan_type.realbits - 1);
+               return IIO_VAL_INT;
+       }
+       default:
+               return -EINVAL;
+       }
+}
+
 static int mpl3115_read_raw(struct iio_dev *indio_dev,
                            struct iio_chan_spec const *chan,
                            int *val, int *val2, long mask)
@@ -82,49 +128,7 @@ static int mpl3115_read_raw(struct iio_dev *indio_dev,
                if (ret)
                        return ret;
 
-               switch (chan->type) {
-               case IIO_PRESSURE: { /* in 0.25 pascal / LSB */
-                       __be32 tmp = 0;
-
-                       mutex_lock(&data->lock);
-                       ret = mpl3115_request(data);
-                       if (ret < 0) {
-                               mutex_unlock(&data->lock);
-                               break;
-                       }
-                       ret = i2c_smbus_read_i2c_block_data(data->client,
-                               MPL3115_OUT_PRESS, 3, (u8 *) &tmp);
-                       mutex_unlock(&data->lock);
-                       if (ret < 0)
-                               break;
-                       *val = be32_to_cpu(tmp) >> chan->scan_type.shift;
-                       ret = IIO_VAL_INT;
-                       break;
-               }
-               case IIO_TEMP: { /* in 0.0625 celsius / LSB */
-                       __be16 tmp;
-
-                       mutex_lock(&data->lock);
-                       ret = mpl3115_request(data);
-                       if (ret < 0) {
-                               mutex_unlock(&data->lock);
-                               break;
-                       }
-                       ret = i2c_smbus_read_i2c_block_data(data->client,
-                               MPL3115_OUT_TEMP, 2, (u8 *) &tmp);
-                       mutex_unlock(&data->lock);
-                       if (ret < 0)
-                               break;
-                       *val = sign_extend32(be16_to_cpu(tmp) >> chan->scan_type.shift,
-                                            chan->scan_type.realbits - 1);
-                       ret = IIO_VAL_INT;
-                       break;
-               }
-               default:
-                       ret = -EINVAL;
-                       break;
-               }
-
+               ret = mpl3115_read_info_raw(data, chan, val);
                iio_device_release_direct_mode(indio_dev);
                return ret;