From mboxrd@z Thu Jan 1 00:00:00 1970 From: mark.brown314@gmail.com (Mark F. Brown) Date: Thu, 26 Aug 2010 05:18:58 -0400 Subject: [PATCH 4/5] ARM: pxa168: added special case handler for keypad interrupts In-Reply-To: <1282814339-10934-1-git-send-email-mark.brown314@gmail.com> References: <1282814339-10934-1-git-send-email-mark.brown314@gmail.com> Message-ID: <1282814339-10934-5-git-send-email-mark.brown314@gmail.com> To: linux-arm-kernel@lists.infradead.org List-Id: linux-arm-kernel.lists.infradead.org Signed-off-by: Mark F. Brown --- arch/arm/mach-mmp/irq-pxa168.c | 23 ++++++++++++++++++++++- 1 files changed, 22 insertions(+), 1 deletions(-) diff --git a/arch/arm/mach-mmp/irq-pxa168.c b/arch/arm/mach-mmp/irq-pxa168.c index 52ff2f0..bfb0984 100644 --- a/arch/arm/mach-mmp/irq-pxa168.c +++ b/arch/arm/mach-mmp/irq-pxa168.c @@ -17,6 +17,8 @@ #include #include +#include +#include #include "common.h" @@ -42,6 +44,19 @@ static struct irq_chip icu_irq_chip = { .unmask = icu_unmask_irq, }; +void handle_pxa168_keypad_irq(unsigned int irq, struct irq_desc *desc) +{ + uint32_t val; + uint32_t mask = APMU_PXA168_KP_WAKE_CLR; + + /* clear keypad wake event */ + val = __raw_readl(APMU_WAKE_CLR); + __raw_writel(val | mask, APMU_WAKE_CLR); + + /* handle irq */ + handle_level_irq(irq, desc); +} + void __init icu_init_irq(void) { int irq; @@ -49,7 +64,13 @@ void __init icu_init_irq(void) for (irq = 0; irq < 64; irq++) { icu_mask_irq(irq); set_irq_chip(irq, &icu_irq_chip); - set_irq_handler(irq, handle_level_irq); + + /* special handler for keypad */ + if (cpu_is_pxa168() && irq == IRQ_PXA168_KEYPAD) + set_irq_handler(irq, handle_pxa168_keypad_irq); + else + set_irq_handler(irq, handle_level_irq); + set_irq_flags(irq, IRQF_VALID); } } -- 1.7.0.4