Home | History | Annotate | Line # | Download | only in pic
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