Commit | Line | Data |
---|---|---|
bf3a00f8 PM |
1 | /* |
2 | * Interrupt handling for INTC2-based IRQ. | |
3 | * | |
4 | * Copyright (C) 2001 David J. Mckay (david.mckay@st.com) | |
5 | * Copyright (C) 2005, 2006 Paul Mundt (lethal@linux-sh.org) | |
6 | * | |
7 | * May be copied or modified under the terms of the GNU General Public | |
8 | * License. See linux/COPYING for more information. | |
9 | * | |
10 | * These are the "new Hitachi style" interrupts, as present on the | |
11 | * Hitachi 7751, the STM ST40 STB1, SH7760, and SH7780. | |
12 | */ | |
bf3a00f8 | 13 | #include <linux/kernel.h> |
9a7ef6d5 | 14 | #include <linux/interrupt.h> |
66a74057 | 15 | #include <linux/io.h> |
027e56e6 | 16 | #include <asm/smp.h> |
9a7ef6d5 | 17 | |
d619500a MD |
18 | static inline struct intc2_desc *get_intc2_desc(unsigned int irq) |
19 | { | |
20 | struct irq_chip *chip = get_irq_chip(irq); | |
21 | return (void *)((char *)chip - offsetof(struct intc2_desc, chip)); | |
22 | } | |
bf3a00f8 PM |
23 | |
24 | static void disable_intc2_irq(unsigned int irq) | |
25 | { | |
525ccc45 | 26 | struct intc2_data *p = get_irq_chip_data(irq); |
d619500a | 27 | struct intc2_desc *d = get_intc2_desc(irq); |
027e56e6 PM |
28 | |
29 | ctrl_outl(1 << p->msk_shift, d->msk_base + p->msk_offset + | |
30 | (hard_smp_processor_id() * 4)); | |
bf3a00f8 PM |
31 | } |
32 | ||
33 | static void enable_intc2_irq(unsigned int irq) | |
34 | { | |
525ccc45 | 35 | struct intc2_data *p = get_irq_chip_data(irq); |
d619500a | 36 | struct intc2_desc *d = get_intc2_desc(irq); |
027e56e6 PM |
37 | |
38 | ctrl_outl(1 << p->msk_shift, d->mskclr_base + p->msk_offset + | |
39 | (hard_smp_processor_id() * 4)); | |
bf3a00f8 PM |
40 | } |
41 | ||
bf3a00f8 PM |
42 | /* |
43 | * Setup an INTC2 style interrupt. | |
44 | * NOTE: Unlike IPR interrupts, parameters are not shifted by this code, | |
45 | * allowing the use of the numbers straight out of the datasheet. | |
46 | * For example: | |
47 | * PIO1 which is INTPRI00[19,16] and INTMSK00[13] | |
48 | * would be: ^ ^ ^ ^ | |
49 | * | | | | | |
66a74057 PM |
50 | * { 84, 0, 16, 0, 13 }, |
51 | * | |
52 | * in the intc2_data table. | |
bf3a00f8 | 53 | */ |
d619500a | 54 | void register_intc2_controller(struct intc2_desc *desc) |
bf3a00f8 | 55 | { |
66a74057 | 56 | int i; |
bf3a00f8 | 57 | |
d619500a MD |
58 | desc->chip.mask = disable_intc2_irq; |
59 | desc->chip.unmask = enable_intc2_irq; | |
60 | desc->chip.mask_ack = disable_intc2_irq; | |
61 | ||
62 | for (i = 0; i < desc->nr_irqs; i++) { | |
66a74057 | 63 | unsigned long ipr, flags; |
d619500a | 64 | struct intc2_data *p = desc->intc2_data + i; |
bf3a00f8 | 65 | |
66a74057 | 66 | disable_irq_nosync(p->irq); |
bf3a00f8 | 67 | |
d619500a MD |
68 | if (desc->prio_base) { |
69 | /* Set the priority level */ | |
70 | local_irq_save(flags); | |
bf3a00f8 | 71 | |
d619500a MD |
72 | ipr = ctrl_inl(desc->prio_base + p->ipr_offset); |
73 | ipr &= ~(0xf << p->ipr_shift); | |
74 | ipr |= p->priority << p->ipr_shift; | |
75 | ctrl_outl(ipr, desc->prio_base + p->ipr_offset); | |
bf3a00f8 | 76 | |
d619500a MD |
77 | local_irq_restore(flags); |
78 | } | |
bf3a00f8 | 79 | |
d619500a | 80 | set_irq_chip_and_handler_name(p->irq, &desc->chip, |
66a74057 PM |
81 | handle_level_irq, "level"); |
82 | set_irq_chip_data(p->irq, p); | |
bf3a00f8 | 83 | |
d619500a | 84 | disable_intc2_irq(p->irq); |
66a74057 | 85 | } |
bf3a00f8 | 86 | } |