Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 84b63ad8 authored by Naveen Kumar Gaddipati's avatar Naveen Kumar Gaddipati Committed by Dmitry Torokhov
Browse files

Input: nomadik-ske-keypad - get rid of multiple interrupts 



The keypad could cause multiple interrupts to be fired in succession
since we weren't waiting for the IRQs to clear properly in the
interrupt handler. We wait for a number of bus iterations (the
readl():s from the peripheral bus will stall, so these are quite
long) before giving up on getting keys ready to read, then we
sleep until the IRQ is deasserted (this is OK since the interrupt
is threaded). Also use the debounce platform data for another
hardcoded wait loop.

Signed-off-by: default avatarNaveen Kumar Gaddipati <naveen.gaddipati@stericsson.com>
Reviewed-by: default avatarRikard Olsson <rikard.p.olsson@stericsson.com>
Reviewed-by: default avatarSrinidhi Kasagar <srinidhi.kasagar@stericsson.com>
Signed-off-by: default avatarLinus Walleij <linus.walleij@linaro.org>
Signed-off-by: default avatarDmitry Torokhov <dtor@mail.ru>
parent af77c88b

drivers/input/keyboard/nomadik-ske-keypad.c

+8 −3
Original line number Original line Diff line number Diff line
@@ -49,6 +49,7 @@ 
#define SKE_ASR3	0x2C

#define SKE_ASR3	0x2C





#define SKE_NUM_ASRX_REGISTERS	(4)

#define SKE_NUM_ASRX_REGISTERS	(4)

#define	KEY_PRESSED_DELAY	10





/**

/**

 * struct ske_keypad  - data structure used by keypad driver

 * struct ske_keypad  - data structure used by keypad driver
@@ -92,7 +93,7 @@ static void ske_keypad_set_bits(struct ske_keypad *keypad, u16 addr, 
static int __init ske_keypad_chip_init(struct ske_keypad *keypad)

static int __init ske_keypad_chip_init(struct ske_keypad *keypad)

{

{

	u32 value;

	u32 value;

	int timeout = 50;

	int timeout = keypad->board->debounce_ms;





	/* check SKE_RIS to be 0 */

	/* check SKE_RIS to be 0 */

	while ((readl(keypad->reg_base + SKE_RIS) != 0x00000000) && timeout--)

	while ((readl(keypad->reg_base + SKE_RIS) != 0x00000000) && timeout--)
@@ -196,18 +197,22 @@ static void ske_keypad_read_data(struct ske_keypad *keypad) 
static irqreturn_t ske_keypad_irq(int irq, void *dev_id)

static irqreturn_t ske_keypad_irq(int irq, void *dev_id)

{

{

	struct ske_keypad *keypad = dev_id;

	struct ske_keypad *keypad = dev_id;

	int retries = 20;

	int timeout = keypad->board->debounce_ms;





	/* disable auto scan interrupt; mask the interrupt generated */

	/* disable auto scan interrupt; mask the interrupt generated */

	ske_keypad_set_bits(keypad, SKE_IMSC, ~SKE_KPIMA, 0x0);

	ske_keypad_set_bits(keypad, SKE_IMSC, ~SKE_KPIMA, 0x0);

	ske_keypad_set_bits(keypad, SKE_ICR, 0x0, SKE_KPICA);

	ske_keypad_set_bits(keypad, SKE_ICR, 0x0, SKE_KPICA);





	while ((readl(keypad->reg_base + SKE_CR) & SKE_KPASON) && --retries)

	while ((readl(keypad->reg_base + SKE_CR) & SKE_KPASON) && --timeout)

		cpu_relax();

		cpu_relax();





	/* SKEx registers are stable and can be read */

	/* SKEx registers are stable and can be read */

	ske_keypad_read_data(keypad);

	ske_keypad_read_data(keypad);





	/* wait until raw interrupt is clear */

	while ((readl(keypad->reg_base + SKE_RIS)) && --timeout)

		msleep(KEY_PRESSED_DELAY);



	/* enable auto scan interrupts */

	/* enable auto scan interrupts */

	ske_keypad_set_bits(keypad, SKE_IMSC, 0x0, SKE_KPIMA);

	ske_keypad_set_bits(keypad, SKE_IMSC, 0x0, SKE_KPIMA);