* [PATCH] iio: magnetometer: mag3110: claim direct mode during raw writes
@ 2017-01-20 20:39 Alison Schofield
2017-01-21 9:43 ` Peter Meerwald-Stadler
0 siblings, 1 reply; 3+ messages in thread
From: Alison Schofield @ 2017-01-20 20:39 UTC (permalink / raw)
To: jic23; +Cc: knaack.h, lars, pmeerw, linux-iio, linux-kernel
Driver was checking for direct mode but not locking it. Use
claim/release helper functions to guarantee the device stays
in direct mode during raw writes.
Signed-off-by: Alison Schofield <amsfield22@gmail.com>
---
drivers/iio/magnetometer/mag3110.c | 30 ++++++++++++++++++++----------
1 file changed, 20 insertions(+), 10 deletions(-)
diff --git a/drivers/iio/magnetometer/mag3110.c b/drivers/iio/magnetometer/mag3110.c
index f2b3bd7..b4f643f 100644
--- a/drivers/iio/magnetometer/mag3110.c
+++ b/drivers/iio/magnetometer/mag3110.c
@@ -222,29 +222,39 @@ static int mag3110_write_raw(struct iio_dev *indio_dev,
int val, int val2, long mask)
{
struct mag3110_data *data = iio_priv(indio_dev);
- int rate;
+ int rate, ret;
- if (iio_buffer_enabled(indio_dev))
- return -EBUSY;
+ ret = iio_device_claim_direct_mode(indio_dev);
+ if (ret)
+ return ret;
switch (mask) {
case IIO_CHAN_INFO_SAMP_FREQ:
rate = mag3110_get_samp_freq_index(data, val, val2);
- if (rate < 0)
- return -EINVAL;
+ if (rate < 0) {
+ ret = -EINVAL;
+ break;
+ }
data->ctrl_reg1 &= ~MAG3110_CTRL_DR_MASK;
data->ctrl_reg1 |= rate << MAG3110_CTRL_DR_SHIFT;
- return i2c_smbus_write_byte_data(data->client,
+ ret = i2c_smbus_write_byte_data(data->client,
MAG3110_CTRL_REG1, data->ctrl_reg1);
+ break;
case IIO_CHAN_INFO_CALIBBIAS:
- if (val < -10000 || val > 10000)
- return -EINVAL;
- return i2c_smbus_write_word_swapped(data->client,
+ if (val < -10000 || val > 10000) {
+ ret = -EINVAL;
+ break;
+ }
+ ret = i2c_smbus_write_word_swapped(data->client,
MAG3110_OFF_X + 2 * chan->scan_index, val << 1);
+ break;
default:
- return -EINVAL;
+ ret = -EINVAL;
+ break;
}
+ iio_device_release_direct_mode(indio_dev);
+ return ret;
}
static irqreturn_t mag3110_trigger_handler(int irq, void *p)
--
2.1.4
^ permalink raw reply related [flat|nested] 3+ messages in thread
* Re: [PATCH] iio: magnetometer: mag3110: claim direct mode during raw writes
2017-01-20 20:39 [PATCH] iio: magnetometer: mag3110: claim direct mode during raw writes Alison Schofield
@ 2017-01-21 9:43 ` Peter Meerwald-Stadler
2017-01-21 12:21 ` Jonathan Cameron
0 siblings, 1 reply; 3+ messages in thread
From: Peter Meerwald-Stadler @ 2017-01-21 9:43 UTC (permalink / raw)
To: Alison Schofield; +Cc: jic23, linux-iio, linux-kernel
> Driver was checking for direct mode but not locking it. Use
> claim/release helper functions to guarantee the device stays
> in direct mode during raw writes.
looks good,
Acked-by: Peter Meerwald-Stadler <pmeerw@pmeerw.net>
> Signed-off-by: Alison Schofield <amsfield22@gmail.com>
> ---
> drivers/iio/magnetometer/mag3110.c | 30 ++++++++++++++++++++----------
> 1 file changed, 20 insertions(+), 10 deletions(-)
>
> diff --git a/drivers/iio/magnetometer/mag3110.c b/drivers/iio/magnetometer/mag3110.c
> index f2b3bd7..b4f643f 100644
> --- a/drivers/iio/magnetometer/mag3110.c
> +++ b/drivers/iio/magnetometer/mag3110.c
> @@ -222,29 +222,39 @@ static int mag3110_write_raw(struct iio_dev *indio_dev,
> int val, int val2, long mask)
> {
> struct mag3110_data *data = iio_priv(indio_dev);
> - int rate;
> + int rate, ret;
>
> - if (iio_buffer_enabled(indio_dev))
> - return -EBUSY;
> + ret = iio_device_claim_direct_mode(indio_dev);
> + if (ret)
> + return ret;
>
> switch (mask) {
> case IIO_CHAN_INFO_SAMP_FREQ:
> rate = mag3110_get_samp_freq_index(data, val, val2);
> - if (rate < 0)
> - return -EINVAL;
> + if (rate < 0) {
> + ret = -EINVAL;
> + break;
> + }
>
> data->ctrl_reg1 &= ~MAG3110_CTRL_DR_MASK;
> data->ctrl_reg1 |= rate << MAG3110_CTRL_DR_SHIFT;
> - return i2c_smbus_write_byte_data(data->client,
> + ret = i2c_smbus_write_byte_data(data->client,
> MAG3110_CTRL_REG1, data->ctrl_reg1);
> + break;
> case IIO_CHAN_INFO_CALIBBIAS:
> - if (val < -10000 || val > 10000)
> - return -EINVAL;
> - return i2c_smbus_write_word_swapped(data->client,
> + if (val < -10000 || val > 10000) {
> + ret = -EINVAL;
> + break;
> + }
> + ret = i2c_smbus_write_word_swapped(data->client,
> MAG3110_OFF_X + 2 * chan->scan_index, val << 1);
> + break;
> default:
> - return -EINVAL;
> + ret = -EINVAL;
> + break;
> }
> + iio_device_release_direct_mode(indio_dev);
> + return ret;
> }
>
> static irqreturn_t mag3110_trigger_handler(int irq, void *p)
>
--
Peter Meerwald-Stadler
+43-664-2444418 (mobile)
^ permalink raw reply [flat|nested] 3+ messages in thread
* Re: [PATCH] iio: magnetometer: mag3110: claim direct mode during raw writes
2017-01-21 9:43 ` Peter Meerwald-Stadler
@ 2017-01-21 12:21 ` Jonathan Cameron
0 siblings, 0 replies; 3+ messages in thread
From: Jonathan Cameron @ 2017-01-21 12:21 UTC (permalink / raw)
To: Peter Meerwald-Stadler, Alison Schofield; +Cc: linux-iio, linux-kernel
On 21/01/17 09:43, Peter Meerwald-Stadler wrote:
>
>> Driver was checking for direct mode but not locking it. Use
>> claim/release helper functions to guarantee the device stays
>> in direct mode during raw writes.
>
> looks good,
> Acked-by: Peter Meerwald-Stadler <pmeerw@pmeerw.net>
Applied to the togreg branch of iio.git - initially pushed out as testing etc..
Jonathan
>
>> Signed-off-by: Alison Schofield <amsfield22@gmail.com>
>> ---
>> drivers/iio/magnetometer/mag3110.c | 30 ++++++++++++++++++++----------
>> 1 file changed, 20 insertions(+), 10 deletions(-)
>>
>> diff --git a/drivers/iio/magnetometer/mag3110.c b/drivers/iio/magnetometer/mag3110.c
>> index f2b3bd7..b4f643f 100644
>> --- a/drivers/iio/magnetometer/mag3110.c
>> +++ b/drivers/iio/magnetometer/mag3110.c
>> @@ -222,29 +222,39 @@ static int mag3110_write_raw(struct iio_dev *indio_dev,
>> int val, int val2, long mask)
>> {
>> struct mag3110_data *data = iio_priv(indio_dev);
>> - int rate;
>> + int rate, ret;
>>
>> - if (iio_buffer_enabled(indio_dev))
>> - return -EBUSY;
>> + ret = iio_device_claim_direct_mode(indio_dev);
>> + if (ret)
>> + return ret;
>>
>> switch (mask) {
>> case IIO_CHAN_INFO_SAMP_FREQ:
>> rate = mag3110_get_samp_freq_index(data, val, val2);
>> - if (rate < 0)
>> - return -EINVAL;
>> + if (rate < 0) {
>> + ret = -EINVAL;
>> + break;
>> + }
>>
>> data->ctrl_reg1 &= ~MAG3110_CTRL_DR_MASK;
>> data->ctrl_reg1 |= rate << MAG3110_CTRL_DR_SHIFT;
>> - return i2c_smbus_write_byte_data(data->client,
>> + ret = i2c_smbus_write_byte_data(data->client,
>> MAG3110_CTRL_REG1, data->ctrl_reg1);
>> + break;
>> case IIO_CHAN_INFO_CALIBBIAS:
>> - if (val < -10000 || val > 10000)
>> - return -EINVAL;
>> - return i2c_smbus_write_word_swapped(data->client,
>> + if (val < -10000 || val > 10000) {
>> + ret = -EINVAL;
>> + break;
>> + }
>> + ret = i2c_smbus_write_word_swapped(data->client,
>> MAG3110_OFF_X + 2 * chan->scan_index, val << 1);
>> + break;
>> default:
>> - return -EINVAL;
>> + ret = -EINVAL;
>> + break;
>> }
>> + iio_device_release_direct_mode(indio_dev);
>> + return ret;
>> }
>>
>> static irqreturn_t mag3110_trigger_handler(int irq, void *p)
>>
>
^ permalink raw reply [flat|nested] 3+ messages in thread
end of thread, other threads:[~2017-01-21 12:21 UTC | newest]
Thread overview: 3+ messages (download: mbox.gz follow: Atom feed
-- links below jump to the message on this page --
2017-01-20 20:39 [PATCH] iio: magnetometer: mag3110: claim direct mode during raw writes Alison Schofield
2017-01-21 9:43 ` Peter Meerwald-Stadler
2017-01-21 12:21 ` Jonathan Cameron
This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox;
as well as URLs for NNTP newsgroup(s).