pic.c revision 1.14 1 1.14 matt /* $NetBSD: pic.c,v 1.14 2012/09/01 01:44:16 matt Exp $ */
2 1.2 matt /*-
3 1.2 matt * Copyright (c) 2008 The NetBSD Foundation, Inc.
4 1.2 matt * All rights reserved.
5 1.2 matt *
6 1.2 matt * This code is derived from software contributed to The NetBSD Foundation
7 1.2 matt * by Matt Thomas.
8 1.2 matt *
9 1.2 matt * Redistribution and use in source and binary forms, with or without
10 1.2 matt * modification, are permitted provided that the following conditions
11 1.2 matt * are met:
12 1.2 matt * 1. Redistributions of source code must retain the above copyright
13 1.2 matt * notice, this list of conditions and the following disclaimer.
14 1.2 matt * 2. Redistributions in binary form must reproduce the above copyright
15 1.2 matt * notice, this list of conditions and the following disclaimer in the
16 1.2 matt * documentation and/or other materials provided with the distribution.
17 1.2 matt *
18 1.2 matt * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
19 1.2 matt * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
20 1.2 matt * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
21 1.2 matt * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
22 1.2 matt * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23 1.2 matt * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24 1.2 matt * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25 1.2 matt * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26 1.2 matt * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27 1.2 matt * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28 1.2 matt * POSSIBILITY OF SUCH DAMAGE.
29 1.2 matt */
30 1.2 matt #include <sys/cdefs.h>
31 1.14 matt __KERNEL_RCSID(0, "$NetBSD: pic.c,v 1.14 2012/09/01 01:44:16 matt Exp $");
32 1.2 matt
33 1.2 matt #define _INTR_PRIVATE
34 1.2 matt #include <sys/param.h>
35 1.13 matt #include <sys/atomic.h>
36 1.13 matt #include <sys/cpu.h>
37 1.2 matt #include <sys/evcnt.h>
38 1.13 matt #include <sys/intr.h>
39 1.13 matt #include <sys/kernel.h>
40 1.11 matt #include <sys/kmem.h>
41 1.13 matt #include <sys/xcall.h>
42 1.2 matt
43 1.2 matt #include <arm/armreg.h>
44 1.2 matt #include <arm/cpufunc.h>
45 1.2 matt
46 1.2 matt #include <arm/pic/picvar.h>
47 1.2 matt
48 1.2 matt static uint32_t
49 1.2 matt pic_find_pending_irqs_by_ipl(struct pic_softc *, size_t, uint32_t, int);
50 1.2 matt static struct pic_softc *
51 1.2 matt pic_list_find_pic_by_pending_ipl(uint32_t);
52 1.2 matt static void
53 1.2 matt pic_deliver_irqs(struct pic_softc *, int, void *);
54 1.2 matt static void
55 1.2 matt pic_list_deliver_irqs(register_t, int, void *);
56 1.2 matt
57 1.2 matt struct pic_softc *pic_list[PIC_MAXPICS];
58 1.2 matt #if PIC_MAXPICS > 32
59 1.2 matt #error PIC_MAXPICS > 32 not supported
60 1.2 matt #endif
61 1.2 matt volatile uint32_t pic_blocked_pics;
62 1.2 matt volatile uint32_t pic_pending_pics;
63 1.2 matt volatile uint32_t pic_pending_ipls;
64 1.2 matt struct intrsource *pic_sources[PIC_MAXMAXSOURCES];
65 1.2 matt struct intrsource *pic__iplsources[PIC_MAXMAXSOURCES];
66 1.2 matt struct intrsource **pic_iplsource[NIPL] = {
67 1.2 matt [0 ... NIPL-1] = pic__iplsources,
68 1.2 matt };
69 1.2 matt size_t pic_ipl_offset[NIPL+1];
70 1.2 matt size_t pic_sourcebase;
71 1.2 matt static struct evcnt pic_deferral_ev =
72 1.2 matt EVCNT_INITIALIZER(EVCNT_TYPE_MISC, NULL, "deferred", "intr");
73 1.2 matt EVCNT_ATTACH_STATIC(pic_deferral_ev);
74 1.2 matt
75 1.11 matt #ifdef __HAVE_PIC_SET_PRIORITY
76 1.11 matt void
77 1.11 matt pic_set_priority(struct cpu_info *ci, int newipl)
78 1.11 matt {
79 1.13 matt register_t psw = cpsid(I32_bit);
80 1.13 matt if (pic_list[0] != NULL)
81 1.13 matt (pic_list[0]->pic_ops->pic_set_priority)(pic_list[0], newipl);
82 1.11 matt ci->ci_cpl = newipl;
83 1.13 matt if ((psw & I32_bit) == 0)
84 1.13 matt cpsie(I32_bit);
85 1.13 matt }
86 1.13 matt #endif
87 1.13 matt
88 1.13 matt #ifdef MULTIPROCESSOR
89 1.13 matt int
90 1.13 matt pic_ipi_nop(void *arg)
91 1.13 matt {
92 1.13 matt /* do nothing */
93 1.13 matt return 1;
94 1.13 matt }
95 1.13 matt
96 1.13 matt int
97 1.13 matt pic_ipi_xcall(void *arg)
98 1.13 matt {
99 1.13 matt xc_ipi_handler();
100 1.13 matt return 1;
101 1.13 matt }
102 1.13 matt
103 1.13 matt void
104 1.13 matt intr_cpu_init(struct cpu_info *ci)
105 1.13 matt {
106 1.13 matt for (size_t slot = 0; slot < PIC_MAXPICS; slot++) {
107 1.13 matt struct pic_softc * const pic = pic_list[slot];
108 1.13 matt if (pic != NULL && pic->pic_ops->pic_cpu_init != NULL) {
109 1.13 matt (*pic->pic_ops->pic_cpu_init)(pic, ci);
110 1.13 matt }
111 1.13 matt }
112 1.13 matt }
113 1.13 matt
114 1.13 matt typedef void (*pic_ipi_send_func_t)(struct pic_softc *, u_long);
115 1.13 matt
116 1.13 matt static struct pic_softc *
117 1.13 matt pic_ipi_sender(void)
118 1.13 matt {
119 1.13 matt for (size_t slot = 0; slot < PIC_MAXPICS; slot++) {
120 1.13 matt struct pic_softc * const pic = pic_list[slot];
121 1.13 matt if (pic != NULL && pic->pic_ops->pic_ipi_send != NULL) {
122 1.13 matt return pic;
123 1.13 matt }
124 1.13 matt }
125 1.13 matt return NULL;
126 1.13 matt }
127 1.13 matt
128 1.13 matt void
129 1.13 matt intr_ipi_send(const kcpuset_t *kcp, u_long ipi)
130 1.13 matt {
131 1.13 matt struct pic_softc * const pic = pic_ipi_sender();
132 1.13 matt KASSERT(ipi < NIPI);
133 1.13 matt if (cold && pic == NULL)
134 1.13 matt return;
135 1.13 matt KASSERT(pic != NULL);
136 1.13 matt (*pic->pic_ops->pic_ipi_send)(pic, kcp, ipi);
137 1.13 matt }
138 1.13 matt #endif /* MULTIPROCESSOR */
139 1.13 matt
140 1.13 matt #ifdef __HAVE_PIC_FAST_SOFTINTS
141 1.13 matt int
142 1.13 matt pic_handle_softint(void *arg)
143 1.13 matt {
144 1.13 matt void softint_switch(lwp_t *, int);
145 1.13 matt struct cpu_info * const ci = curcpu();
146 1.13 matt const size_t softint = (size_t) arg;
147 1.13 matt int s = splhigh();
148 1.13 matt ci->ci_intr_depth--; // don't count these as interrupts
149 1.13 matt softint_switch(ci->ci_softlwps[softint], s);
150 1.13 matt ci->ci_intr_depth++;
151 1.13 matt splx(s);
152 1.13 matt return 1;
153 1.11 matt }
154 1.11 matt #endif
155 1.2 matt
156 1.2 matt int
157 1.2 matt pic_handle_intr(void *arg)
158 1.2 matt {
159 1.2 matt struct pic_softc * const pic = arg;
160 1.2 matt int rv;
161 1.2 matt
162 1.2 matt rv = (*pic->pic_ops->pic_find_pending_irqs)(pic);
163 1.2 matt
164 1.2 matt return rv > 0;
165 1.2 matt }
166 1.2 matt
167 1.2 matt void
168 1.2 matt pic_mark_pending_source(struct pic_softc *pic, struct intrsource *is)
169 1.2 matt {
170 1.2 matt const uint32_t ipl_mask = __BIT(is->is_ipl);
171 1.2 matt
172 1.4 matt atomic_or_32(&pic->pic_pending_irqs[is->is_irq >> 5],
173 1.4 matt __BIT(is->is_irq & 0x1f));
174 1.2 matt
175 1.4 matt atomic_or_32(&pic->pic_pending_ipls, ipl_mask);
176 1.4 matt atomic_or_32(&pic_pending_ipls, ipl_mask);
177 1.4 matt atomic_or_32(&pic_pending_pics, __BIT(pic->pic_id));
178 1.2 matt }
179 1.2 matt
180 1.2 matt void
181 1.2 matt pic_mark_pending(struct pic_softc *pic, int irq)
182 1.2 matt {
183 1.2 matt struct intrsource * const is = pic->pic_sources[irq];
184 1.2 matt
185 1.2 matt KASSERT(irq < pic->pic_maxsources);
186 1.2 matt KASSERT(is != NULL);
187 1.2 matt
188 1.2 matt pic_mark_pending_source(pic, is);
189 1.2 matt }
190 1.2 matt
191 1.2 matt uint32_t
192 1.2 matt pic_mark_pending_sources(struct pic_softc *pic, size_t irq_base,
193 1.2 matt uint32_t pending)
194 1.2 matt {
195 1.2 matt struct intrsource ** const isbase = &pic->pic_sources[irq_base];
196 1.2 matt struct intrsource *is;
197 1.4 matt volatile uint32_t *ipending = &pic->pic_pending_irqs[irq_base >> 5];
198 1.2 matt uint32_t ipl_mask = 0;
199 1.2 matt
200 1.2 matt if (pending == 0)
201 1.2 matt return ipl_mask;
202 1.2 matt
203 1.2 matt KASSERT((irq_base & 31) == 0);
204 1.2 matt
205 1.2 matt (*pic->pic_ops->pic_block_irqs)(pic, irq_base, pending);
206 1.2 matt
207 1.4 matt atomic_or_32(ipending, pending);
208 1.2 matt while (pending != 0) {
209 1.2 matt int n = ffs(pending);
210 1.2 matt if (n-- == 0)
211 1.2 matt break;
212 1.2 matt is = isbase[n];
213 1.2 matt KASSERT(is != NULL);
214 1.2 matt KASSERT(irq_base <= is->is_irq && is->is_irq < irq_base + 32);
215 1.2 matt pending &= ~__BIT(n);
216 1.2 matt ipl_mask |= __BIT(is->is_ipl);
217 1.2 matt }
218 1.2 matt
219 1.4 matt atomic_or_32(&pic->pic_pending_ipls, ipl_mask);
220 1.4 matt atomic_or_32(&pic_pending_ipls, ipl_mask);
221 1.4 matt atomic_or_32(&pic_pending_pics, __BIT(pic->pic_id));
222 1.2 matt
223 1.2 matt return ipl_mask;
224 1.2 matt }
225 1.2 matt
226 1.2 matt uint32_t
227 1.2 matt pic_find_pending_irqs_by_ipl(struct pic_softc *pic, size_t irq_base,
228 1.2 matt uint32_t pending, int ipl)
229 1.2 matt {
230 1.2 matt uint32_t ipl_irq_mask = 0;
231 1.2 matt uint32_t irq_mask;
232 1.2 matt
233 1.2 matt for (;;) {
234 1.2 matt int irq = ffs(pending);
235 1.2 matt if (irq-- == 0)
236 1.2 matt return ipl_irq_mask;
237 1.2 matt
238 1.2 matt irq_mask = __BIT(irq);
239 1.8 bsh #if 1
240 1.10 skrll KASSERTMSG(pic->pic_sources[irq_base + irq] != NULL,
241 1.10 skrll "%s: irq_base %zu irq %d\n", __func__, irq_base, irq);
242 1.8 bsh #else
243 1.8 bsh if (pic->pic_sources[irq_base + irq] == NULL) {
244 1.8 bsh aprint_error("stray interrupt? irq_base=%zu irq=%d\n",
245 1.8 bsh irq_base, irq);
246 1.8 bsh } else
247 1.8 bsh #endif
248 1.2 matt if (pic->pic_sources[irq_base + irq]->is_ipl == ipl)
249 1.2 matt ipl_irq_mask |= irq_mask;
250 1.2 matt
251 1.2 matt pending &= ~irq_mask;
252 1.2 matt }
253 1.2 matt }
254 1.2 matt
255 1.2 matt void
256 1.2 matt pic_dispatch(struct intrsource *is, void *frame)
257 1.2 matt {
258 1.2 matt int rv;
259 1.2 matt
260 1.13 matt
261 1.2 matt if (__predict_false(is->is_arg == NULL)
262 1.2 matt && __predict_true(frame != NULL)) {
263 1.2 matt rv = (*is->is_func)(frame);
264 1.2 matt } else if (__predict_true(is->is_arg != NULL)) {
265 1.2 matt rv = (*is->is_func)(is->is_arg);
266 1.2 matt } else {
267 1.2 matt pic_deferral_ev.ev_count++;
268 1.2 matt return;
269 1.2 matt }
270 1.13 matt
271 1.13 matt struct pic_percpu * const pcpu = percpu_getref(is->is_pic->pic_percpu);
272 1.13 matt KASSERT(pcpu->pcpu_magic == PICPERCPU_MAGIC);
273 1.13 matt pcpu->pcpu_evs[is->is_irq].ev_count++;
274 1.13 matt percpu_putref(is->is_pic->pic_percpu);
275 1.2 matt }
276 1.2 matt
277 1.2 matt void
278 1.2 matt pic_deliver_irqs(struct pic_softc *pic, int ipl, void *frame)
279 1.2 matt {
280 1.2 matt const uint32_t ipl_mask = __BIT(ipl);
281 1.2 matt struct intrsource *is;
282 1.4 matt volatile uint32_t *ipending = pic->pic_pending_irqs;
283 1.4 matt volatile uint32_t *iblocked = pic->pic_blocked_irqs;
284 1.2 matt size_t irq_base;
285 1.2 matt #if PIC_MAXSOURCES > 32
286 1.2 matt size_t irq_count;
287 1.6 kiyohara int poi = 0; /* Possibility of interrupting */
288 1.2 matt #endif
289 1.2 matt uint32_t pending_irqs;
290 1.2 matt uint32_t blocked_irqs;
291 1.2 matt int irq;
292 1.2 matt bool progress = false;
293 1.2 matt
294 1.2 matt KASSERT(pic->pic_pending_ipls & ipl_mask);
295 1.2 matt
296 1.2 matt irq_base = 0;
297 1.2 matt #if PIC_MAXSOURCES > 32
298 1.2 matt irq_count = 0;
299 1.2 matt #endif
300 1.2 matt
301 1.2 matt for (;;) {
302 1.2 matt pending_irqs = pic_find_pending_irqs_by_ipl(pic, irq_base,
303 1.2 matt *ipending, ipl);
304 1.2 matt KASSERT((pending_irqs & *ipending) == pending_irqs);
305 1.2 matt KASSERT((pending_irqs & ~(*ipending)) == 0);
306 1.2 matt if (pending_irqs == 0) {
307 1.2 matt #if PIC_MAXSOURCES > 32
308 1.2 matt irq_count += 32;
309 1.6 kiyohara if (__predict_true(irq_count >= pic->pic_maxsources)) {
310 1.6 kiyohara if (!poi)
311 1.6 kiyohara /*Interrupt at this level was handled.*/
312 1.6 kiyohara break;
313 1.6 kiyohara irq_base = 0;
314 1.6 kiyohara irq_count = 0;
315 1.6 kiyohara poi = 0;
316 1.2 matt ipending = pic->pic_pending_irqs;
317 1.2 matt iblocked = pic->pic_blocked_irqs;
318 1.6 kiyohara } else {
319 1.6 kiyohara irq_base += 32;
320 1.6 kiyohara ipending++;
321 1.6 kiyohara iblocked++;
322 1.6 kiyohara KASSERT(irq_base <= pic->pic_maxsources);
323 1.2 matt }
324 1.2 matt continue;
325 1.2 matt #else
326 1.2 matt break;
327 1.2 matt #endif
328 1.2 matt }
329 1.2 matt progress = true;
330 1.5 kiyohara blocked_irqs = 0;
331 1.2 matt do {
332 1.2 matt irq = ffs(pending_irqs) - 1;
333 1.2 matt KASSERT(irq >= 0);
334 1.2 matt
335 1.4 matt atomic_and_32(ipending, ~__BIT(irq));
336 1.2 matt is = pic->pic_sources[irq_base + irq];
337 1.2 matt if (is != NULL) {
338 1.2 matt cpsie(I32_bit);
339 1.2 matt pic_dispatch(is, frame);
340 1.2 matt cpsid(I32_bit);
341 1.6 kiyohara #if PIC_MAXSOURCES > 32
342 1.6 kiyohara /*
343 1.6 kiyohara * There is a possibility of interrupting
344 1.6 kiyohara * from cpsie() to cpsid().
345 1.6 kiyohara */
346 1.6 kiyohara poi = 1;
347 1.6 kiyohara #endif
348 1.5 kiyohara blocked_irqs |= __BIT(irq);
349 1.2 matt } else {
350 1.2 matt KASSERT(0);
351 1.2 matt }
352 1.2 matt pending_irqs = pic_find_pending_irqs_by_ipl(pic,
353 1.2 matt irq_base, *ipending, ipl);
354 1.2 matt } while (pending_irqs);
355 1.2 matt if (blocked_irqs) {
356 1.4 matt atomic_or_32(iblocked, blocked_irqs);
357 1.4 matt atomic_or_32(&pic_blocked_pics, __BIT(pic->pic_id));
358 1.2 matt }
359 1.2 matt }
360 1.2 matt
361 1.2 matt KASSERT(progress);
362 1.2 matt /*
363 1.2 matt * Since interrupts are disabled, we don't have to be too careful
364 1.2 matt * about these.
365 1.2 matt */
366 1.4 matt if (atomic_and_32_nv(&pic->pic_pending_ipls, ~ipl_mask) == 0)
367 1.4 matt atomic_and_32(&pic_pending_pics, ~__BIT(pic->pic_id));
368 1.2 matt }
369 1.2 matt
370 1.2 matt static void
371 1.2 matt pic_list_unblock_irqs(void)
372 1.2 matt {
373 1.4 matt uint32_t blocked_pics = pic_blocked_pics;
374 1.2 matt
375 1.2 matt pic_blocked_pics = 0;
376 1.2 matt for (;;) {
377 1.2 matt struct pic_softc *pic;
378 1.2 matt #if PIC_MAXSOURCES > 32
379 1.4 matt volatile uint32_t *iblocked;
380 1.4 matt uint32_t blocked;
381 1.2 matt size_t irq_base;
382 1.2 matt #endif
383 1.2 matt
384 1.4 matt int pic_id = ffs(blocked_pics);
385 1.2 matt if (pic_id-- == 0)
386 1.2 matt return;
387 1.2 matt
388 1.2 matt pic = pic_list[pic_id];
389 1.2 matt KASSERT(pic != NULL);
390 1.2 matt #if PIC_MAXSOURCES > 32
391 1.2 matt for (irq_base = 0, iblocked = pic->pic_blocked_irqs;
392 1.2 matt irq_base < pic->pic_maxsources;
393 1.2 matt irq_base += 32, iblocked++) {
394 1.4 matt if ((blocked = *iblocked) != 0) {
395 1.2 matt (*pic->pic_ops->pic_unblock_irqs)(pic,
396 1.4 matt irq_base, blocked);
397 1.4 matt atomic_and_32(iblocked, ~blocked);
398 1.2 matt }
399 1.2 matt }
400 1.2 matt #else
401 1.2 matt KASSERT(pic->pic_blocked_irqs[0] != 0);
402 1.2 matt (*pic->pic_ops->pic_unblock_irqs)(pic,
403 1.2 matt 0, pic->pic_blocked_irqs[0]);
404 1.4 matt pic->pic_blocked_irqs[0] = 0;
405 1.2 matt #endif
406 1.4 matt blocked_pics &= ~__BIT(pic_id);
407 1.2 matt }
408 1.2 matt }
409 1.2 matt
410 1.2 matt
411 1.2 matt struct pic_softc *
412 1.2 matt pic_list_find_pic_by_pending_ipl(uint32_t ipl_mask)
413 1.2 matt {
414 1.4 matt uint32_t pending_pics = pic_pending_pics;
415 1.2 matt struct pic_softc *pic;
416 1.2 matt
417 1.2 matt for (;;) {
418 1.4 matt int pic_id = ffs(pending_pics);
419 1.2 matt if (pic_id-- == 0)
420 1.2 matt return NULL;
421 1.2 matt
422 1.2 matt pic = pic_list[pic_id];
423 1.2 matt KASSERT(pic != NULL);
424 1.2 matt if (pic->pic_pending_ipls & ipl_mask)
425 1.2 matt return pic;
426 1.4 matt pending_pics &= ~__BIT(pic_id);
427 1.2 matt }
428 1.2 matt }
429 1.2 matt
430 1.2 matt void
431 1.2 matt pic_list_deliver_irqs(register_t psw, int ipl, void *frame)
432 1.2 matt {
433 1.2 matt const uint32_t ipl_mask = __BIT(ipl);
434 1.2 matt struct pic_softc *pic;
435 1.2 matt
436 1.2 matt while ((pic = pic_list_find_pic_by_pending_ipl(ipl_mask)) != NULL) {
437 1.2 matt pic_deliver_irqs(pic, ipl, frame);
438 1.2 matt KASSERT((pic->pic_pending_ipls & ipl_mask) == 0);
439 1.2 matt }
440 1.4 matt atomic_and_32(&pic_pending_ipls, ~ipl_mask);
441 1.2 matt }
442 1.2 matt
443 1.2 matt void
444 1.2 matt pic_do_pending_ints(register_t psw, int newipl, void *frame)
445 1.2 matt {
446 1.2 matt struct cpu_info * const ci = curcpu();
447 1.13 matt if (__predict_false(newipl == IPL_HIGH)) {
448 1.13 matt KASSERTMSG(ci->ci_cpl == IPL_HIGH, "cpl %d", ci->ci_cpl);
449 1.2 matt return;
450 1.13 matt }
451 1.2 matt while ((pic_pending_ipls & ~__BIT(newipl)) > __BIT(newipl)) {
452 1.2 matt KASSERT(pic_pending_ipls < __BIT(NIPL));
453 1.2 matt for (;;) {
454 1.2 matt int ipl = 31 - __builtin_clz(pic_pending_ipls);
455 1.2 matt KASSERT(ipl < NIPL);
456 1.2 matt if (ipl <= newipl)
457 1.2 matt break;
458 1.2 matt
459 1.12 matt pic_set_priority(ci, ipl);
460 1.2 matt pic_list_deliver_irqs(psw, ipl, frame);
461 1.2 matt pic_list_unblock_irqs();
462 1.2 matt }
463 1.2 matt }
464 1.2 matt if (ci->ci_cpl != newipl)
465 1.11 matt pic_set_priority(ci, newipl);
466 1.13 matt }
467 1.13 matt
468 1.13 matt static void
469 1.13 matt pic_percpu_allocate(void *v0, void *v1, struct cpu_info *ci)
470 1.13 matt {
471 1.13 matt struct pic_percpu * const pcpu = v0;
472 1.13 matt struct pic_softc * const pic = v1;
473 1.13 matt
474 1.13 matt pcpu->pcpu_evs = kmem_zalloc(pic->pic_maxsources * sizeof(pcpu->pcpu_evs[0]),
475 1.13 matt KM_SLEEP);
476 1.13 matt KASSERT(pcpu->pcpu_evs != NULL);
477 1.13 matt
478 1.13 matt #define PCPU_NAMELEN 32
479 1.14 matt #ifdef DIAGNOSTIC
480 1.13 matt const size_t namelen = strlen(pic->pic_name) + 4 + strlen(ci->ci_data.cpu_name);
481 1.14 matt #endif
482 1.13 matt
483 1.13 matt KASSERT(namelen < PCPU_NAMELEN);
484 1.13 matt pcpu->pcpu_name = kmem_alloc(PCPU_NAMELEN, KM_SLEEP);
485 1.13 matt #ifdef MULTIPROCESSOR
486 1.13 matt snprintf(pcpu->pcpu_name, PCPU_NAMELEN,
487 1.13 matt "%s (%s)", pic->pic_name, ci->ci_data.cpu_name);
488 1.13 matt #else
489 1.13 matt strlcpy(pcpu->pcpu_name, pic->pic_name, PCPU_NAMELEN);
490 1.13 matt #endif
491 1.13 matt pcpu->pcpu_magic = PICPERCPU_MAGIC;
492 1.13 matt #if 0
493 1.13 matt printf("%s: %s %s: <%s>\n",
494 1.13 matt __func__, ci->ci_data.cpu_name, pic->pic_name,
495 1.13 matt pcpu->pcpu_name);
496 1.2 matt #endif
497 1.2 matt }
498 1.2 matt
499 1.2 matt void
500 1.2 matt pic_add(struct pic_softc *pic, int irqbase)
501 1.2 matt {
502 1.2 matt int slot, maybe_slot = -1;
503 1.2 matt
504 1.13 matt KASSERT(strlen(pic->pic_name) > 0);
505 1.13 matt
506 1.2 matt for (slot = 0; slot < PIC_MAXPICS; slot++) {
507 1.2 matt struct pic_softc * const xpic = pic_list[slot];
508 1.2 matt if (xpic == NULL) {
509 1.2 matt if (maybe_slot < 0)
510 1.2 matt maybe_slot = slot;
511 1.2 matt if (irqbase < 0)
512 1.2 matt break;
513 1.2 matt continue;
514 1.2 matt }
515 1.2 matt if (irqbase < 0 || xpic->pic_irqbase < 0)
516 1.2 matt continue;
517 1.2 matt if (irqbase >= xpic->pic_irqbase + xpic->pic_maxsources)
518 1.2 matt continue;
519 1.2 matt if (irqbase + pic->pic_maxsources <= xpic->pic_irqbase)
520 1.2 matt continue;
521 1.2 matt panic("pic_add: pic %s (%zu sources @ irq %u) conflicts"
522 1.2 matt " with pic %s (%zu sources @ irq %u)",
523 1.2 matt pic->pic_name, pic->pic_maxsources, irqbase,
524 1.2 matt xpic->pic_name, xpic->pic_maxsources, xpic->pic_irqbase);
525 1.2 matt }
526 1.2 matt slot = maybe_slot;
527 1.2 matt #if 0
528 1.2 matt printf("%s: pic_sourcebase=%zu pic_maxsources=%zu\n",
529 1.2 matt pic->pic_name, pic_sourcebase, pic->pic_maxsources);
530 1.2 matt #endif
531 1.9 skrll KASSERT(pic->pic_maxsources <= PIC_MAXSOURCES);
532 1.2 matt KASSERT(pic_sourcebase + pic->pic_maxsources <= PIC_MAXMAXSOURCES);
533 1.2 matt
534 1.13 matt /*
535 1.13 matt * Allocate a pointer to each cpu's evcnts and then, for each cpu,
536 1.13 matt * allocate its evcnts and then attach an evcnt for each pin.
537 1.13 matt * We can't allocate the evcnt structures directly since
538 1.13 matt * percpu will move the contents of percpu memory around and
539 1.13 matt * corrupt the pointers in the evcnts themselves. Remember, any
540 1.13 matt * problem can be solved with sufficient indirection.
541 1.13 matt */
542 1.13 matt pic->pic_percpu = percpu_alloc(sizeof(struct pic_percpu));
543 1.13 matt KASSERT(pic->pic_percpu != NULL);
544 1.13 matt
545 1.13 matt /*
546 1.13 matt * Now allocate the per-cpu evcnts.
547 1.13 matt */
548 1.13 matt percpu_foreach(pic->pic_percpu, pic_percpu_allocate, pic);
549 1.13 matt
550 1.2 matt pic->pic_sources = &pic_sources[pic_sourcebase];
551 1.2 matt pic->pic_irqbase = irqbase;
552 1.2 matt pic_sourcebase += pic->pic_maxsources;
553 1.2 matt pic->pic_id = slot;
554 1.13 matt #ifdef __HAVE_PIC_SET_PRIORITY
555 1.13 matt KASSERT((slot == 0) == (pic->pic_ops->pic_set_priority != NULL));
556 1.13 matt #endif
557 1.13 matt #ifdef MULTIPROCESSOR
558 1.13 matt KASSERT((slot == 0) == (pic->pic_ops->pic_ipi_send != NULL));
559 1.13 matt #endif
560 1.2 matt pic_list[slot] = pic;
561 1.2 matt }
562 1.2 matt
563 1.2 matt int
564 1.2 matt pic_alloc_irq(struct pic_softc *pic)
565 1.2 matt {
566 1.2 matt int irq;
567 1.2 matt
568 1.2 matt for (irq = 0; irq < pic->pic_maxsources; irq++) {
569 1.2 matt if (pic->pic_sources[irq] == NULL)
570 1.2 matt return irq;
571 1.2 matt }
572 1.2 matt
573 1.2 matt return -1;
574 1.2 matt }
575 1.2 matt
576 1.13 matt static void
577 1.13 matt pic_percpu_evcnt_attach(void *v0, void *v1, struct cpu_info *ci)
578 1.13 matt {
579 1.13 matt struct pic_percpu * const pcpu = v0;
580 1.13 matt struct intrsource * const is = v1;
581 1.13 matt
582 1.13 matt KASSERT(pcpu->pcpu_magic == PICPERCPU_MAGIC);
583 1.13 matt evcnt_attach_dynamic(&pcpu->pcpu_evs[is->is_irq], EVCNT_TYPE_INTR, NULL,
584 1.13 matt pcpu->pcpu_name, is->is_source);
585 1.13 matt }
586 1.13 matt
587 1.2 matt void *
588 1.2 matt pic_establish_intr(struct pic_softc *pic, int irq, int ipl, int type,
589 1.2 matt int (*func)(void *), void *arg)
590 1.2 matt {
591 1.2 matt struct intrsource *is;
592 1.2 matt int off, nipl;
593 1.2 matt
594 1.2 matt if (pic->pic_sources[irq]) {
595 1.2 matt printf("pic_establish_intr: pic %s irq %d already present\n",
596 1.2 matt pic->pic_name, irq);
597 1.2 matt return NULL;
598 1.2 matt }
599 1.2 matt
600 1.11 matt is = kmem_zalloc(sizeof(*is), KM_SLEEP);
601 1.2 matt if (is == NULL)
602 1.2 matt return NULL;
603 1.2 matt
604 1.2 matt is->is_pic = pic;
605 1.2 matt is->is_irq = irq;
606 1.2 matt is->is_ipl = ipl;
607 1.2 matt is->is_type = type;
608 1.2 matt is->is_func = func;
609 1.2 matt is->is_arg = arg;
610 1.13 matt
611 1.2 matt if (pic->pic_ops->pic_source_name)
612 1.2 matt (*pic->pic_ops->pic_source_name)(pic, irq, is->is_source,
613 1.2 matt sizeof(is->is_source));
614 1.2 matt else
615 1.2 matt snprintf(is->is_source, sizeof(is->is_source), "irq %d", irq);
616 1.2 matt
617 1.13 matt /*
618 1.13 matt * Now attach the per-cpu evcnts.
619 1.13 matt */
620 1.13 matt percpu_foreach(pic->pic_percpu, pic_percpu_evcnt_attach, is);
621 1.2 matt
622 1.2 matt pic->pic_sources[irq] = is;
623 1.2 matt
624 1.2 matt /*
625 1.2 matt * First try to use an existing slot which is empty.
626 1.2 matt */
627 1.2 matt for (off = pic_ipl_offset[ipl]; off < pic_ipl_offset[ipl+1]; off++) {
628 1.2 matt if (pic__iplsources[off] == NULL) {
629 1.2 matt is->is_iplidx = off - pic_ipl_offset[ipl];
630 1.2 matt pic__iplsources[off] = is;
631 1.2 matt return is;
632 1.2 matt }
633 1.2 matt }
634 1.2 matt
635 1.2 matt /*
636 1.2 matt * Move up all the sources by one.
637 1.2 matt */
638 1.2 matt if (ipl < NIPL) {
639 1.2 matt off = pic_ipl_offset[ipl+1];
640 1.2 matt memmove(&pic__iplsources[off+1], &pic__iplsources[off],
641 1.2 matt sizeof(pic__iplsources[0]) * (pic_ipl_offset[NIPL] - off));
642 1.2 matt }
643 1.2 matt
644 1.2 matt /*
645 1.2 matt * Advance the offset of all IPLs higher than this. Include an
646 1.2 matt * extra one as well. Thus the number of sources per ipl is
647 1.2 matt * pic_ipl_offset[ipl+1] - pic_ipl_offset[ipl].
648 1.2 matt */
649 1.2 matt for (nipl = ipl + 1; nipl <= NIPL; nipl++)
650 1.2 matt pic_ipl_offset[nipl]++;
651 1.2 matt
652 1.2 matt /*
653 1.2 matt * Insert into the previously made position at the end of this IPL's
654 1.2 matt * sources.
655 1.2 matt */
656 1.2 matt off = pic_ipl_offset[ipl + 1] - 1;
657 1.2 matt is->is_iplidx = off - pic_ipl_offset[ipl];
658 1.2 matt pic__iplsources[off] = is;
659 1.2 matt
660 1.2 matt (*pic->pic_ops->pic_establish_irq)(pic, is);
661 1.2 matt
662 1.2 matt (*pic->pic_ops->pic_unblock_irqs)(pic, is->is_irq & ~0x1f,
663 1.2 matt __BIT(is->is_irq & 0x1f));
664 1.2 matt
665 1.2 matt /* We're done. */
666 1.2 matt return is;
667 1.2 matt }
668 1.2 matt
669 1.13 matt static void
670 1.13 matt pic_percpu_evcnt_deattach(void *v0, void *v1, struct cpu_info *ci)
671 1.13 matt {
672 1.13 matt struct pic_percpu * const pcpu = v0;
673 1.13 matt struct intrsource * const is = v1;
674 1.13 matt
675 1.13 matt KASSERT(pcpu->pcpu_magic == PICPERCPU_MAGIC);
676 1.13 matt evcnt_detach(&pcpu->pcpu_evs[is->is_irq]);
677 1.13 matt }
678 1.13 matt
679 1.2 matt void
680 1.2 matt pic_disestablish_source(struct intrsource *is)
681 1.2 matt {
682 1.2 matt struct pic_softc * const pic = is->is_pic;
683 1.2 matt const int irq = is->is_irq;
684 1.2 matt
685 1.13 matt KASSERT(is == pic->pic_sources[irq]);
686 1.13 matt
687 1.2 matt (*pic->pic_ops->pic_block_irqs)(pic, irq & ~31, __BIT(irq));
688 1.2 matt pic->pic_sources[irq] = NULL;
689 1.2 matt pic__iplsources[pic_ipl_offset[is->is_ipl] + is->is_iplidx] = NULL;
690 1.13 matt /*
691 1.13 matt * Now detach the per-cpu evcnts.
692 1.13 matt */
693 1.13 matt percpu_foreach(pic->pic_percpu, pic_percpu_evcnt_deattach, is);
694 1.2 matt
695 1.11 matt kmem_free(is, sizeof(*is));
696 1.2 matt }
697 1.2 matt
698 1.2 matt void *
699 1.2 matt intr_establish(int irq, int ipl, int type, int (*func)(void *), void *arg)
700 1.2 matt {
701 1.11 matt KASSERT(!cpu_intr_p());
702 1.11 matt KASSERT(!cpu_softintr_p());
703 1.11 matt
704 1.13 matt for (size_t slot = 0; slot < PIC_MAXPICS; slot++) {
705 1.2 matt struct pic_softc * const pic = pic_list[slot];
706 1.2 matt if (pic == NULL || pic->pic_irqbase < 0)
707 1.2 matt continue;
708 1.2 matt if (pic->pic_irqbase <= irq
709 1.2 matt && irq < pic->pic_irqbase + pic->pic_maxsources) {
710 1.2 matt return pic_establish_intr(pic, irq - pic->pic_irqbase,
711 1.2 matt ipl, type, func, arg);
712 1.2 matt }
713 1.2 matt }
714 1.2 matt
715 1.2 matt return NULL;
716 1.2 matt }
717 1.2 matt
718 1.2 matt void
719 1.2 matt intr_disestablish(void *ih)
720 1.2 matt {
721 1.2 matt struct intrsource * const is = ih;
722 1.13 matt
723 1.13 matt KASSERT(!cpu_intr_p());
724 1.13 matt KASSERT(!cpu_softintr_p());
725 1.13 matt
726 1.2 matt pic_disestablish_source(is);
727 1.2 matt }
728