mirror of
https://github.com/torvalds/linux.git
synced 2026-05-22 22:22:08 +02:00
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>
This commit is contained in:
parent
8bea9af887
commit
5cfe8a1c25
|
|
@ -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;
|
||||
|
|
|
|||
Loading…
Reference in New Issue
Block a user