iio: adc: ad7124: add sequencer support

Add sequencer support for AD7124.

Signed-off-by: Alexandru Tachici <alexandru.tachici@analog.com>
Link: https://lore.kernel.org/r/20220322105029.86389-6-alexandru.tachici@analog.com
Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>

diff --git a/drivers/iio/adc/ad7124.c b/drivers/iio/adc/ad7124.c
index 8e86c6c..c5b785d 100644 (file)
--- a/drivers/iio/adc/ad7124.c
+++ b/drivers/iio/adc/ad7124.c
@@ -43,6 +43,8 @@
 #define AD7124_STATUS_POR_FLAG_MSK     BIT(4)
 
 /* AD7124_ADC_CONTROL */
+#define AD7124_ADC_STATUS_EN_MSK       BIT(10)
+#define AD7124_ADC_STATUS_EN(x)                FIELD_PREP(AD7124_ADC_STATUS_EN_MSK, x)
 #define AD7124_ADC_CTRL_REF_EN_MSK     BIT(8)
 #define AD7124_ADC_CTRL_REF_EN(x)      FIELD_PREP(AD7124_ADC_CTRL_REF_EN_MSK, x)
 #define AD7124_ADC_CTRL_PWR_MSK        GENMASK(7, 6)
@@ -500,26 +502,70 @@ static int ad7124_prepare_read(struct ad7124_state *st, int address)
        return ad7124_enable_channel(st, &st->channels[address]);
 }
 
+static int __ad7124_set_channel(struct ad_sigma_delta *sd, unsigned int channel)
+{
+       struct ad7124_state *st = container_of(sd, struct ad7124_state, sd);
+
+       return ad7124_prepare_read(st, channel);
+}
+
 static int ad7124_set_channel(struct ad_sigma_delta *sd, unsigned int channel)
 {
        struct ad7124_state *st = container_of(sd, struct ad7124_state, sd);
        int ret;
 
        mutex_lock(&st->cfgs_lock);
-       ret = ad7124_prepare_read(st, channel);
+       ret = __ad7124_set_channel(sd, channel);
        mutex_unlock(&st->cfgs_lock);
 
        return ret;
 }
 
+static int ad7124_append_status(struct ad_sigma_delta *sd, bool append)
+{
+       struct ad7124_state *st = container_of(sd, struct ad7124_state, sd);
+       unsigned int adc_control = st->adc_control;
+       int ret;
+
+       adc_control &= ~AD7124_ADC_STATUS_EN_MSK;
+       adc_control |= AD7124_ADC_STATUS_EN(append);
+
+       ret = ad_sd_write_reg(&st->sd, AD7124_ADC_CONTROL, 2, adc_control);
+       if (ret < 0)
+               return ret;
+
+       st->adc_control = adc_control;
+
+       return 0;
+}
+
+static int ad7124_disable_all(struct ad_sigma_delta *sd)
+{
+       struct ad7124_state *st = container_of(sd, struct ad7124_state, sd);
+       int ret;
+       int i;
+
+       for (i = 0; i < st->num_channels; i++) {
+               ret = ad7124_spi_write_mask(st, AD7124_CHANNEL(i), AD7124_CHANNEL_EN_MSK, 0, 2);
+               if (ret < 0)
+                       return ret;
+       }
+
+       return 0;
+}
+
 static const struct ad_sigma_delta_info ad7124_sigma_delta_info = {
        .set_channel = ad7124_set_channel,
+       .append_status = ad7124_append_status,
+       .disable_all = ad7124_disable_all,
        .set_mode = ad7124_set_mode,
        .has_registers = true,
        .addr_shift = 0,
        .read_mask = BIT(6),
+       .status_ch_mask = GENMASK(3, 0),
        .data_reg = AD7124_DATA,
-       .irq_flags = IRQF_TRIGGER_FALLING
+       .num_slots = 8,
+       .irq_flags = IRQF_TRIGGER_FALLING,
 };
 
 static int ad7124_read_raw(struct iio_dev *indio_dev,
@@ -677,15 +723,23 @@ static int ad7124_update_scan_mode(struct iio_dev *indio_dev,
        int ret;
        int i;
 
+       mutex_lock(&st->cfgs_lock);
        for (i = 0; i < st->num_channels; i++) {
                bit_set = test_bit(i, scan_mask);
-               ret = ad7124_spi_write_mask(st, AD7124_CHANNEL(i),
-                                           AD7124_CHANNEL_EN_MSK,
-                                           AD7124_CHANNEL_EN(bit_set),
-                                           2);
-               if (ret < 0)
+               if (bit_set)
+                       ret = __ad7124_set_channel(&st->sd, i);
+               else
+                       ret = ad7124_spi_write_mask(st, AD7124_CHANNEL(i), AD7124_CHANNEL_EN_MSK,
+                                                   0, 2);
+               if (ret < 0) {
+                       mutex_unlock(&st->cfgs_lock);
+
                        return ret;
+               }
        }
+
+       mutex_unlock(&st->cfgs_lock);
+
        return 0;
 }
 
@@ -906,12 +960,14 @@ static int ad7124_probe(struct spi_device *spi)
 
        st->chip_info = info;
 
-       ad_sd_init(&st->sd, indio_dev, spi, &ad7124_sigma_delta_info);
-
        indio_dev->name = st->chip_info->name;
        indio_dev->modes = INDIO_DIRECT_MODE;
        indio_dev->info = &ad7124_info;
 
+       ret = ad_sd_init(&st->sd, indio_dev, spi, &ad7124_sigma_delta_info);
+       if (ret < 0)
+               return ret;
+
        ret = ad7124_of_parse_channel_config(indio_dev, spi->dev.of_node);
        if (ret < 0)
                return ret;