| Lennert Buytenhek | 01eb569 | 2008-03-27 14:51:40 -0400 | [diff] [blame] | 1 | /* | 
|  | 2 | * arch/arm/plat-orion/irq.c | 
|  | 3 | * | 
|  | 4 | * Marvell Orion SoC IRQ handling. | 
|  | 5 | * | 
|  | 6 | * This file is licensed under the terms of the GNU General Public | 
|  | 7 | * License version 2.  This program is licensed "as is" without any | 
|  | 8 | * warranty of any kind, whether express or implied. | 
|  | 9 | */ | 
|  | 10 |  | 
|  | 11 | #include <linux/kernel.h> | 
|  | 12 | #include <linux/init.h> | 
|  | 13 | #include <linux/irq.h> | 
|  | 14 | #include <linux/io.h> | 
| Lennert Buytenhek | 6f088f1 | 2008-08-09 13:44:58 +0200 | [diff] [blame] | 15 | #include <plat/irq.h> | 
| Lennert Buytenhek | 01eb569 | 2008-03-27 14:51:40 -0400 | [diff] [blame] | 16 |  | 
|  | 17 | static void orion_irq_mask(u32 irq) | 
|  | 18 | { | 
|  | 19 | void __iomem *maskaddr = get_irq_chip_data(irq); | 
|  | 20 | u32 mask; | 
|  | 21 |  | 
|  | 22 | mask = readl(maskaddr); | 
|  | 23 | mask &= ~(1 << (irq & 31)); | 
|  | 24 | writel(mask, maskaddr); | 
|  | 25 | } | 
|  | 26 |  | 
|  | 27 | static void orion_irq_unmask(u32 irq) | 
|  | 28 | { | 
|  | 29 | void __iomem *maskaddr = get_irq_chip_data(irq); | 
|  | 30 | u32 mask; | 
|  | 31 |  | 
|  | 32 | mask = readl(maskaddr); | 
|  | 33 | mask |= 1 << (irq & 31); | 
|  | 34 | writel(mask, maskaddr); | 
|  | 35 | } | 
|  | 36 |  | 
|  | 37 | static struct irq_chip orion_irq_chip = { | 
|  | 38 | .name		= "orion_irq", | 
| Lennert Buytenhek | 01eb569 | 2008-03-27 14:51:40 -0400 | [diff] [blame] | 39 | .mask		= orion_irq_mask, | 
| Lennert Buytenhek | 000e99c | 2008-05-18 19:46:59 +0200 | [diff] [blame] | 40 | .mask_ack	= orion_irq_mask, | 
| Lennert Buytenhek | 01eb569 | 2008-03-27 14:51:40 -0400 | [diff] [blame] | 41 | .unmask		= orion_irq_unmask, | 
|  | 42 | }; | 
|  | 43 |  | 
|  | 44 | void __init orion_irq_init(unsigned int irq_start, void __iomem *maskaddr) | 
|  | 45 | { | 
|  | 46 | unsigned int i; | 
|  | 47 |  | 
|  | 48 | /* | 
|  | 49 | * Mask all interrupts initially. | 
|  | 50 | */ | 
|  | 51 | writel(0, maskaddr); | 
|  | 52 |  | 
|  | 53 | /* | 
|  | 54 | * Register IRQ sources. | 
|  | 55 | */ | 
|  | 56 | for (i = 0; i < 32; i++) { | 
|  | 57 | unsigned int irq = irq_start + i; | 
|  | 58 |  | 
|  | 59 | set_irq_chip(irq, &orion_irq_chip); | 
|  | 60 | set_irq_chip_data(irq, maskaddr); | 
|  | 61 | set_irq_handler(irq, handle_level_irq); | 
| Lennert Buytenhek | 000e99c | 2008-05-18 19:46:59 +0200 | [diff] [blame] | 62 | irq_desc[irq].status |= IRQ_LEVEL; | 
| Lennert Buytenhek | 01eb569 | 2008-03-27 14:51:40 -0400 | [diff] [blame] | 63 | set_irq_flags(irq, IRQF_VALID); | 
|  | 64 | } | 
|  | 65 | } |