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 RM9000 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> |
| 14 | #include <linux/kernel.h> |
| 15 | #include <linux/module.h> |
| 16 | |
| 17 | #include <asm/irq_cpu.h> |
| 18 | #include <asm/mipsregs.h> |
| 19 | #include <asm/system.h> |
| 20 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 21 | static inline void unmask_rm9k_irq(unsigned int irq) |
| 22 | { |
Atsushi Nemoto | 97dcb82 | 2007-01-08 02:14:29 +0900 | [diff] [blame] | 23 | set_c0_intcontrol(0x1000 << (irq - RM9K_CPU_IRQ_BASE)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 24 | } |
| 25 | |
| 26 | static inline void mask_rm9k_irq(unsigned int irq) |
| 27 | { |
Atsushi Nemoto | 97dcb82 | 2007-01-08 02:14:29 +0900 | [diff] [blame] | 28 | clear_c0_intcontrol(0x1000 << (irq - RM9K_CPU_IRQ_BASE)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 | } |
| 30 | |
| 31 | static inline void rm9k_cpu_irq_enable(unsigned int irq) |
| 32 | { |
| 33 | unsigned long flags; |
| 34 | |
| 35 | local_irq_save(flags); |
| 36 | unmask_rm9k_irq(irq); |
| 37 | local_irq_restore(flags); |
| 38 | } |
| 39 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 40 | /* |
| 41 | * Performance counter interrupts are global on all processors. |
| 42 | */ |
| 43 | static void local_rm9k_perfcounter_irq_startup(void *args) |
| 44 | { |
| 45 | unsigned int irq = (unsigned int) args; |
| 46 | |
| 47 | rm9k_cpu_irq_enable(irq); |
| 48 | } |
| 49 | |
| 50 | static unsigned int rm9k_perfcounter_irq_startup(unsigned int irq) |
| 51 | { |
Jens Axboe | 15c8b6c | 2008-05-09 09:39:44 +0200 | [diff] [blame] | 52 | on_each_cpu(local_rm9k_perfcounter_irq_startup, (void *) irq, 1); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 | |
| 54 | return 0; |
| 55 | } |
| 56 | |
| 57 | static void local_rm9k_perfcounter_irq_shutdown(void *args) |
| 58 | { |
| 59 | unsigned int irq = (unsigned int) args; |
| 60 | unsigned long flags; |
| 61 | |
| 62 | local_irq_save(flags); |
| 63 | mask_rm9k_irq(irq); |
| 64 | local_irq_restore(flags); |
| 65 | } |
| 66 | |
| 67 | static void rm9k_perfcounter_irq_shutdown(unsigned int irq) |
| 68 | { |
Jens Axboe | 15c8b6c | 2008-05-09 09:39:44 +0200 | [diff] [blame] | 69 | on_each_cpu(local_rm9k_perfcounter_irq_shutdown, (void *) irq, 1); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 70 | } |
| 71 | |
Ralf Baechle | 94dee17 | 2006-07-02 14:41:42 +0100 | [diff] [blame] | 72 | static struct irq_chip rm9k_irq_controller = { |
Atsushi Nemoto | 70d21cd | 2007-01-15 00:07:25 +0900 | [diff] [blame] | 73 | .name = "RM9000", |
Atsushi Nemoto | 1603b5a | 2006-11-02 02:08:36 +0900 | [diff] [blame] | 74 | .ack = mask_rm9k_irq, |
| 75 | .mask = mask_rm9k_irq, |
| 76 | .mask_ack = mask_rm9k_irq, |
| 77 | .unmask = unmask_rm9k_irq, |
Thomas Koeller | c42d95d | 2008-02-11 23:42:12 +0100 | [diff] [blame] | 78 | .eoi = unmask_rm9k_irq |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 79 | }; |
| 80 | |
Ralf Baechle | 94dee17 | 2006-07-02 14:41:42 +0100 | [diff] [blame] | 81 | static struct irq_chip rm9k_perfcounter_irq = { |
Atsushi Nemoto | 70d21cd | 2007-01-15 00:07:25 +0900 | [diff] [blame] | 82 | .name = "RM9000", |
Ralf Baechle | 8ab00b9 | 2005-02-28 13:39:57 +0000 | [diff] [blame] | 83 | .startup = rm9k_perfcounter_irq_startup, |
| 84 | .shutdown = rm9k_perfcounter_irq_shutdown, |
Atsushi Nemoto | 1603b5a | 2006-11-02 02:08:36 +0900 | [diff] [blame] | 85 | .ack = mask_rm9k_irq, |
| 86 | .mask = mask_rm9k_irq, |
| 87 | .mask_ack = mask_rm9k_irq, |
| 88 | .unmask = unmask_rm9k_irq, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 89 | }; |
| 90 | |
| 91 | unsigned int rm9000_perfcount_irq; |
| 92 | |
| 93 | EXPORT_SYMBOL(rm9000_perfcount_irq); |
| 94 | |
Atsushi Nemoto | 97dcb82 | 2007-01-08 02:14:29 +0900 | [diff] [blame] | 95 | void __init rm9k_cpu_irq_init(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 96 | { |
Atsushi Nemoto | 97dcb82 | 2007-01-08 02:14:29 +0900 | [diff] [blame] | 97 | int base = RM9K_CPU_IRQ_BASE; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 98 | int i; |
| 99 | |
| 100 | clear_c0_intcontrol(0x0000f000); /* Mask all */ |
| 101 | |
Atsushi Nemoto | 1603b5a | 2006-11-02 02:08:36 +0900 | [diff] [blame] | 102 | for (i = base; i < base + 4; i++) |
Atsushi Nemoto | 1417836 | 2006-11-14 01:13:18 +0900 | [diff] [blame] | 103 | set_irq_chip_and_handler(i, &rm9k_irq_controller, |
| 104 | handle_level_irq); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 105 | |
| 106 | rm9000_perfcount_irq = base + 1; |
Atsushi Nemoto | 1417836 | 2006-11-14 01:13:18 +0900 | [diff] [blame] | 107 | set_irq_chip_and_handler(rm9000_perfcount_irq, &rm9k_perfcounter_irq, |
Ralf Baechle | 30e748a | 2007-11-15 19:37:15 +0000 | [diff] [blame] | 108 | handle_percpu_irq); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 109 | } |