arch/arm/mach-pxa/irq.c

   1 /*
   2  *  linux/arch/arm/mach-pxa/irq.c
   3  *
   4  *  Generic PXA IRQ handling
   5  *
   6  *  Author:     Nicolas Pitre
   7  *  Created:    Jun 15, 2001
   8  *  Copyright:  MontaVista Software Inc.
   9  *
  10  *  This program is free software; you can redistribute it and/or modify
  11  *  it under the terms of the GNU General Public License version 2 as
  12  *  published by the Free Software Foundation.
  13  */
  14
  15 #include <linux/init.h>
  16 #include <linux/module.h>
  17 #include <linux/interrupt.h>
  18 #include <linux/sysdev.h>
  19
  20 #include <asm/hardware.h>
  21 #include <asm/irq.h>
  22 #include <asm/mach/irq.h>
  23 #include <asm/arch/pxa-regs.h>
  24 #include <asm/arch/pxa2xx-gpio.h>
  25
  26 #include "generic.h"
  27
  28 #define IRQ_BIT(n)      (((n) - PXA_IRQ(0)) & 0x1f)
  29 #define _ICMR(n)        (*((((n) - PXA_IRQ(0)) & ~0x1f) ? &ICMR2 : &ICMR))
  30 #define _ICLR(n)        (*((((n) - PXA_IRQ(0)) & ~0x1f) ? &ICLR2 : &ICLR))
  31
  32 /*
  33  * This is for peripheral IRQs internal to the PXA chip.
  34  */
  35
  36 static int pxa_internal_irq_nr;
  37
  38 static void pxa_mask_irq(unsigned int irq)
  39 {
  40         _ICMR(irq) &= ~(1 << IRQ_BIT(irq));
  41 }
  42
  43 static void pxa_unmask_irq(unsigned int irq)
  44 {
  45         _ICMR(irq) |= 1 << IRQ_BIT(irq);
  46 }
  47
  48 static struct irq_chip pxa_internal_irq_chip = {
  49         .name           = "SC",
  50         .ack            = pxa_mask_irq,
  51         .mask           = pxa_mask_irq,
  52         .unmask         = pxa_unmask_irq,
  53 };
  54
  55 void __init pxa_init_irq(int irq_nr, set_wake_t fn)
  56 {
  57         int irq;
  58
  59         pxa_internal_irq_nr = irq_nr;
  60
  61         for (irq = 0; irq < irq_nr; irq += 32) {
  62                 _ICMR(irq) = 0; /* disable all IRQs */
  63                 _ICLR(irq) = 0; /* all IRQs are IRQ, not FIQ */
  64         }
  65
  66         /* only unmasked interrupts kick us out of idle */
  67         ICCR = 1;
  68
  69         for (irq = PXA_IRQ(0); irq < PXA_IRQ(irq_nr); irq++) {
  70                 set_irq_chip(irq, &pxa_internal_irq_chip);
  71                 set_irq_handler(irq, handle_level_irq);
  72                 set_irq_flags(irq, IRQF_VALID);
  73         }
  74
  75         pxa_internal_irq_chip.set_wake = fn;
  76 }
  77
  78 #ifdef CONFIG_PM
  79 static unsigned long saved_icmr[2];
  80
  81 static int pxa_irq_suspend(struct sys_device *dev, pm_message_t state)
  82 {
  83         int i, irq = PXA_IRQ(0);
  84
  85         for (i = 0; irq < PXA_IRQ(pxa_internal_irq_nr); i++, irq += 32) {
  86                 saved_icmr[i] = _ICMR(irq);
  87                 _ICMR(irq) = 0;
  88         }
  89
  90         return 0;
  91 }
  92
  93 static int pxa_irq_resume(struct sys_device *dev)
  94 {
  95         int i, irq = PXA_IRQ(0);
  96
  97         for (i = 0; irq < PXA_IRQ(pxa_internal_irq_nr); i++, irq += 32) {
  98                 _ICMR(irq) = saved_icmr[i];
  99                 _ICLR(irq) = 0;
 100         }
 101
 102         ICCR = 1;
 103         return 0;
 104 }
 105 #else
 106 #define pxa_irq_suspend         NULL
 107 #define pxa_irq_resume          NULL
 108 #endif
 109
 110 struct sysdev_class pxa_irq_sysclass = {
 111         .name           = "irq",
 112         .suspend        = pxa_irq_suspend,
 113         .resume         = pxa_irq_resume,
 114 };
 115
 116 static int __init pxa_irq_init(void)
 117 {
 118         return sysdev_class_register(&pxa_irq_sysclass);
 119 }
 120
 121 core_initcall(pxa_irq_init);