1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32#include <linux/init.h>
33#include <linux/types.h>
34#include <linux/interrupt.h>
35
36#include <asm/io.h>
37#include <asm/mipsregs.h>
38#include <asm/txx9/generic.h>
39#include <asm/txx9/jmr3927.h>
40
41#if JMR3927_IRQ_END > NR_IRQS
42#error JMR3927_IRQ_END > NR_IRQS
43#endif
44
45
46
47
48
49static void mask_irq_ioc(unsigned int irq)
50{
51
52 unsigned int irq_nr = irq - JMR3927_IRQ_IOC;
53 unsigned char imask = jmr3927_ioc_reg_in(JMR3927_IOC_INTM_ADDR);
54 unsigned int bit = 1 << irq_nr;
55 jmr3927_ioc_reg_out(imask & ~bit, JMR3927_IOC_INTM_ADDR);
56
57 (void)jmr3927_ioc_reg_in(JMR3927_IOC_REV_ADDR);
58}
59static void unmask_irq_ioc(unsigned int irq)
60{
61
62 unsigned int irq_nr = irq - JMR3927_IRQ_IOC;
63 unsigned char imask = jmr3927_ioc_reg_in(JMR3927_IOC_INTM_ADDR);
64 unsigned int bit = 1 << irq_nr;
65 jmr3927_ioc_reg_out(imask | bit, JMR3927_IOC_INTM_ADDR);
66
67 (void)jmr3927_ioc_reg_in(JMR3927_IOC_REV_ADDR);
68}
69
70static int jmr3927_ioc_irqroute(void)
71{
72 unsigned char istat = jmr3927_ioc_reg_in(JMR3927_IOC_INTS2_ADDR);
73 int i;
74
75 for (i = 0; i < JMR3927_NR_IRQ_IOC; i++) {
76 if (istat & (1 << i))
77 return JMR3927_IRQ_IOC + i;
78 }
79 return -1;
80}
81
82static int jmr3927_irq_dispatch(int pending)
83{
84 int irq;
85
86 if ((pending & CAUSEF_IP7) == 0)
87 return -1;
88 irq = (pending >> CAUSEB_IP2) & 0x0f;
89 irq += JMR3927_IRQ_IRC;
90 if (irq == JMR3927_IRQ_IOCINT)
91 irq = jmr3927_ioc_irqroute();
92 return irq;
93}
94
95static struct irq_chip jmr3927_irq_ioc = {
96 .name = "jmr3927_ioc",
97 .ack = mask_irq_ioc,
98 .mask = mask_irq_ioc,
99 .mask_ack = mask_irq_ioc,
100 .unmask = unmask_irq_ioc,
101};
102
103void __init jmr3927_irq_setup(void)
104{
105 int i;
106
107 txx9_irq_dispatch = jmr3927_irq_dispatch;
108
109
110
111
112
113 jmr3927_ioc_reg_out(0, JMR3927_IOC_INTM_ADDR);
114
115 jmr3927_ioc_reg_out(JMR3927_IOC_INTF_SOFT, JMR3927_IOC_INTP_ADDR);
116
117
118 jmr3927_ioc_reg_out(0, JMR3927_IOC_INTS1_ADDR);
119
120 jmr3927_ioc_reg_out(0, JMR3927_IOC_RESET_ADDR);
121
122 tx3927_irq_init();
123 for (i = JMR3927_IRQ_IOC; i < JMR3927_IRQ_IOC + JMR3927_NR_IRQ_IOC; i++)
124 set_irq_chip_and_handler(i, &jmr3927_irq_ioc, handle_level_irq);
125
126
127 set_irq_chained_handler(JMR3927_IRQ_IOCINT, handle_simple_irq);
128}
129