1
2
3
4
5
6
7#include <common.h>
8#include <irq_func.h>
9#include <mpc8xx.h>
10#include <mpc8xx_irq.h>
11#include <asm/cpm_8xx.h>
12#include <asm/processor.h>
13#include <asm/io.h>
14
15
16
17
18
19
20struct interrupt_action {
21 interrupt_handler_t *handler;
22 void *arg;
23};
24
25static struct interrupt_action cpm_vecs[CPMVEC_NR];
26static struct interrupt_action irq_vecs[NR_IRQS];
27
28static void cpm_interrupt_init(void);
29static void cpm_interrupt(void *regs);
30
31
32
33void interrupt_init_cpu(unsigned *decrementer_count)
34{
35 immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
36
37 *decrementer_count = get_tbclk() / CONFIG_SYS_HZ;
38
39
40 out_be32(&immr->im_siu_conf.sc_simask, 0);
41
42
43 cpm_interrupt_init();
44}
45
46
47
48
49
50
51void external_interrupt(struct pt_regs *regs)
52{
53 immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
54 int irq;
55 ulong simask;
56 ulong vec, v_bit;
57
58
59
60
61
62 vec = in_be32(&immr->im_siu_conf.sc_sivec);
63 irq = vec >> 26;
64 v_bit = 0x80000000UL >> irq;
65
66
67
68
69 simask = in_be32(&immr->im_siu_conf.sc_simask);
70 clrbits_be32(&immr->im_siu_conf.sc_simask, 0xFFFF0000 >> irq);
71
72 if (!(irq & 0x1)) {
73 ulong siel;
74
75
76
77
78 siel = in_be32(&immr->im_siu_conf.sc_siel);
79
80 if (siel & v_bit) {
81
82
83
84 out_be32(&immr->im_siu_conf.sc_sipend, v_bit);
85 }
86 }
87
88 if (irq_vecs[irq].handler != NULL) {
89 irq_vecs[irq].handler(irq_vecs[irq].arg);
90 } else {
91 printf("\nBogus External Interrupt IRQ %d Vector %ld\n",
92 irq, vec);
93
94 simask &= ~v_bit;
95 }
96
97
98
99 out_be32(&immr->im_siu_conf.sc_simask, simask);
100}
101
102
103
104
105
106
107static void cpm_interrupt(void *regs)
108{
109 immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
110 uint vec;
111
112
113
114
115
116 out_be16(&immr->im_cpic.cpic_civr, 1);
117 vec = in_be16(&immr->im_cpic.cpic_civr);
118 vec >>= 11;
119
120 if (cpm_vecs[vec].handler != NULL) {
121 (*cpm_vecs[vec].handler) (cpm_vecs[vec].arg);
122 } else {
123 clrbits_be32(&immr->im_cpic.cpic_cimr, 1 << vec);
124 printf("Masking bogus CPM interrupt vector 0x%x\n", vec);
125 }
126
127
128
129
130 setbits_be32(&immr->im_cpic.cpic_cisr, 1 << vec);
131}
132
133
134
135
136
137
138
139static void cpm_error_interrupt(void *dummy)
140{
141}
142
143
144
145
146
147void irq_install_handler(int vec, interrupt_handler_t *handler, void *arg)
148{
149 immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
150
151 if ((vec & CPMVEC_OFFSET) != 0) {
152
153 vec &= 0xffff;
154 if (cpm_vecs[vec].handler != NULL)
155 printf("CPM interrupt 0x%x replacing 0x%x\n",
156 (uint)handler, (uint)cpm_vecs[vec].handler);
157 cpm_vecs[vec].handler = handler;
158 cpm_vecs[vec].arg = arg;
159 setbits_be32(&immr->im_cpic.cpic_cimr, 1 << vec);
160 } else {
161
162 if (irq_vecs[vec].handler != NULL)
163 printf("SIU interrupt %d 0x%x replacing 0x%x\n",
164 vec, (uint)handler, (uint)cpm_vecs[vec].handler);
165 irq_vecs[vec].handler = handler;
166 irq_vecs[vec].arg = arg;
167 setbits_be32(&immr->im_siu_conf.sc_simask, 1 << (31 - vec));
168 }
169}
170
171void irq_free_handler(int vec)
172{
173 immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
174
175 if ((vec & CPMVEC_OFFSET) != 0) {
176
177 vec &= 0xffff;
178 clrbits_be32(&immr->im_cpic.cpic_cimr, 1 << vec);
179 cpm_vecs[vec].handler = NULL;
180 cpm_vecs[vec].arg = NULL;
181 } else {
182
183 clrbits_be32(&immr->im_siu_conf.sc_simask, 1 << (31 - vec));
184 irq_vecs[vec].handler = NULL;
185 irq_vecs[vec].arg = NULL;
186 }
187}
188
189
190
191static void cpm_interrupt_init(void)
192{
193 immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
194 uint cicr;
195
196
197
198
199
200 cicr = CICR_SCD_SCC4 | CICR_SCC_SCC3 | CICR_SCB_SCC2 | CICR_SCA_SCC1 |
201 ((CPM_INTERRUPT / 2) << 13) | CICR_HP_MASK;
202
203 out_be32(&immr->im_cpic.cpic_cicr, cicr);
204 out_be32(&immr->im_cpic.cpic_cimr, 0);
205
206
207
208
209 irq_install_handler(CPMVEC_ERROR, cpm_error_interrupt, NULL);
210
211 setbits_be32(&immr->im_cpic.cpic_cicr, CICR_IEN);
212
213
214
215
216 irq_install_handler(CPM_INTERRUPT, cpm_interrupt, NULL);
217}
218
219
220
221
222
223
224
225
226void timer_interrupt_cpu(struct pt_regs *regs)
227{
228 immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
229
230
231 out_be32(&immr->im_clkrstk.cark_plprcrk, KAPWR_KEY);
232 __asm__ ("nop");
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247 setbits_be32(&immr->im_clkrst.car_plprcr, 0);
248}
249
250
251