mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-15 06:55:13 +08:00
iio: adc: at91-sama5d2_adc: add support for separate end of conversion registers
Some platforms have separated the end-of-conversion information from the usual ISR/IMR/IER/IDR registers, into EOC_ISR/EOC_IMR/EOC_IER/EOC_IDR. To cope with both variants, helpers are being added, that will make code more clear and more easy to read. Signed-off-by: Eugen Hristev <eugen.hristev@microchip.com> Link: https://lore.kernel.org/r/20210901123013.329792-6-eugen.hristev@microchip.com Signed-off-by: Jonathan Cameron <Jonathan.Cameron@huawei.com>
This commit is contained in:
parent
8940de2e48
commit
e6d5eee4df
@ -117,6 +117,14 @@ struct at91_adc_reg_layout {
|
|||||||
u16 IMR;
|
u16 IMR;
|
||||||
/* Interrupt Status Register */
|
/* Interrupt Status Register */
|
||||||
u16 ISR;
|
u16 ISR;
|
||||||
|
/* End of Conversion Interrupt Enable Register */
|
||||||
|
u16 EOC_IER;
|
||||||
|
/* End of Conversion Interrupt Disable Register */
|
||||||
|
u16 EOC_IDR;
|
||||||
|
/* End of Conversion Interrupt Mask Register */
|
||||||
|
u16 EOC_IMR;
|
||||||
|
/* End of Conversion Interrupt Status Register */
|
||||||
|
u16 EOC_ISR;
|
||||||
/* Interrupt Status Register - Pen touching sense status */
|
/* Interrupt Status Register - Pen touching sense status */
|
||||||
#define AT91_SAMA5D2_ISR_PENS BIT(31)
|
#define AT91_SAMA5D2_ISR_PENS BIT(31)
|
||||||
/* Last Channel Trigger Mode Register */
|
/* Last Channel Trigger Mode Register */
|
||||||
@ -586,6 +594,44 @@ static unsigned int at91_adc_active_scan_mask_to_reg(struct iio_dev *indio_dev)
|
|||||||
return mask & GENMASK(st->soc_info.platform->nr_channels, 0);
|
return mask & GENMASK(st->soc_info.platform->nr_channels, 0);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void at91_adc_irq_status(struct at91_adc_state *st, u32 *status,
|
||||||
|
u32 *eoc)
|
||||||
|
{
|
||||||
|
*status = at91_adc_readl(st, ISR);
|
||||||
|
if (st->soc_info.platform->layout->EOC_ISR)
|
||||||
|
*eoc = at91_adc_readl(st, EOC_ISR);
|
||||||
|
else
|
||||||
|
*eoc = *status;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void at91_adc_irq_mask(struct at91_adc_state *st, u32 *status, u32 *eoc)
|
||||||
|
{
|
||||||
|
*status = at91_adc_readl(st, IMR);
|
||||||
|
if (st->soc_info.platform->layout->EOC_IMR)
|
||||||
|
*eoc = at91_adc_readl(st, EOC_IMR);
|
||||||
|
else
|
||||||
|
*eoc = *status;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void at91_adc_eoc_dis(struct at91_adc_state *st, unsigned int channel)
|
||||||
|
{
|
||||||
|
/*
|
||||||
|
* On some products having the EOC bits in a separate register,
|
||||||
|
* errata recommends not writing this register (EOC_IDR).
|
||||||
|
* On products having the EOC bits in the IDR register, it's fine to write it.
|
||||||
|
*/
|
||||||
|
if (!st->soc_info.platform->layout->EOC_IDR)
|
||||||
|
at91_adc_writel(st, IDR, BIT(channel));
|
||||||
|
}
|
||||||
|
|
||||||
|
static void at91_adc_eoc_ena(struct at91_adc_state *st, unsigned int channel)
|
||||||
|
{
|
||||||
|
if (!st->soc_info.platform->layout->EOC_IDR)
|
||||||
|
at91_adc_writel(st, IER, BIT(channel));
|
||||||
|
else
|
||||||
|
at91_adc_writel(st, EOC_IER, BIT(channel));
|
||||||
|
}
|
||||||
|
|
||||||
static void at91_adc_config_emr(struct at91_adc_state *st)
|
static void at91_adc_config_emr(struct at91_adc_state *st)
|
||||||
{
|
{
|
||||||
/* configure the extended mode register */
|
/* configure the extended mode register */
|
||||||
@ -1105,13 +1151,15 @@ static void at91_adc_trigger_handler_nodma(struct iio_dev *indio_dev,
|
|||||||
u8 bit;
|
u8 bit;
|
||||||
u32 mask = at91_adc_active_scan_mask_to_reg(indio_dev);
|
u32 mask = at91_adc_active_scan_mask_to_reg(indio_dev);
|
||||||
unsigned int timeout = 50;
|
unsigned int timeout = 50;
|
||||||
|
u32 status, imr, eoc = 0, eoc_imr;
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Check if the conversion is ready. If not, wait a little bit, and
|
* Check if the conversion is ready. If not, wait a little bit, and
|
||||||
* in case of timeout exit with an error.
|
* in case of timeout exit with an error.
|
||||||
*/
|
*/
|
||||||
while ((at91_adc_readl(st, ISR) & mask) != mask &&
|
while (((eoc & mask) != mask) && timeout) {
|
||||||
timeout) {
|
at91_adc_irq_status(st, &status, &eoc);
|
||||||
|
at91_adc_irq_mask(st, &imr, &eoc_imr);
|
||||||
usleep_range(50, 100);
|
usleep_range(50, 100);
|
||||||
timeout--;
|
timeout--;
|
||||||
}
|
}
|
||||||
@ -1347,12 +1395,14 @@ static irqreturn_t at91_adc_interrupt(int irq, void *private)
|
|||||||
{
|
{
|
||||||
struct iio_dev *indio = private;
|
struct iio_dev *indio = private;
|
||||||
struct at91_adc_state *st = iio_priv(indio);
|
struct at91_adc_state *st = iio_priv(indio);
|
||||||
u32 status = at91_adc_readl(st, ISR);
|
u32 status, eoc, imr, eoc_imr;
|
||||||
u32 imr = at91_adc_readl(st, IMR);
|
|
||||||
u32 rdy_mask = AT91_SAMA5D2_IER_XRDY | AT91_SAMA5D2_IER_YRDY |
|
u32 rdy_mask = AT91_SAMA5D2_IER_XRDY | AT91_SAMA5D2_IER_YRDY |
|
||||||
AT91_SAMA5D2_IER_PRDY;
|
AT91_SAMA5D2_IER_PRDY;
|
||||||
|
|
||||||
if (!(status & imr))
|
at91_adc_irq_status(st, &status, &eoc);
|
||||||
|
at91_adc_irq_mask(st, &imr, &eoc_imr);
|
||||||
|
|
||||||
|
if (!(status & imr) && !(eoc & eoc_imr))
|
||||||
return IRQ_NONE;
|
return IRQ_NONE;
|
||||||
if (status & AT91_SAMA5D2_IER_PEN) {
|
if (status & AT91_SAMA5D2_IER_PEN) {
|
||||||
/* pen detected IRQ */
|
/* pen detected IRQ */
|
||||||
@ -1446,7 +1496,7 @@ static int at91_adc_read_info_raw(struct iio_dev *indio_dev,
|
|||||||
|
|
||||||
at91_adc_writel(st, COR, cor);
|
at91_adc_writel(st, COR, cor);
|
||||||
at91_adc_writel(st, CHER, BIT(chan->channel));
|
at91_adc_writel(st, CHER, BIT(chan->channel));
|
||||||
at91_adc_writel(st, IER, BIT(chan->channel));
|
at91_adc_eoc_ena(st, chan->channel);
|
||||||
at91_adc_writel(st, CR, AT91_SAMA5D2_CR_START);
|
at91_adc_writel(st, CR, AT91_SAMA5D2_CR_START);
|
||||||
|
|
||||||
ret = wait_event_interruptible_timeout(st->wq_data_available,
|
ret = wait_event_interruptible_timeout(st->wq_data_available,
|
||||||
@ -1463,7 +1513,7 @@ static int at91_adc_read_info_raw(struct iio_dev *indio_dev,
|
|||||||
st->conversion_done = false;
|
st->conversion_done = false;
|
||||||
}
|
}
|
||||||
|
|
||||||
at91_adc_writel(st, IDR, BIT(chan->channel));
|
at91_adc_eoc_dis(st, st->chan->channel);
|
||||||
at91_adc_writel(st, CHDR, BIT(chan->channel));
|
at91_adc_writel(st, CHDR, BIT(chan->channel));
|
||||||
|
|
||||||
/* Needed to ACK the DRDY interruption */
|
/* Needed to ACK the DRDY interruption */
|
||||||
@ -1681,6 +1731,8 @@ static void at91_adc_hw_init(struct iio_dev *indio_dev)
|
|||||||
struct at91_adc_state *st = iio_priv(indio_dev);
|
struct at91_adc_state *st = iio_priv(indio_dev);
|
||||||
|
|
||||||
at91_adc_writel(st, CR, AT91_SAMA5D2_CR_SWRST);
|
at91_adc_writel(st, CR, AT91_SAMA5D2_CR_SWRST);
|
||||||
|
if (st->soc_info.platform->layout->EOC_IDR)
|
||||||
|
at91_adc_writel(st, EOC_IDR, 0xffffffff);
|
||||||
at91_adc_writel(st, IDR, 0xffffffff);
|
at91_adc_writel(st, IDR, 0xffffffff);
|
||||||
/*
|
/*
|
||||||
* Transfer field must be set to 2 according to the datasheet and
|
* Transfer field must be set to 2 according to the datasheet and
|
||||||
|
Loading…
Reference in New Issue
Block a user