mirror of
https://github.com/torvalds/linux.git
synced 2026-05-31 02:24:24 +02:00
iio: adc: Enable multiple consecutive channels based on model data
Add helpers to generate channel masks and enable multiple ADC channels according to the device model's channel count. Signed-off-by: Billy Tsai <billy_tsai@aspeedtech.com> Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>
This commit is contained in:
parent
a28069be7d
commit
9ee1c3be16
|
|
@ -123,6 +123,24 @@ struct aspeed_adc_data {
|
|||
struct adc_gain battery_mode_gain;
|
||||
};
|
||||
|
||||
/*
|
||||
* Enable multiple consecutive channels starting from channel 0.
|
||||
* This creates a bitmask for channels 0 to (num_channels - 1).
|
||||
* For example: num_channels=3 creates mask 0x0007 (channels 0,1,2)
|
||||
*/
|
||||
static inline u32 aspeed_adc_channels_mask(unsigned int num_channels)
|
||||
{
|
||||
if (num_channels > 16)
|
||||
return GENMASK(15, 0);
|
||||
|
||||
return BIT(num_channels) - 1;
|
||||
}
|
||||
|
||||
static inline unsigned int aspeed_adc_get_active_channels(const struct aspeed_adc_data *data)
|
||||
{
|
||||
return data->model_data->num_channels;
|
||||
}
|
||||
|
||||
#define ASPEED_CHAN(_idx, _data_reg_addr) { \
|
||||
.type = IIO_VOLTAGE, \
|
||||
.indexed = 1, \
|
||||
|
|
@ -612,7 +630,9 @@ static int aspeed_adc_probe(struct platform_device *pdev)
|
|||
/* Start all channels in normal mode. */
|
||||
adc_engine_control_reg_val =
|
||||
readl(data->base + ASPEED_REG_ENGINE_CONTROL);
|
||||
adc_engine_control_reg_val |= ASPEED_ADC_CTRL_CHANNEL;
|
||||
FIELD_MODIFY(ASPEED_ADC_CTRL_CHANNEL, &adc_engine_control_reg_val,
|
||||
aspeed_adc_channels_mask(aspeed_adc_get_active_channels(data)));
|
||||
|
||||
writel(adc_engine_control_reg_val,
|
||||
data->base + ASPEED_REG_ENGINE_CONTROL);
|
||||
|
||||
|
|
|
|||
Loading…
Reference in New Issue
Block a user