| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | * Copyright (C) 2003 Ralf Baechle | 
|  | 3 | * | 
|  | 4 | * This program is free software; you can redistribute  it and/or modify it | 
|  | 5 | * under  the terms of  the GNU General  Public License as published by the | 
|  | 6 | * Free Software Foundation;  either version 2 of the  License, or (at your | 
|  | 7 | * option) any later version. | 
|  | 8 | * | 
|  | 9 | * Handler for RM7000 extended interrupts.  These are a non-standard | 
|  | 10 | * feature so we handle them separately from standard interrupts. | 
|  | 11 | */ | 
|  | 12 | #include <linux/init.h> | 
|  | 13 | #include <linux/interrupt.h> | 
| David Howells | ca4d3e67 | 2010-10-07 14:08:54 +0100 | [diff] [blame] | 14 | #include <linux/irq.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 15 | #include <linux/kernel.h> | 
|  | 16 |  | 
|  | 17 | #include <asm/irq_cpu.h> | 
|  | 18 | #include <asm/mipsregs.h> | 
|  | 19 | #include <asm/system.h> | 
|  | 20 |  | 
| Thomas Gleixner | e059852 | 2011-03-23 21:09:00 +0000 | [diff] [blame] | 21 | static inline void unmask_rm7k_irq(struct irq_data *d) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 22 | { | 
| Thomas Gleixner | e059852 | 2011-03-23 21:09:00 +0000 | [diff] [blame] | 23 | set_c0_intcontrol(0x100 << (d->irq - RM7K_CPU_IRQ_BASE)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 24 | } | 
|  | 25 |  | 
| Thomas Gleixner | e059852 | 2011-03-23 21:09:00 +0000 | [diff] [blame] | 26 | static inline void mask_rm7k_irq(struct irq_data *d) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 27 | { | 
| Thomas Gleixner | e059852 | 2011-03-23 21:09:00 +0000 | [diff] [blame] | 28 | clear_c0_intcontrol(0x100 << (d->irq - RM7K_CPU_IRQ_BASE)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 | } | 
|  | 30 |  | 
| Ralf Baechle | 94dee17 | 2006-07-02 14:41:42 +0100 | [diff] [blame] | 31 | static struct irq_chip rm7k_irq_controller = { | 
| Atsushi Nemoto | 70d21cd | 2007-01-15 00:07:25 +0900 | [diff] [blame] | 32 | .name = "RM7000", | 
| Thomas Gleixner | e059852 | 2011-03-23 21:09:00 +0000 | [diff] [blame] | 33 | .irq_ack = mask_rm7k_irq, | 
|  | 34 | .irq_mask = mask_rm7k_irq, | 
|  | 35 | .irq_mask_ack = mask_rm7k_irq, | 
|  | 36 | .irq_unmask = unmask_rm7k_irq, | 
|  | 37 | .irq_eoi = unmask_rm7k_irq | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 38 | }; | 
|  | 39 |  | 
| Atsushi Nemoto | 97dcb82 | 2007-01-08 02:14:29 +0900 | [diff] [blame] | 40 | void __init rm7k_cpu_irq_init(void) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 41 | { | 
| Atsushi Nemoto | 97dcb82 | 2007-01-08 02:14:29 +0900 | [diff] [blame] | 42 | int base = RM7K_CPU_IRQ_BASE; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 43 | int i; | 
|  | 44 |  | 
|  | 45 | clear_c0_intcontrol(0x00000f00);		/* Mask all */ | 
|  | 46 |  | 
| Atsushi Nemoto | 1603b5a | 2006-11-02 02:08:36 +0900 | [diff] [blame] | 47 | for (i = base; i < base + 4; i++) | 
| Thomas Gleixner | e4ec798 | 2011-03-27 15:19:28 +0200 | [diff] [blame] | 48 | irq_set_chip_and_handler(i, &rm7k_irq_controller, | 
| Ralf Baechle | 30e748a | 2007-11-15 19:37:15 +0000 | [diff] [blame] | 49 | handle_percpu_irq); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 50 | } |