iio: adc: max1027: Create a helper to configure the channels to scan
These bits are meant to be reused for triggered buffers setup. Signed-off-by: Miquel Raynal <miquel.raynal@bootlin.com> Link: https://lore.kernel.org/r/20210921115408.66711-10-miquel.raynal@bootlin.com Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>
This commit is contained in:
parent
cba18232c4
commit
af8b93e27f
|
@ -272,6 +272,19 @@ struct max1027_state {
|
|||
u8 reg ____cacheline_aligned;
|
||||
};
|
||||
|
||||
/* Scan from chan 0 to the highest requested channel. Include temperature on demand. */
|
||||
static int max1027_configure_chans_and_start(struct iio_dev *indio_dev)
|
||||
{
|
||||
struct max1027_state *st = iio_priv(indio_dev);
|
||||
|
||||
st->reg = MAX1027_CONV_REG | MAX1027_SCAN_0_N;
|
||||
st->reg |= MAX1027_CHAN(fls(*indio_dev->active_scan_mask) - 2);
|
||||
if (*indio_dev->active_scan_mask & MAX1X27_SCAN_MASK_TEMP)
|
||||
st->reg |= MAX1027_TEMP;
|
||||
|
||||
return spi_write(st->spi, &st->reg, 1);
|
||||
}
|
||||
|
||||
static int max1027_enable_trigger(struct iio_dev *indio_dev, bool enable)
|
||||
{
|
||||
struct max1027_state *st = iio_priv(indio_dev);
|
||||
|
@ -403,7 +416,6 @@ static int max1027_validate_trigger(struct iio_dev *indio_dev,
|
|||
static int max1027_set_cnvst_trigger_state(struct iio_trigger *trig, bool state)
|
||||
{
|
||||
struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
|
||||
struct max1027_state *st = iio_priv(indio_dev);
|
||||
int ret;
|
||||
|
||||
/*
|
||||
|
@ -417,17 +429,8 @@ static int max1027_set_cnvst_trigger_state(struct iio_trigger *trig, bool state)
|
|||
return ret;
|
||||
|
||||
if (state) {
|
||||
/*
|
||||
* Scan from chan 0 to the highest requested channel.
|
||||
* Include temperature on demand.
|
||||
*/
|
||||
st->reg = MAX1027_CONV_REG | MAX1027_SCAN_0_N;
|
||||
st->reg |= MAX1027_CHAN(fls(*indio_dev->active_scan_mask) - 2);
|
||||
if (*indio_dev->active_scan_mask & MAX1X27_SCAN_MASK_TEMP)
|
||||
st->reg |= MAX1027_TEMP;
|
||||
|
||||
ret = spi_write(st->spi, &st->reg, 1);
|
||||
if (ret < 0)
|
||||
ret = max1027_configure_chans_and_start(indio_dev);
|
||||
if (ret)
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in New Issue