Commit 23a7fdc0 authored by Arnaud de Turckheim's avatar Arnaud de Turckheim Committed by Bartosz Golaszewski
Browse files

gpio: pcie-idio-24: Fix IRQ Enable Register value 



This fixes the COS Enable Register value for enabling/disabling the
corresponding IRQs bank.

Fixes: 58556204 ("gpio: Add GPIO support for the ACCES PCIe-IDIO-24 family")
Cc: stable@vger.kernel.org
Signed-off-by: default avatarArnaud de Turckheim <quarium@gmail.com>
Reviewed-by: default avatarWilliam Breathitt Gray <vilhelm.gray@gmail.com>
Signed-off-by: default avatarBartosz Golaszewski <bgolaszewski@baylibre.com>
parent d8f270ef

drivers/gpio/gpio-pcie-idio-24.c

+4 −4
Original line number Diff line number Diff line
@@ -334,13 +334,13 @@ static void idio_24_irq_mask(struct irq_data *data) 
	unsigned long flags;

	const unsigned long bit_offset = irqd_to_hwirq(data) - 24;

	unsigned char new_irq_mask;

	const unsigned long bank_offset = bit_offset/8 * 8;

	const unsigned long bank_offset = bit_offset / 8;

	unsigned char cos_enable_state;



	raw_spin_lock_irqsave(&idio24gpio->lock, flags);



	idio24gpio->irq_mask &= ~BIT(bit_offset);

	new_irq_mask = idio24gpio->irq_mask >> bank_offset;

	new_irq_mask = idio24gpio->irq_mask >> bank_offset * 8;



	if (!new_irq_mask) {

		cos_enable_state = ioread8(&idio24gpio->reg->cos_enable);
@@ -363,12 +363,12 @@ static void idio_24_irq_unmask(struct irq_data *data) 
	unsigned long flags;

	unsigned char prev_irq_mask;

	const unsigned long bit_offset = irqd_to_hwirq(data) - 24;

	const unsigned long bank_offset = bit_offset/8 * 8;

	const unsigned long bank_offset = bit_offset / 8;

	unsigned char cos_enable_state;



	raw_spin_lock_irqsave(&idio24gpio->lock, flags);



	prev_irq_mask = idio24gpio->irq_mask >> bank_offset;

	prev_irq_mask = idio24gpio->irq_mask >> bank_offset * 8;

	idio24gpio->irq_mask |= BIT(bit_offset);



	if (!prev_irq_mask) {