rmixl_intr.c revision 1.1.2.2 1 1.1.2.2 cliff /* $NetBSD: rmixl_intr.c,v 1.1.2.2 2009/09/25 22:22:09 cliff Exp $ */
2 1.1.2.1 cliff
3 1.1.2.1 cliff /*-
4 1.1.2.1 cliff * Copyright (c) 2007 Ruslan Ermilov and Vsevolod Lobko.
5 1.1.2.1 cliff * All rights reserved.
6 1.1.2.1 cliff *
7 1.1.2.1 cliff * Redistribution and use in source and binary forms, with or
8 1.1.2.1 cliff * without modification, are permitted provided that the following
9 1.1.2.1 cliff * conditions are met:
10 1.1.2.1 cliff * 1. Redistributions of source code must retain the above copyright
11 1.1.2.1 cliff * notice, this list of conditions and the following disclaimer.
12 1.1.2.1 cliff * 2. Redistributions in binary form must reproduce the above
13 1.1.2.1 cliff * copyright notice, this list of conditions and the following
14 1.1.2.1 cliff * disclaimer in the documentation and/or other materials provided
15 1.1.2.1 cliff * with the distribution.
16 1.1.2.1 cliff * 3. The names of the authors may not be used to endorse or promote
17 1.1.2.1 cliff * products derived from this software without specific prior
18 1.1.2.1 cliff * written permission.
19 1.1.2.1 cliff *
20 1.1.2.1 cliff * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY
21 1.1.2.1 cliff * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
22 1.1.2.1 cliff * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
23 1.1.2.1 cliff * PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHORS
24 1.1.2.1 cliff * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
25 1.1.2.1 cliff * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
26 1.1.2.1 cliff * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
27 1.1.2.1 cliff * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
28 1.1.2.1 cliff * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
29 1.1.2.1 cliff * TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
30 1.1.2.1 cliff * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
31 1.1.2.1 cliff * OF SUCH DAMAGE.
32 1.1.2.1 cliff */
33 1.1.2.1 cliff /*-
34 1.1.2.1 cliff * Copyright (c) 2001 The NetBSD Foundation, Inc.
35 1.1.2.1 cliff * All rights reserved.
36 1.1.2.1 cliff *
37 1.1.2.1 cliff * This code is derived from software contributed to The NetBSD Foundation
38 1.1.2.1 cliff * by Jason R. Thorpe.
39 1.1.2.1 cliff *
40 1.1.2.1 cliff * Redistribution and use in source and binary forms, with or without
41 1.1.2.1 cliff * modification, are permitted provided that the following conditions
42 1.1.2.1 cliff * are met:
43 1.1.2.1 cliff * 1. Redistributions of source code must retain the above copyright
44 1.1.2.1 cliff * notice, this list of conditions and the following disclaimer.
45 1.1.2.1 cliff * 2. Redistributions in binary form must reproduce the above copyright
46 1.1.2.1 cliff * notice, this list of conditions and the following disclaimer in the
47 1.1.2.1 cliff * documentation and/or other materials provided with the distribution.
48 1.1.2.1 cliff *
49 1.1.2.1 cliff * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
50 1.1.2.1 cliff * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
51 1.1.2.1 cliff * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
52 1.1.2.1 cliff * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
53 1.1.2.1 cliff * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
54 1.1.2.1 cliff * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
55 1.1.2.1 cliff * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
56 1.1.2.1 cliff * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
57 1.1.2.1 cliff * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
58 1.1.2.1 cliff * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
59 1.1.2.1 cliff * POSSIBILITY OF SUCH DAMAGE.
60 1.1.2.1 cliff */
61 1.1.2.1 cliff
62 1.1.2.1 cliff /*
63 1.1.2.1 cliff * Platform-specific interrupt support for the RMI XLP, XLR, XLS
64 1.1.2.1 cliff */
65 1.1.2.1 cliff
66 1.1.2.1 cliff #include <sys/cdefs.h>
67 1.1.2.2 cliff __KERNEL_RCSID(0, "$NetBSD: rmixl_intr.c,v 1.1.2.2 2009/09/25 22:22:09 cliff Exp $");
68 1.1.2.1 cliff
69 1.1.2.1 cliff #include "opt_ddb.h"
70 1.1.2.1 cliff
71 1.1.2.1 cliff #include <sys/param.h>
72 1.1.2.1 cliff #include <sys/queue.h>
73 1.1.2.1 cliff #include <sys/malloc.h>
74 1.1.2.1 cliff #include <sys/systm.h>
75 1.1.2.1 cliff #include <sys/device.h>
76 1.1.2.1 cliff #include <sys/kernel.h>
77 1.1.2.1 cliff
78 1.1.2.1 cliff #include <machine/bus.h>
79 1.1.2.1 cliff #include <machine/intr.h>
80 1.1.2.1 cliff
81 1.1.2.1 cliff #include <mips/locore.h>
82 1.1.2.1 cliff #include <mips/rmi/rmixlreg.h>
83 1.1.2.1 cliff #include <mips/rmi/rmixlvar.h>
84 1.1.2.1 cliff
85 1.1.2.1 cliff #include <dev/pci/pcireg.h>
86 1.1.2.1 cliff #include <dev/pci/pcivar.h>
87 1.1.2.1 cliff
88 1.1.2.1 cliff /*
89 1.1.2.1 cliff * This is a mask of bits to clear in the SR when we go to a
90 1.1.2.1 cliff * given hardware interrupt priority level.
91 1.1.2.1 cliff */
92 1.1.2.1 cliff const uint32_t ipl_sr_bits[_IPL_N] = {
93 1.1.2.2 cliff [IPL_NONE] = 0,
94 1.1.2.2 cliff [IPL_SOFTCLOCK] =
95 1.1.2.2 cliff MIPS_SOFT_INT_MASK_0,
96 1.1.2.2 cliff [IPL_SOFTNET] =
97 1.1.2.2 cliff MIPS_SOFT_INT_MASK_0
98 1.1.2.2 cliff | MIPS_SOFT_INT_MASK_1,
99 1.1.2.2 cliff [IPL_VM] =
100 1.1.2.2 cliff MIPS_SOFT_INT_MASK_0
101 1.1.2.2 cliff | MIPS_SOFT_INT_MASK_1
102 1.1.2.2 cliff | MIPS_INT_MASK_0,
103 1.1.2.2 cliff [IPL_SCHED] =
104 1.1.2.2 cliff MIPS_SOFT_INT_MASK_0
105 1.1.2.2 cliff | MIPS_SOFT_INT_MASK_1
106 1.1.2.2 cliff | MIPS_INT_MASK_0
107 1.1.2.2 cliff | MIPS_INT_MASK_1
108 1.1.2.2 cliff | MIPS_INT_MASK_2
109 1.1.2.2 cliff | MIPS_INT_MASK_3
110 1.1.2.2 cliff | MIPS_INT_MASK_4
111 1.1.2.2 cliff | MIPS_INT_MASK_5,
112 1.1.2.1 cliff };
113 1.1.2.1 cliff
114 1.1.2.2 cliff /*
115 1.1.2.2 cliff * 'IRQs' here are indiividual interrupt sources
116 1.1.2.2 cliff * each has a slot in the Interrupt Redirection Table (IRT)
117 1.1.2.2 cliff * in the order listed
118 1.1.2.2 cliff *
119 1.1.2.2 cliff * NOTE: many irq sources depend on the chip family
120 1.1.2.2 cliff * XLS1xx vs. XLS2xx vs. XLS3xx vs. XLS6xx
121 1.1.2.2 cliff * so just use generic names where they diverge
122 1.1.2.2 cliff */
123 1.1.2.2 cliff #define NIRQS 32
124 1.1.2.2 cliff static const char *rmixl_irqnames[NIRQS] = {
125 1.1.2.2 cliff "int 0 (watchdog)", /* 0 */
126 1.1.2.2 cliff "int 1 (timer0)", /* 1 */
127 1.1.2.2 cliff "int 2 (timer1)", /* 2 */
128 1.1.2.2 cliff "int 3 (timer2)", /* 3 */
129 1.1.2.2 cliff "int 4 (timer3)", /* 4 */
130 1.1.2.2 cliff "int 5 (timer4)", /* 5 */
131 1.1.2.2 cliff "int 6 (timer5)", /* 6 */
132 1.1.2.2 cliff "int 7 (timer6)", /* 7 */
133 1.1.2.2 cliff "int 8 (timer7)", /* 8 */
134 1.1.2.2 cliff "int 9 (uart0)", /* 9 */
135 1.1.2.2 cliff "int 10 (uart1)", /* 10 */
136 1.1.2.2 cliff "int 11 (i2c0)", /* 11 */
137 1.1.2.2 cliff "int 12 (i2c1)", /* 12 */
138 1.1.2.2 cliff "int 13 (pcmcia)", /* 13 */
139 1.1.2.2 cliff "int 14 (gpio_a)", /* 14 */
140 1.1.2.2 cliff "int 15 (irq15)", /* 15 */
141 1.1.2.2 cliff "int 16 (bridge_tb)", /* 16 */
142 1.1.2.2 cliff "int 17 (gmac0)", /* 17 */
143 1.1.2.2 cliff "int 18 (gmac1)", /* 18 */
144 1.1.2.2 cliff "int 19 (gmac2)", /* 19 */
145 1.1.2.2 cliff "int 20 (gmac3)", /* 20 */
146 1.1.2.2 cliff "int 21 (irq21)", /* 21 */
147 1.1.2.2 cliff "int 22 (irq22)", /* 22 */
148 1.1.2.2 cliff "int 23 (irq23)", /* 23 */
149 1.1.2.2 cliff "int 24 (irq24)", /* 24 */
150 1.1.2.2 cliff "int 25 (bridge_err)", /* 25 */
151 1.1.2.2 cliff "int 26 (pcie_link0)", /* 26 */
152 1.1.2.2 cliff "int 27 (pcie_link1)", /* 27 */
153 1.1.2.2 cliff "int 28 (irq28)", /* 28 */
154 1.1.2.2 cliff "int 29 (irq29)", /* 29 */
155 1.1.2.2 cliff "int 30 (gpio_b)", /* 30 */
156 1.1.2.2 cliff "int 31 (usb)", /* 31 */
157 1.1.2.1 cliff };
158 1.1.2.1 cliff
159 1.1.2.2 cliff /*
160 1.1.2.2 cliff * per-IRQ event stats
161 1.1.2.2 cliff */
162 1.1.2.2 cliff struct rmixl_irqtab {
163 1.1.2.2 cliff struct evcnt irq_count;
164 1.1.2.2 cliff void *irq_ih;
165 1.1.2.1 cliff };
166 1.1.2.2 cliff static struct rmixl_irqtab rmixl_irqtab[NIRQS];
167 1.1.2.1 cliff
168 1.1.2.1 cliff
169 1.1.2.2 cliff /*
170 1.1.2.2 cliff * 'vectors' here correspond to IRT Entry vector numbers
171 1.1.2.2 cliff * - IRT Entry vector# is bit# in EIRR
172 1.1.2.2 cliff * - note that EIRR[7:0] == CAUSE[15:8]
173 1.1.2.2 cliff * - we actually only use the first _IPL_N bits
174 1.1.2.2 cliff * (less than 8)
175 1.1.2.2 cliff *
176 1.1.2.2 cliff * each IRT entry gets routed to a vector
177 1.1.2.2 cliff * (if and when that interrupt is established)
178 1.1.2.2 cliff * the vectors are shared on a per-IPL basis
179 1.1.2.2 cliff * which simplifies dispatch
180 1.1.2.2 cliff *
181 1.1.2.2 cliff * XXX use of mips64 extended IRQs is TBD
182 1.1.2.2 cliff */
183 1.1.2.2 cliff #define NINTRVECS _IPL_N
184 1.1.2.2 cliff
185 1.1.2.2 cliff /*
186 1.1.2.2 cliff * translate IPL to vector number
187 1.1.2.2 cliff */
188 1.1.2.2 cliff static const int rmixl_iplvec[_IPL_N] = {
189 1.1.2.2 cliff [IPL_NONE] = -1, /* XXX */
190 1.1.2.2 cliff [IPL_SOFTCLOCK] = 0,
191 1.1.2.2 cliff [IPL_SOFTNET] = 1,
192 1.1.2.2 cliff [IPL_VM] = 2,
193 1.1.2.2 cliff [IPL_SCHED] = 3,
194 1.1.2.1 cliff };
195 1.1.2.1 cliff
196 1.1.2.2 cliff /*
197 1.1.2.2 cliff * list and ref count manage sharing of each vector
198 1.1.2.2 cliff */
199 1.1.2.2 cliff struct rmixl_intrvec {
200 1.1.2.2 cliff LIST_HEAD(, evbmips_intrhand) iv_list;
201 1.1.2.2 cliff u_int iv_refcnt;
202 1.1.2.1 cliff };
203 1.1.2.2 cliff static struct rmixl_intrvec rmixl_intrvec[NINTRVECS];
204 1.1.2.2 cliff
205 1.1.2.2 cliff
206 1.1.2.2 cliff /*
207 1.1.2.2 cliff * register byte order is BIG ENDIAN regardless of code model
208 1.1.2.2 cliff */
209 1.1.2.2 cliff #define REG_DEREF(o) \
210 1.1.2.2 cliff *((volatile uint32_t *)MIPS_PHYS_TO_KSEG1( \
211 1.1.2.2 cliff rmixl_configuration.rc_io_pbase \
212 1.1.2.2 cliff + RMIXL_IO_DEV_PIC + (o)))
213 1.1.2.1 cliff
214 1.1.2.2 cliff #define REG_READ(o) be32toh(REG_DEREF(o))
215 1.1.2.2 cliff #define REG_WRITE(o,v) REG_DEREF(o) = htobe32(v)
216 1.1.2.1 cliff
217 1.1.2.1 cliff void
218 1.1.2.1 cliff evbmips_intr_init(void)
219 1.1.2.1 cliff {
220 1.1.2.2 cliff uint32_t r;
221 1.1.2.1 cliff int i;
222 1.1.2.1 cliff
223 1.1.2.2 cliff for (i=0; i < NIRQS; i++) {
224 1.1.2.2 cliff evcnt_attach_dynamic(&rmixl_irqtab[i].irq_count,
225 1.1.2.2 cliff EVCNT_TYPE_INTR, NULL, "rmixl", rmixl_irqnames[i]);
226 1.1.2.2 cliff rmixl_irqtab[i].irq_ih = NULL;
227 1.1.2.1 cliff }
228 1.1.2.1 cliff
229 1.1.2.2 cliff for (i=0; i < NINTRVECS; i++) {
230 1.1.2.2 cliff LIST_INIT(&rmixl_intrvec[i].iv_list);
231 1.1.2.2 cliff rmixl_intrvec[i].iv_refcnt = 0;
232 1.1.2.1 cliff }
233 1.1.2.1 cliff
234 1.1.2.2 cliff /*
235 1.1.2.2 cliff * disable watchdog, watchdog NMI, timers
236 1.1.2.2 cliff */
237 1.1.2.2 cliff r = REG_READ(RMIXL_PIC_CONTROL);
238 1.1.2.2 cliff r &= RMIXL_PIC_CONTROL_RESV;
239 1.1.2.2 cliff REG_WRITE(RMIXL_PIC_CONTROL, r);
240 1.1.2.2 cliff
241 1.1.2.2 cliff /*
242 1.1.2.2 cliff * invalidate all IRT Entries
243 1.1.2.2 cliff * permanently unmask Thread#0 in low word
244 1.1.2.2 cliff * (assume we only have 1 thread)
245 1.1.2.2 cliff */
246 1.1.2.2 cliff for (i=0; i < NIRQS; i++) {
247 1.1.2.2 cliff
248 1.1.2.2 cliff /* high word */
249 1.1.2.2 cliff r = REG_READ(RMIXL_PIC_IRTENTRYC1(i));
250 1.1.2.2 cliff r &= RMIXL_PIC_IRTENTRYC1_RESV;
251 1.1.2.2 cliff REG_WRITE(RMIXL_PIC_IRTENTRYC1(i), r);
252 1.1.2.2 cliff
253 1.1.2.2 cliff /* low word */
254 1.1.2.2 cliff r = REG_READ(RMIXL_PIC_IRTENTRYC0(i));
255 1.1.2.2 cliff r &= RMIXL_PIC_IRTENTRYC0_RESV;
256 1.1.2.2 cliff r |= 1; /* Thread Mask */
257 1.1.2.2 cliff REG_WRITE(RMIXL_PIC_IRTENTRYC0(i), r);
258 1.1.2.2 cliff }
259 1.1.2.1 cliff }
260 1.1.2.1 cliff
261 1.1.2.1 cliff void *
262 1.1.2.2 cliff rmixl_intr_establish(int irq, int ipl, rmixl_intr_trigger_t trigger,
263 1.1.2.2 cliff rmixl_intr_polarity_t polarity, int (*func)(void *), void *arg)
264 1.1.2.1 cliff {
265 1.1.2.1 cliff struct evbmips_intrhand *ih;
266 1.1.2.2 cliff uint32_t irtc1;
267 1.1.2.2 cliff int vec;
268 1.1.2.2 cliff int s;
269 1.1.2.1 cliff
270 1.1.2.2 cliff /*
271 1.1.2.2 cliff * check args and assemble an IRT Entry
272 1.1.2.2 cliff */
273 1.1.2.1 cliff if (irq < 0 || irq >= NIRQS)
274 1.1.2.2 cliff panic("%s: irq %d out of range, max %d",
275 1.1.2.2 cliff __func__, irq, NIRQS - 1);
276 1.1.2.2 cliff if (ipl < 0 || ipl >= _IPL_N)
277 1.1.2.2 cliff panic("%s: ipl %d out of range, max %d",
278 1.1.2.2 cliff __func__, ipl, _IPL_N - 1);
279 1.1.2.2 cliff if (rmixl_irqtab[irq].irq_ih != NULL)
280 1.1.2.2 cliff panic("%s: irq %d busy", __func__, irq);
281 1.1.2.2 cliff
282 1.1.2.2 cliff irtc1 = RMIXL_PIC_IRTENTRYC1_VALID;
283 1.1.2.2 cliff irtc1 |= RMIXL_PIC_IRTENTRYC1_GL; /* local */
284 1.1.2.2 cliff
285 1.1.2.2 cliff switch (trigger) {
286 1.1.2.2 cliff case RMIXL_INTR_EDGE:
287 1.1.2.2 cliff break;
288 1.1.2.2 cliff case RMIXL_INTR_LEVEL:
289 1.1.2.2 cliff irtc1 |= RMIXL_PIC_IRTENTRYC1_TRG;
290 1.1.2.2 cliff break;
291 1.1.2.2 cliff default:
292 1.1.2.2 cliff panic("%s: bad trigger %d\n", __func__, trigger);
293 1.1.2.2 cliff }
294 1.1.2.1 cliff
295 1.1.2.2 cliff switch (polarity) {
296 1.1.2.2 cliff case RMIXL_INTR_RISING:
297 1.1.2.2 cliff case RMIXL_INTR_HIGH:
298 1.1.2.2 cliff break;
299 1.1.2.2 cliff case RMIXL_INTR_FALLING:
300 1.1.2.2 cliff case RMIXL_INTR_LOW:
301 1.1.2.2 cliff irtc1 |= RMIXL_PIC_IRTENTRYC1_P;
302 1.1.2.2 cliff break;
303 1.1.2.2 cliff default:
304 1.1.2.2 cliff panic("%s: bad polarity %d\n", __func__, polarity);
305 1.1.2.2 cliff }
306 1.1.2.2 cliff
307 1.1.2.2 cliff /*
308 1.1.2.2 cliff * ipl determines which vector to use
309 1.1.2.2 cliff */
310 1.1.2.2 cliff vec = rmixl_iplvec[ipl];
311 1.1.2.2 cliff printf("%s: ipl=%d, vec=%d\n", __func__, ipl, vec);
312 1.1.2.2 cliff KASSERT((vec & ~RMIXL_PIC_IRTENTRYC1_INTVEC) == 0);
313 1.1.2.2 cliff irtc1 |= vec;
314 1.1.2.2 cliff
315 1.1.2.2 cliff /*
316 1.1.2.2 cliff * allocate and initialize an interrupt handle
317 1.1.2.2 cliff */
318 1.1.2.1 cliff ih = malloc(sizeof(*ih), M_DEVBUF, M_NOWAIT);
319 1.1.2.1 cliff if (ih == NULL)
320 1.1.2.1 cliff return NULL;
321 1.1.2.1 cliff
322 1.1.2.1 cliff ih->ih_func = func;
323 1.1.2.1 cliff ih->ih_arg = arg;
324 1.1.2.1 cliff ih->ih_irq = irq;
325 1.1.2.2 cliff ih->ih_ipl = ipl;
326 1.1.2.1 cliff
327 1.1.2.1 cliff s = splhigh();
328 1.1.2.1 cliff
329 1.1.2.1 cliff /*
330 1.1.2.2 cliff * mark this irq as established, busy
331 1.1.2.1 cliff */
332 1.1.2.2 cliff rmixl_irqtab[irq].irq_ih = ih;
333 1.1.2.1 cliff
334 1.1.2.2 cliff /*
335 1.1.2.2 cliff * link this ih into the tables and bump reference count
336 1.1.2.2 cliff */
337 1.1.2.2 cliff LIST_INSERT_HEAD(&rmixl_intrvec[vec].iv_list, ih, ih_q);
338 1.1.2.2 cliff rmixl_intrvec[vec].iv_refcnt++;
339 1.1.2.1 cliff
340 1.1.2.1 cliff /*
341 1.1.2.2 cliff * establish IRT Entry (low word only)
342 1.1.2.1 cliff */
343 1.1.2.2 cliff REG_WRITE(RMIXL_PIC_IRTENTRYC1(irq), irtc1);
344 1.1.2.1 cliff
345 1.1.2.1 cliff splx(s);
346 1.1.2.1 cliff
347 1.1.2.1 cliff return ih;
348 1.1.2.1 cliff }
349 1.1.2.1 cliff
350 1.1.2.1 cliff void
351 1.1.2.1 cliff rmixl_intr_disestablish(void *cookie)
352 1.1.2.1 cliff {
353 1.1.2.1 cliff struct evbmips_intrhand *ih = cookie;
354 1.1.2.2 cliff uint32_t r;
355 1.1.2.2 cliff int irq;
356 1.1.2.2 cliff int vec;
357 1.1.2.2 cliff int s;
358 1.1.2.1 cliff
359 1.1.2.1 cliff irq = ih->ih_irq;
360 1.1.2.2 cliff vec = rmixl_iplvec[ih->ih_ipl];
361 1.1.2.1 cliff
362 1.1.2.1 cliff s = splhigh();
363 1.1.2.1 cliff
364 1.1.2.1 cliff /*
365 1.1.2.2 cliff * remove from the table and adjust the reference count
366 1.1.2.1 cliff */
367 1.1.2.1 cliff LIST_REMOVE(ih, ih_q);
368 1.1.2.2 cliff rmixl_intrvec[vec].iv_refcnt--;
369 1.1.2.1 cliff
370 1.1.2.1 cliff /*
371 1.1.2.2 cliff * disable the IRT Entry (low word only)
372 1.1.2.1 cliff */
373 1.1.2.2 cliff r = REG_READ(RMIXL_PIC_IRTENTRYC1(irq));
374 1.1.2.2 cliff r &= RMIXL_PIC_IRTENTRYC1_RESV;
375 1.1.2.2 cliff REG_WRITE(RMIXL_PIC_IRTENTRYC1(irq), r);
376 1.1.2.1 cliff
377 1.1.2.2 cliff /*
378 1.1.2.2 cliff * this irq now disestablished, not busy
379 1.1.2.2 cliff */
380 1.1.2.2 cliff rmixl_irqtab[irq].irq_ih = NULL;
381 1.1.2.1 cliff
382 1.1.2.1 cliff splx(s);
383 1.1.2.1 cliff
384 1.1.2.1 cliff free(ih, M_DEVBUF);
385 1.1.2.1 cliff }
386 1.1.2.1 cliff
387 1.1.2.1 cliff void
388 1.1.2.1 cliff evbmips_iointr(uint32_t status, uint32_t cause, uint32_t pc, uint32_t ipending)
389 1.1.2.1 cliff {
390 1.1.2.1 cliff struct evbmips_intrhand *ih;
391 1.1.2.2 cliff uint64_t eirr;
392 1.1.2.2 cliff uint64_t eimr;
393 1.1.2.2 cliff uint32_t sr;
394 1.1.2.2 cliff int vec;
395 1.1.2.2 cliff
396 1.1.2.2 cliff printf("\n%s: status: %#x, cause %#x\n", __func__, status, cause);
397 1.1.2.2 cliff asm volatile ("mfc0 %0, $9, 6;" :"=r"(sr));
398 1.1.2.2 cliff printf("%s:%d: SR: %#x\n", __func__, __LINE__, sr);
399 1.1.2.2 cliff asm volatile ("dmfc0 %0, $9, 7;" :"=r"(eimr));
400 1.1.2.2 cliff printf("%s: EIMR: %#lx\n", __func__, eimr);
401 1.1.2.1 cliff
402 1.1.2.2 cliff for (vec = NINTRVECS - 1; vec >= 0; vec--) {
403 1.1.2.2 cliff if ((ipending & (MIPS_SOFT_INT_MASK_0 << vec)) == 0)
404 1.1.2.1 cliff continue;
405 1.1.2.1 cliff
406 1.1.2.2 cliff /* ack this vec in the EIRR */
407 1.1.2.2 cliff eirr = (1 << vec);
408 1.1.2.2 cliff asm volatile ("dmtc0 %0, $9, 6;" :: "r"(eirr));
409 1.1.2.2 cliff
410 1.1.2.2 cliff LIST_FOREACH(ih, &rmixl_intrvec[vec].iv_list, ih_q) {
411 1.1.2.2 cliff if ((*ih->ih_func)(ih->ih_arg) != 0)
412 1.1.2.2 cliff rmixl_irqtab[ih->ih_irq].irq_count.ev_count++;
413 1.1.2.1 cliff }
414 1.1.2.2 cliff cause &= ~(MIPS_SOFT_INT_MASK_0 << vec);
415 1.1.2.1 cliff }
416 1.1.2.1 cliff
417 1.1.2.1 cliff /* Re-enable anything that we have processed. */
418 1.1.2.2 cliff printf("%s:%d: re-enable: %#x\n", __func__, __LINE__,
419 1.1.2.2 cliff MIPS_SR_INT_IE | ((status & ~cause) & MIPS_HARD_INT_MASK));
420 1.1.2.1 cliff _splset(MIPS_SR_INT_IE | ((status & ~cause) & MIPS_HARD_INT_MASK));
421 1.1.2.2 cliff
422 1.1.2.2 cliff asm volatile ("mfc0 %0, $9, 6;" :"=r"(sr));
423 1.1.2.2 cliff printf("%s: SR: %#x\n", __func__, sr);
424 1.1.2.2 cliff
425 1.1.2.2 cliff asm volatile ("dmfc0 %0, $9, 6;" :"=r"(eirr));
426 1.1.2.2 cliff printf("%s: EIRR: %#lx\n", __func__, eirr);
427 1.1.2.2 cliff
428 1.1.2.2 cliff asm volatile ("dmfc0 %0, $9, 7;" :"=r"(eimr));
429 1.1.2.2 cliff printf("%s: EIMR: %#lx\n", __func__, eimr);
430 1.1.2.1 cliff }
431