| 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 | } |