Home | History | Annotate | Line # | Download | only in cortex
gic.c revision 1.1.2.4
      1  1.1.2.2       tls /*	$NetBSD: gic.c,v 1.1.2.4 2017/12/03 11:35:52 jdolecek Exp $	*/
      2      1.1      matt /*-
      3      1.1      matt  * Copyright (c) 2012 The NetBSD Foundation, Inc.
      4      1.1      matt  * All rights reserved.
      5      1.1      matt  *
      6      1.1      matt  * This code is derived from software contributed to The NetBSD Foundation
      7      1.1      matt  * by Matt Thomas of 3am Software Foundry.
      8      1.1      matt  *
      9      1.1      matt  * Redistribution and use in source and binary forms, with or without
     10      1.1      matt  * modification, are permitted provided that the following conditions
     11      1.1      matt  * are met:
     12      1.1      matt  * 1. Redistributions of source code must retain the above copyright
     13      1.1      matt  *    notice, this list of conditions and the following disclaimer.
     14      1.1      matt  * 2. Redistributions in binary form must reproduce the above copyright
     15      1.1      matt  *    notice, this list of conditions and the following disclaimer in the
     16      1.1      matt  *    documentation and/or other materials provided with the distribution.
     17      1.1      matt  *
     18      1.1      matt  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     19      1.1      matt  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     20      1.1      matt  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     21      1.1      matt  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     22      1.1      matt  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     23      1.1      matt  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     24      1.1      matt  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     25      1.1      matt  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     26      1.1      matt  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     27      1.1      matt  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     28      1.1      matt  * POSSIBILITY OF SUCH DAMAGE.
     29      1.1      matt  */
     30      1.1      matt 
     31  1.1.2.3       tls #include "opt_ddb.h"
     32  1.1.2.4  jdolecek #include "opt_multiprocessor.h"
     33  1.1.2.3       tls 
     34      1.1      matt #define _INTR_PRIVATE
     35      1.1      matt 
     36      1.1      matt #include <sys/cdefs.h>
     37  1.1.2.2       tls __KERNEL_RCSID(0, "$NetBSD: gic.c,v 1.1.2.4 2017/12/03 11:35:52 jdolecek Exp $");
     38      1.1      matt 
     39      1.1      matt #include <sys/param.h>
     40      1.1      matt #include <sys/bus.h>
     41  1.1.2.4  jdolecek #include <sys/cpu.h>
     42      1.1      matt #include <sys/device.h>
     43      1.1      matt #include <sys/evcnt.h>
     44      1.1      matt #include <sys/intr.h>
     45      1.1      matt #include <sys/proc.h>
     46      1.1      matt 
     47      1.1      matt #include <arm/armreg.h>
     48      1.1      matt #include <arm/cpufunc.h>
     49      1.1      matt #include <arm/atomic.h>
     50      1.1      matt 
     51      1.1      matt #include <arm/cortex/gic_reg.h>
     52      1.1      matt #include <arm/cortex/mpcore_var.h>
     53      1.1      matt 
     54  1.1.2.4  jdolecek void armgic_irq_handler(void *);
     55  1.1.2.4  jdolecek 
     56  1.1.2.4  jdolecek #define	ARMGIC_SGI_IPIBASE	0
     57  1.1.2.4  jdolecek 
     58  1.1.2.4  jdolecek /*
     59  1.1.2.4  jdolecek  * SGIs 8-16 are reserved for use by ARM Trusted Firmware.
     60  1.1.2.4  jdolecek  */
     61  1.1.2.4  jdolecek __CTASSERT(ARMGIC_SGI_IPIBASE + NIPI <= 8);
     62      1.1      matt 
     63      1.1      matt static int armgic_match(device_t, cfdata_t, void *);
     64      1.1      matt static void armgic_attach(device_t, device_t, void *);
     65      1.1      matt 
     66      1.1      matt static void armgic_set_priority(struct pic_softc *, int);
     67      1.1      matt static void armgic_unblock_irqs(struct pic_softc *, size_t, uint32_t);
     68      1.1      matt static void armgic_block_irqs(struct pic_softc *, size_t, uint32_t);
     69      1.1      matt static void armgic_establish_irq(struct pic_softc *, struct intrsource *);
     70      1.1      matt #if 0
     71      1.1      matt static void armgic_source_name(struct pic_softc *, int, char *, size_t);
     72      1.1      matt #endif
     73      1.1      matt 
     74      1.1      matt #ifdef MULTIPROCESSOR
     75      1.1      matt static void armgic_cpu_init(struct pic_softc *, struct cpu_info *);
     76      1.1      matt static void armgic_ipi_send(struct pic_softc *, const kcpuset_t *, u_long);
     77      1.1      matt #endif
     78      1.1      matt 
     79      1.1      matt static const struct pic_ops armgic_picops = {
     80      1.1      matt 	.pic_unblock_irqs = armgic_unblock_irqs,
     81      1.1      matt 	.pic_block_irqs = armgic_block_irqs,
     82      1.1      matt 	.pic_establish_irq = armgic_establish_irq,
     83      1.1      matt #if 0
     84      1.1      matt 	.pic_source_name = armgic_source_name,
     85      1.1      matt #endif
     86      1.1      matt 	.pic_set_priority = armgic_set_priority,
     87      1.1      matt #ifdef MULTIPROCESSOR
     88      1.1      matt 	.pic_cpu_init = armgic_cpu_init,
     89      1.1      matt 	.pic_ipi_send = armgic_ipi_send,
     90      1.1      matt #endif
     91      1.1      matt };
     92      1.1      matt 
     93      1.1      matt #define	PICTOSOFTC(pic)		((struct armgic_softc *)(pic))
     94      1.1      matt 
     95      1.1      matt static struct armgic_softc {
     96      1.1      matt 	struct pic_softc sc_pic;
     97      1.1      matt 	device_t sc_dev;
     98      1.1      matt 	bus_space_tag_t sc_memt;
     99  1.1.2.2       tls 	bus_space_handle_t sc_gicch;
    100  1.1.2.2       tls 	bus_space_handle_t sc_gicdh;
    101      1.1      matt 	size_t sc_gic_lines;
    102      1.1      matt 	uint32_t sc_gic_type;
    103      1.1      matt 	uint32_t sc_gic_valid_lines[1024/32];
    104      1.1      matt 	uint32_t sc_enabled_local;
    105  1.1.2.3       tls #ifdef MULTIPROCESSOR
    106  1.1.2.3       tls 	uint32_t sc_mptargets;
    107  1.1.2.3       tls #endif
    108  1.1.2.4  jdolecek 	uint32_t sc_bptargets;
    109      1.1      matt } armgic_softc = {
    110      1.1      matt 	.sc_pic = {
    111      1.1      matt 		.pic_ops = &armgic_picops,
    112      1.1      matt 		.pic_name = "armgic",
    113      1.1      matt 	},
    114      1.1      matt };
    115      1.1      matt 
    116      1.1      matt static struct intrsource armgic_dummy_source;
    117      1.1      matt 
    118      1.1      matt __CTASSERT(NIPL == 8);
    119      1.1      matt 
    120      1.1      matt /*
    121  1.1.2.3       tls  * GIC register are always in little-endian.  It is assumed the bus_space
    122  1.1.2.3       tls  * will do any endian conversion required.
    123      1.1      matt  */
    124      1.1      matt static inline uint32_t
    125      1.1      matt gicc_read(struct armgic_softc *sc, bus_size_t o)
    126      1.1      matt {
    127  1.1.2.3       tls 	return bus_space_read_4(sc->sc_memt, sc->sc_gicch, o);
    128      1.1      matt }
    129      1.1      matt 
    130      1.1      matt static inline void
    131      1.1      matt gicc_write(struct armgic_softc *sc, bus_size_t o, uint32_t v)
    132      1.1      matt {
    133  1.1.2.2       tls 	bus_space_write_4(sc->sc_memt, sc->sc_gicch, o, v);
    134      1.1      matt }
    135      1.1      matt 
    136      1.1      matt static inline uint32_t
    137      1.1      matt gicd_read(struct armgic_softc *sc, bus_size_t o)
    138      1.1      matt {
    139  1.1.2.3       tls 	return bus_space_read_4(sc->sc_memt, sc->sc_gicdh, o);
    140      1.1      matt }
    141      1.1      matt 
    142      1.1      matt static inline void
    143      1.1      matt gicd_write(struct armgic_softc *sc, bus_size_t o, uint32_t v)
    144      1.1      matt {
    145  1.1.2.2       tls 	bus_space_write_4(sc->sc_memt, sc->sc_gicdh, o, v);
    146      1.1      matt }
    147      1.1      matt 
    148  1.1.2.4  jdolecek static uint32_t
    149  1.1.2.4  jdolecek gicd_find_targets(struct armgic_softc *sc)
    150  1.1.2.4  jdolecek {
    151  1.1.2.4  jdolecek 	uint32_t targets = 0;
    152  1.1.2.4  jdolecek 
    153  1.1.2.4  jdolecek 	/*
    154  1.1.2.4  jdolecek 	 * GICD_ITARGETSR0 through 7 are read-only, and each field returns
    155  1.1.2.4  jdolecek 	 * a value that corresponds only to the processor reading the
    156  1.1.2.4  jdolecek 	 * register. Use this to determine the current processor's
    157  1.1.2.4  jdolecek 	 * CPU interface number.
    158  1.1.2.4  jdolecek 	 */
    159  1.1.2.4  jdolecek 	for (int i = 0; i < 8; i++) {
    160  1.1.2.4  jdolecek 		targets = gicd_read(sc, GICD_ITARGETSRn(i));
    161  1.1.2.4  jdolecek 		if (targets != 0)
    162  1.1.2.4  jdolecek 			break;
    163  1.1.2.4  jdolecek 	}
    164  1.1.2.4  jdolecek 	targets |= (targets >> 16);
    165  1.1.2.4  jdolecek 	targets |= (targets >> 8);
    166  1.1.2.4  jdolecek 	targets &= 0xff;
    167  1.1.2.4  jdolecek 
    168  1.1.2.4  jdolecek 	return targets ? targets : 1;
    169  1.1.2.4  jdolecek }
    170  1.1.2.4  jdolecek 
    171      1.1      matt /*
    172      1.1      matt  * In the GIC prioritization scheme, lower numbers have higher priority.
    173  1.1.2.3       tls  * Only write priorities that could be non-secure.
    174      1.1      matt  */
    175      1.1      matt static inline uint32_t
    176      1.1      matt armgic_ipl_to_priority(int ipl)
    177      1.1      matt {
    178  1.1.2.3       tls 	return GICC_PMR_NONSECURE
    179  1.1.2.3       tls 	    | ((IPL_HIGH - ipl) * GICC_PMR_NS_PRIORITIES / NIPL);
    180      1.1      matt }
    181      1.1      matt 
    182  1.1.2.3       tls #if 0
    183      1.1      matt static inline int
    184      1.1      matt armgic_priority_to_ipl(uint32_t priority)
    185      1.1      matt {
    186  1.1.2.3       tls 	return IPL_HIGH
    187  1.1.2.3       tls 	    - (priority & ~GICC_PMR_NONSECURE) * NIPL / GICC_PMR_NS_PRIORITIES;
    188      1.1      matt }
    189  1.1.2.3       tls #endif
    190      1.1      matt 
    191      1.1      matt static void
    192      1.1      matt armgic_unblock_irqs(struct pic_softc *pic, size_t irq_base, uint32_t irq_mask)
    193      1.1      matt {
    194      1.1      matt 	struct armgic_softc * const sc = PICTOSOFTC(pic);
    195      1.1      matt 	const size_t group = irq_base / 32;
    196      1.1      matt 
    197      1.1      matt 	if (group == 0)
    198      1.1      matt 		sc->sc_enabled_local |= irq_mask;
    199      1.1      matt 
    200      1.1      matt 	gicd_write(sc, GICD_ISENABLERn(group), irq_mask);
    201      1.1      matt }
    202      1.1      matt 
    203      1.1      matt static void
    204      1.1      matt armgic_block_irqs(struct pic_softc *pic, size_t irq_base, uint32_t irq_mask)
    205      1.1      matt {
    206      1.1      matt 	struct armgic_softc * const sc = PICTOSOFTC(pic);
    207      1.1      matt 	const size_t group = irq_base / 32;
    208      1.1      matt 
    209      1.1      matt 	if (group == 0)
    210      1.1      matt 		sc->sc_enabled_local &= ~irq_mask;
    211      1.1      matt 
    212      1.1      matt 	gicd_write(sc, GICD_ICENABLERn(group), irq_mask);
    213      1.1      matt }
    214      1.1      matt 
    215      1.1      matt static void
    216      1.1      matt armgic_set_priority(struct pic_softc *pic, int ipl)
    217      1.1      matt {
    218      1.1      matt 	struct armgic_softc * const sc = PICTOSOFTC(pic);
    219      1.1      matt 
    220      1.1      matt 	const uint32_t priority = armgic_ipl_to_priority(ipl);
    221      1.1      matt 	gicc_write(sc, GICC_PMR, priority);
    222      1.1      matt }
    223      1.1      matt 
    224      1.1      matt #ifdef __HAVE_PIC_FAST_SOFTINTS
    225      1.1      matt void
    226      1.1      matt softint_init_md(lwp_t *l, u_int level, uintptr_t *machdep_p)
    227      1.1      matt {
    228      1.1      matt 	lwp_t **lp = &l->l_cpu->ci_softlwps[level];
    229      1.1      matt 	KASSERT(*lp == NULL || *lp == l);
    230      1.1      matt 	*lp = l;
    231      1.1      matt 	/*
    232      1.1      matt 	 * Really easy.  Just tell it to trigger the local CPU.
    233      1.1      matt 	 */
    234      1.1      matt 	*machdep_p = GICD_SGIR_TargetListFilter_Me
    235      1.1      matt 	    | __SHIFTIN(level, GICD_SGIR_SGIINTID);
    236      1.1      matt }
    237      1.1      matt 
    238      1.1      matt void
    239      1.1      matt softint_trigger(uintptr_t machdep)
    240      1.1      matt {
    241      1.1      matt 
    242      1.1      matt 	gicd_write(&armgic_softc, GICD_SGIR, machdep);
    243      1.1      matt }
    244      1.1      matt #endif
    245      1.1      matt 
    246      1.1      matt void
    247      1.1      matt armgic_irq_handler(void *tf)
    248      1.1      matt {
    249      1.1      matt 	struct cpu_info * const ci = curcpu();
    250      1.1      matt 	struct armgic_softc * const sc = &armgic_softc;
    251      1.1      matt 	const int old_ipl = ci->ci_cpl;
    252      1.1      matt #ifdef DIAGNOSTIC
    253      1.1      matt 	const int old_mtx_count = ci->ci_mtx_count;
    254      1.1      matt 	const int old_l_biglocks = ci->ci_curlwp->l_biglocks;
    255      1.1      matt #endif
    256      1.1      matt #ifdef DEBUG
    257      1.1      matt 	size_t n = 0;
    258      1.1      matt #endif
    259      1.1      matt 
    260      1.1      matt 	ci->ci_data.cpu_nintr++;
    261      1.1      matt 
    262      1.1      matt 	KASSERTMSG(old_ipl != IPL_HIGH, "old_ipl %d pmr %#x hppir %#x",
    263      1.1      matt 	    old_ipl, gicc_read(sc, GICC_PMR), gicc_read(sc, GICC_HPPIR));
    264      1.1      matt 
    265      1.1      matt 	for (;;) {
    266      1.1      matt 		uint32_t iar = gicc_read(sc, GICC_IAR);
    267      1.1      matt 		uint32_t irq = __SHIFTOUT(iar, GICC_IAR_IRQ);
    268  1.1.2.4  jdolecek 
    269  1.1.2.4  jdolecek 		if (irq == GICC_IAR_IRQ_SPURIOUS ||
    270  1.1.2.4  jdolecek 		    irq == GICC_IAR_IRQ_SSPURIOUS) {
    271      1.1      matt 			iar = gicc_read(sc, GICC_IAR);
    272      1.1      matt 			irq = __SHIFTOUT(iar, GICC_IAR_IRQ);
    273      1.1      matt 			if (irq == GICC_IAR_IRQ_SPURIOUS)
    274      1.1      matt 				break;
    275  1.1.2.4  jdolecek 			if (irq == GICC_IAR_IRQ_SSPURIOUS) {
    276  1.1.2.4  jdolecek 				break;
    277  1.1.2.4  jdolecek 			}
    278      1.1      matt 		}
    279      1.1      matt 
    280      1.1      matt 		//const uint32_t cpuid = __SHIFTOUT(iar, GICC_IAR_CPUID_MASK);
    281      1.1      matt 		struct intrsource * const is = sc->sc_pic.pic_sources[irq];
    282  1.1.2.1       tls 		KASSERT(is != &armgic_dummy_source);
    283      1.1      matt 
    284      1.1      matt 		/*
    285      1.1      matt 		 * GIC has asserted IPL for us so we can just update ci_cpl.
    286      1.1      matt 		 *
    287      1.1      matt 		 * But it's not that simple.  We may have already bumped ci_cpl
    288      1.1      matt 		 * due to a high priority interrupt and now we are about to
    289      1.1      matt 		 * dispatch one lower than the previous.  It's possible for
    290      1.1      matt 		 * that previous interrupt to have deferred some interrupts
    291      1.1      matt 		 * so we need deal with those when lowering to the current
    292      1.1      matt 		 * interrupt's ipl.
    293      1.1      matt 		 *
    294      1.1      matt 		 * However, if are just raising ipl, we can just update ci_cpl.
    295      1.1      matt 		 */
    296      1.1      matt 		const int ipl = is->is_ipl;
    297      1.1      matt 		if (__predict_false(ipl < ci->ci_cpl)) {
    298      1.1      matt 			pic_do_pending_ints(I32_bit, ipl, tf);
    299      1.1      matt 			KASSERT(ci->ci_cpl == ipl);
    300      1.1      matt 		} else {
    301      1.1      matt 			KASSERTMSG(ipl > ci->ci_cpl, "ipl %d cpl %d hw-ipl %#x",
    302      1.1      matt 			    ipl, ci->ci_cpl,
    303      1.1      matt 			    gicc_read(sc, GICC_PMR));
    304      1.1      matt 			gicc_write(sc, GICC_PMR, armgic_ipl_to_priority(ipl));
    305      1.1      matt 			ci->ci_cpl = ipl;
    306      1.1      matt 		}
    307      1.1      matt 		cpsie(I32_bit);
    308      1.1      matt 		pic_dispatch(is, tf);
    309      1.1      matt 		cpsid(I32_bit);
    310      1.1      matt 		gicc_write(sc, GICC_EOIR, iar);
    311      1.1      matt #ifdef DEBUG
    312      1.1      matt 		n++;
    313      1.1      matt 		KDASSERTMSG(n < 5, "%s: processed too many (%zu)",
    314      1.1      matt 		    ci->ci_data.cpu_name, n);
    315      1.1      matt #endif
    316      1.1      matt 	}
    317      1.1      matt 
    318      1.1      matt 	/*
    319      1.1      matt 	 * Now handle any pending ints.
    320      1.1      matt 	 */
    321      1.1      matt 	KASSERT(old_ipl != IPL_HIGH);
    322      1.1      matt 	pic_do_pending_ints(I32_bit, old_ipl, tf);
    323      1.1      matt 	KASSERTMSG(ci->ci_cpl == old_ipl, "ci_cpl %d old_ipl %d", ci->ci_cpl, old_ipl);
    324      1.1      matt 	KASSERT(old_mtx_count == ci->ci_mtx_count);
    325      1.1      matt 	KASSERT(old_l_biglocks == ci->ci_curlwp->l_biglocks);
    326      1.1      matt }
    327      1.1      matt 
    328      1.1      matt void
    329      1.1      matt armgic_establish_irq(struct pic_softc *pic, struct intrsource *is)
    330      1.1      matt {
    331      1.1      matt 	struct armgic_softc * const sc = PICTOSOFTC(pic);
    332      1.1      matt 	const size_t group = is->is_irq / 32;
    333      1.1      matt 	const u_int irq = is->is_irq & 31;
    334      1.1      matt 	const u_int byte_shift = 8 * (irq & 3);
    335      1.1      matt 	const u_int twopair_shift = 2 * (irq & 15);
    336      1.1      matt 
    337      1.1      matt 	KASSERTMSG(sc->sc_gic_valid_lines[group] & __BIT(irq),
    338      1.1      matt 	    "irq %u: not valid (group[%zu]=0x%08x [0x%08x])",
    339      1.1      matt 	    is->is_irq, group, sc->sc_gic_valid_lines[group],
    340      1.1      matt 	    (uint32_t)__BIT(irq));
    341  1.1.2.4  jdolecek 
    342      1.1      matt 	KASSERTMSG(is->is_type == IST_LEVEL || is->is_type == IST_EDGE,
    343      1.1      matt 	    "irq %u: type %u unsupported", is->is_irq, is->is_type);
    344      1.1      matt 
    345      1.1      matt 	const bus_size_t targets_reg = GICD_ITARGETSRn(is->is_irq / 4);
    346      1.1      matt 	const bus_size_t cfg_reg = GICD_ICFGRn(is->is_irq / 16);
    347      1.1      matt 	uint32_t targets = gicd_read(sc, targets_reg);
    348      1.1      matt 	uint32_t cfg = gicd_read(sc, cfg_reg);
    349      1.1      matt 
    350      1.1      matt 	if (group > 0) {
    351  1.1.2.4  jdolecek 		/*
    352      1.1      matt 		 * There are 4 irqs per TARGETS register.  For now bind
    353      1.1      matt 		 * to the primary cpu.
    354      1.1      matt 		 */
    355      1.1      matt 		targets &= ~(0xff << byte_shift);
    356  1.1.2.4  jdolecek #if 0
    357  1.1.2.3       tls #ifdef MULTIPROCESSOR
    358  1.1.2.3       tls 		if (is->is_mpsafe) {
    359  1.1.2.4  jdolecek 			targets |= sc->sc_mptargets << byte_shift;
    360  1.1.2.3       tls 		} else
    361  1.1.2.3       tls #endif
    362  1.1.2.4  jdolecek #endif
    363  1.1.2.4  jdolecek 		targets |= sc->sc_bptargets << byte_shift;
    364      1.1      matt 		gicd_write(sc, targets_reg, targets);
    365      1.1      matt 
    366  1.1.2.4  jdolecek 		/*
    367      1.1      matt 		 * There are 16 irqs per CFG register.  10=EDGE 00=LEVEL
    368      1.1      matt 		 */
    369      1.1      matt 		uint32_t new_cfg = cfg;
    370      1.1      matt 		uint32_t old_cfg = (cfg >> twopair_shift) & 3;
    371      1.1      matt 		if (is->is_type == IST_LEVEL && (old_cfg & 2) != 0) {
    372      1.1      matt 			new_cfg &= ~(3 << twopair_shift);
    373      1.1      matt 		} else if (is->is_type == IST_EDGE && (old_cfg & 2) == 0) {
    374      1.1      matt 			new_cfg |= 2 << twopair_shift;
    375      1.1      matt 		}
    376      1.1      matt 		if (new_cfg != cfg) {
    377  1.1.2.4  jdolecek 			gicd_write(sc, cfg_reg, new_cfg);
    378      1.1      matt 		}
    379  1.1.2.3       tls #ifdef MULTIPROCESSOR
    380  1.1.2.3       tls 	} else {
    381  1.1.2.3       tls 		/*
    382  1.1.2.3       tls 		 * All group 0 interrupts are per processor and MPSAFE by
    383  1.1.2.3       tls 		 * default.
    384  1.1.2.3       tls 		 */
    385  1.1.2.3       tls 		is->is_mpsafe = true;
    386  1.1.2.3       tls #endif
    387      1.1      matt 	}
    388      1.1      matt 
    389  1.1.2.4  jdolecek 	/*
    390      1.1      matt 	 * There are 4 irqs per PRIORITY register.  Map the IPL
    391      1.1      matt 	 * to GIC priority.
    392      1.1      matt 	 */
    393      1.1      matt 	const bus_size_t priority_reg = GICD_IPRIORITYRn(is->is_irq / 4);
    394      1.1      matt 	uint32_t priority = gicd_read(sc, priority_reg);
    395      1.1      matt 	priority &= ~(0xff << byte_shift);
    396      1.1      matt 	priority |= armgic_ipl_to_priority(is->is_ipl) << byte_shift;
    397      1.1      matt 	gicd_write(sc, priority_reg, priority);
    398      1.1      matt }
    399      1.1      matt 
    400      1.1      matt #ifdef MULTIPROCESSOR
    401      1.1      matt static void
    402      1.1      matt armgic_cpu_init_priorities(struct armgic_softc *sc)
    403      1.1      matt {
    404  1.1.2.4  jdolecek 	/* Set lowest priority, i.e. disable interrupts */
    405  1.1.2.4  jdolecek 	for (size_t i = 0; i < 32; i += 4) {
    406  1.1.2.4  jdolecek 		const bus_size_t priority_reg = GICD_IPRIORITYRn(i / 4);
    407  1.1.2.4  jdolecek 		gicd_write(sc, priority_reg, ~0);
    408  1.1.2.4  jdolecek 	}
    409  1.1.2.4  jdolecek }
    410  1.1.2.4  jdolecek 
    411  1.1.2.4  jdolecek static void
    412  1.1.2.4  jdolecek armgic_cpu_update_priorities(struct armgic_softc *sc)
    413  1.1.2.4  jdolecek {
    414      1.1      matt 	uint32_t enabled = sc->sc_enabled_local;
    415      1.1      matt 	for (size_t i = 0; i < 32; i += 4, enabled >>= 4) {
    416      1.1      matt 		const bus_size_t priority_reg = GICD_IPRIORITYRn(i / 4);
    417      1.1      matt 		uint32_t priority = gicd_read(sc, priority_reg);
    418      1.1      matt 		uint32_t byte_mask = 0xff;
    419      1.1      matt 		size_t byte_shift = 0;
    420      1.1      matt 		for (size_t j = 0; j < 4; j++, byte_mask <<= 8, byte_shift += 8) {
    421      1.1      matt 			struct intrsource * const is = sc->sc_pic.pic_sources[i+j];
    422  1.1.2.4  jdolecek 			priority |= byte_mask;
    423      1.1      matt 			if (is == NULL || is == &armgic_dummy_source)
    424      1.1      matt 				continue;
    425      1.1      matt 			priority &= ~byte_mask;
    426      1.1      matt 			priority |= armgic_ipl_to_priority(is->is_ipl) << byte_shift;
    427      1.1      matt 		}
    428      1.1      matt 		gicd_write(sc, priority_reg, priority);
    429      1.1      matt 	}
    430      1.1      matt }
    431      1.1      matt 
    432  1.1.2.3       tls static void
    433  1.1.2.3       tls armgic_cpu_init_targets(struct armgic_softc *sc)
    434  1.1.2.3       tls {
    435  1.1.2.3       tls 	/*
    436  1.1.2.4  jdolecek 	 * Update the mpsafe targets
    437  1.1.2.3       tls 	 */
    438  1.1.2.4  jdolecek 	for (size_t irq = 32; irq < sc->sc_pic.pic_maxsources; irq++) {
    439  1.1.2.3       tls 		struct intrsource * const is = sc->sc_pic.pic_sources[irq];
    440  1.1.2.3       tls 		const bus_size_t targets_reg = GICD_ITARGETSRn(irq / 4);
    441  1.1.2.3       tls 		if (is != NULL && is->is_mpsafe) {
    442  1.1.2.4  jdolecek 			const u_int byte_shift = 8 * (irq & 3);
    443  1.1.2.3       tls 			uint32_t targets = gicd_read(sc, targets_reg);
    444  1.1.2.3       tls 			targets |= sc->sc_mptargets << byte_shift;
    445  1.1.2.3       tls 			gicd_write(sc, targets_reg, targets);
    446  1.1.2.3       tls 		}
    447  1.1.2.3       tls 	}
    448  1.1.2.3       tls }
    449  1.1.2.3       tls 
    450      1.1      matt void
    451      1.1      matt armgic_cpu_init(struct pic_softc *pic, struct cpu_info *ci)
    452      1.1      matt {
    453      1.1      matt 	struct armgic_softc * const sc = PICTOSOFTC(pic);
    454  1.1.2.4  jdolecek 	sc->sc_mptargets |= gicd_find_targets(sc);
    455      1.1      matt 	KASSERTMSG(ci->ci_cpl == IPL_HIGH, "ipl %d not IPL_HIGH", ci->ci_cpl);
    456  1.1.2.4  jdolecek 	armgic_cpu_init_priorities(sc);
    457  1.1.2.3       tls 	if (!CPU_IS_PRIMARY(ci)) {
    458  1.1.2.4  jdolecek 		if (popcount(sc->sc_mptargets) != 1) {
    459  1.1.2.3       tls 			armgic_cpu_init_targets(sc);
    460  1.1.2.3       tls 		}
    461  1.1.2.3       tls 		if (sc->sc_enabled_local) {
    462  1.1.2.4  jdolecek 			armgic_cpu_update_priorities(sc);
    463  1.1.2.3       tls 			gicd_write(sc, GICD_ISENABLERn(0),
    464  1.1.2.3       tls 			    sc->sc_enabled_local);
    465  1.1.2.3       tls 		}
    466  1.1.2.3       tls 	}
    467      1.1      matt 	gicc_write(sc, GICC_PMR, armgic_ipl_to_priority(ci->ci_cpl));	// set PMR
    468      1.1      matt 	gicc_write(sc, GICC_CTRL, GICC_CTRL_V1_Enable);	// enable interrupt
    469      1.1      matt 	cpsie(I32_bit);					// allow IRQ exceptions
    470      1.1      matt }
    471      1.1      matt 
    472      1.1      matt void
    473      1.1      matt armgic_ipi_send(struct pic_softc *pic, const kcpuset_t *kcp, u_long ipi)
    474      1.1      matt {
    475      1.1      matt 	struct armgic_softc * const sc = PICTOSOFTC(pic);
    476      1.1      matt 
    477  1.1.2.3       tls #if 0
    478      1.1      matt 	if (ipi == IPI_NOP) {
    479      1.1      matt 		__asm __volatile("sev");
    480      1.1      matt 		return;
    481      1.1      matt 	}
    482  1.1.2.3       tls #endif
    483      1.1      matt 
    484  1.1.2.3       tls 	uint32_t sgir = __SHIFTIN(ARMGIC_SGI_IPIBASE + ipi, GICD_SGIR_SGIINTID);
    485  1.1.2.3       tls 	if (kcp != NULL) {
    486  1.1.2.3       tls 		uint32_t targets;
    487  1.1.2.3       tls 		kcpuset_export_u32(kcp, &targets, sizeof(targets));
    488  1.1.2.3       tls 		sgir |= __SHIFTIN(targets, GICD_SGIR_TargetList);
    489  1.1.2.3       tls 		sgir |= GICD_SGIR_TargetListFilter_List;
    490  1.1.2.3       tls 	} else {
    491  1.1.2.3       tls 		if (ncpu == 1)
    492  1.1.2.3       tls 			return;
    493  1.1.2.3       tls 		sgir |= GICD_SGIR_TargetListFilter_NotMe;
    494  1.1.2.3       tls 	}
    495      1.1      matt 
    496      1.1      matt 	gicd_write(sc, GICD_SGIR, sgir);
    497      1.1      matt }
    498      1.1      matt #endif
    499      1.1      matt 
    500      1.1      matt int
    501      1.1      matt armgic_match(device_t parent, cfdata_t cf, void *aux)
    502      1.1      matt {
    503      1.1      matt 	struct mpcore_attach_args * const mpcaa = aux;
    504      1.1      matt 
    505      1.1      matt 	if (strcmp(cf->cf_name, mpcaa->mpcaa_name) != 0)
    506      1.1      matt 		return 0;
    507  1.1.2.2       tls 	if (!CPU_ID_CORTEX_P(cputype) || CPU_ID_CORTEX_A8_P(cputype))
    508      1.1      matt 		return 0;
    509      1.1      matt 
    510      1.1      matt 	return 1;
    511      1.1      matt }
    512      1.1      matt 
    513      1.1      matt void
    514      1.1      matt armgic_attach(device_t parent, device_t self, void *aux)
    515      1.1      matt {
    516      1.1      matt 	struct armgic_softc * const sc = &armgic_softc;
    517      1.1      matt 	struct mpcore_attach_args * const mpcaa = aux;
    518      1.1      matt 
    519      1.1      matt 	sc->sc_dev = self;
    520      1.1      matt 	self->dv_private = sc;
    521      1.1      matt 
    522      1.1      matt 	sc->sc_memt = mpcaa->mpcaa_memt;	/* provided for us */
    523  1.1.2.2       tls 	bus_space_subregion(sc->sc_memt, mpcaa->mpcaa_memh, mpcaa->mpcaa_off1,
    524  1.1.2.2       tls 	    4096, &sc->sc_gicdh);
    525  1.1.2.2       tls 	bus_space_subregion(sc->sc_memt, mpcaa->mpcaa_memh, mpcaa->mpcaa_off2,
    526  1.1.2.2       tls 	    4096, &sc->sc_gicch);
    527      1.1      matt 
    528      1.1      matt 	sc->sc_gic_type = gicd_read(sc, GICD_TYPER);
    529      1.1      matt 	sc->sc_pic.pic_maxsources = GICD_TYPER_LINES(sc->sc_gic_type);
    530      1.1      matt 
    531      1.1      matt 	gicc_write(sc, GICC_CTRL, 0);	/* disable all interrupts */
    532      1.1      matt 	gicd_write(sc, GICD_CTRL, 0);	/* disable all interrupts */
    533      1.1      matt 
    534      1.1      matt 	gicc_write(sc, GICC_PMR, 0xff);
    535      1.1      matt 	uint32_t pmr = gicc_read(sc, GICC_PMR);
    536      1.1      matt 	u_int priorities = 1 << popcount32(pmr);
    537      1.1      matt 
    538  1.1.2.4  jdolecek 	const uint32_t iidr = gicc_read(sc, GICC_IIDR);
    539  1.1.2.4  jdolecek 	const int iidr_prod = __SHIFTOUT(iidr, GICC_IIDR_ProductID);
    540  1.1.2.4  jdolecek 	const int iidr_arch = __SHIFTOUT(iidr, GICC_IIDR_ArchVersion);
    541  1.1.2.4  jdolecek 	const int iidr_rev = __SHIFTOUT(iidr, GICC_IIDR_Revision);
    542  1.1.2.4  jdolecek 	const int iidr_imp = __SHIFTOUT(iidr, GICC_IIDR_Implementer);
    543  1.1.2.4  jdolecek 
    544  1.1.2.4  jdolecek 	/*
    545  1.1.2.4  jdolecek 	 * Find the boot processor's CPU interface number.
    546  1.1.2.4  jdolecek 	 */
    547  1.1.2.4  jdolecek 	sc->sc_bptargets = gicd_find_targets(sc);
    548  1.1.2.4  jdolecek 
    549      1.1      matt 	/*
    550      1.1      matt 	 * Let's find out how many real sources we have.
    551      1.1      matt 	 */
    552      1.1      matt 	for (size_t i = 0, group = 0;
    553      1.1      matt 	     i < sc->sc_pic.pic_maxsources;
    554      1.1      matt 	     i += 32, group++) {
    555      1.1      matt 		/*
    556      1.1      matt 		 * To figure what sources are real, one enables all interrupts
    557      1.1      matt 		 * and then reads back the enable mask so which ones really
    558      1.1      matt 		 * got enabled.
    559      1.1      matt 		 */
    560      1.1      matt 		gicd_write(sc, GICD_ISENABLERn(group), 0xffffffff);
    561      1.1      matt 		uint32_t valid = gicd_read(sc, GICD_ISENABLERn(group));
    562      1.1      matt 
    563      1.1      matt 		/*
    564      1.1      matt 		 * Now disable (clear enable) them again.
    565      1.1      matt 		 */
    566      1.1      matt 		gicd_write(sc, GICD_ICENABLERn(group), valid);
    567      1.1      matt 
    568      1.1      matt 		/*
    569      1.1      matt 		 * Count how many are valid.
    570      1.1      matt 		 */
    571      1.1      matt 		sc->sc_gic_lines += popcount32(valid);
    572      1.1      matt 		sc->sc_gic_valid_lines[group] = valid;
    573      1.1      matt 	}
    574      1.1      matt 
    575  1.1.2.3       tls 	aprint_normal(": Generic Interrupt Controller, "
    576  1.1.2.3       tls 	    "%zu sources (%zu valid)\n",
    577  1.1.2.3       tls 	    sc->sc_pic.pic_maxsources, sc->sc_gic_lines);
    578  1.1.2.4  jdolecek 	aprint_debug_dev(sc->sc_dev, "Architecture version %d"
    579  1.1.2.4  jdolecek 	    " (0x%x:%d rev %d)\n", iidr_arch, iidr_imp, iidr_prod,
    580  1.1.2.4  jdolecek 	    iidr_rev);
    581  1.1.2.3       tls 
    582  1.1.2.4  jdolecek #ifdef MULTIPROCESSOR
    583  1.1.2.4  jdolecek 	sc->sc_pic.pic_cpus = kcpuset_running;
    584  1.1.2.4  jdolecek #endif
    585      1.1      matt 	pic_add(&sc->sc_pic, 0);
    586      1.1      matt 
    587      1.1      matt 	/*
    588      1.1      matt 	 * Force the GICD to IPL_HIGH and then enable interrupts.
    589      1.1      matt 	 */
    590      1.1      matt 	struct cpu_info * const ci = curcpu();
    591      1.1      matt 	KASSERTMSG(ci->ci_cpl == IPL_HIGH, "ipl %d not IPL_HIGH", ci->ci_cpl);
    592      1.1      matt 	armgic_set_priority(&sc->sc_pic, ci->ci_cpl);	// set PMR
    593      1.1      matt 	gicd_write(sc, GICD_CTRL, GICD_CTRL_Enable);	// enable Distributer
    594      1.1      matt 	gicc_write(sc, GICC_CTRL, GICC_CTRL_V1_Enable);	// enable CPU interrupts
    595      1.1      matt 	cpsie(I32_bit);					// allow interrupt exceptions
    596      1.1      matt 
    597      1.1      matt 	/*
    598      1.1      matt 	 * For each line that isn't valid, we set the intrsource for it to
    599      1.1      matt 	 * point at a dummy source so that pic_intr_establish will fail for it.
    600      1.1      matt 	 */
    601      1.1      matt 	for (size_t i = 0, group = 0;
    602      1.1      matt 	     i < sc->sc_pic.pic_maxsources;
    603      1.1      matt 	     i += 32, group++) {
    604      1.1      matt 		uint32_t invalid = ~sc->sc_gic_valid_lines[group];
    605      1.1      matt 		for (size_t j = 0; invalid && j < 32; j++, invalid >>= 1) {
    606      1.1      matt 			if (invalid & 1) {
    607      1.1      matt 				sc->sc_pic.pic_sources[i + j] =
    608      1.1      matt 				     &armgic_dummy_source;
    609      1.1      matt 			}
    610      1.1      matt 		}
    611      1.1      matt 	}
    612      1.1      matt #ifdef __HAVE_PIC_FAST_SOFTINTS
    613  1.1.2.4  jdolecek 	intr_establish(SOFTINT_BIO, IPL_SOFTBIO, IST_MPSAFE | IST_EDGE,
    614      1.1      matt 	    pic_handle_softint, (void *)SOFTINT_BIO);
    615  1.1.2.4  jdolecek 	intr_establish(SOFTINT_CLOCK, IPL_SOFTCLOCK, IST_MPSAFE | IST_EDGE,
    616      1.1      matt 	    pic_handle_softint, (void *)SOFTINT_CLOCK);
    617  1.1.2.4  jdolecek 	intr_establish(SOFTINT_NET, IPL_SOFTNET, IST_MPSAFE | IST_EDGE,
    618      1.1      matt 	    pic_handle_softint, (void *)SOFTINT_NET);
    619  1.1.2.4  jdolecek 	intr_establish(SOFTINT_SERIAL, IPL_SOFTSERIAL, IST_MPSAFE | IST_EDGE,
    620      1.1      matt 	    pic_handle_softint, (void *)SOFTINT_SERIAL);
    621      1.1      matt #endif
    622      1.1      matt #ifdef MULTIPROCESSOR
    623  1.1.2.4  jdolecek 	armgic_cpu_init(&sc->sc_pic, curcpu());
    624  1.1.2.4  jdolecek 
    625  1.1.2.4  jdolecek 	intr_establish(ARMGIC_SGI_IPIBASE + IPI_AST, IPL_VM,
    626  1.1.2.4  jdolecek 	    IST_MPSAFE | IST_EDGE, pic_ipi_ast, (void *)-1);
    627  1.1.2.4  jdolecek 	intr_establish(ARMGIC_SGI_IPIBASE + IPI_XCALL, IPL_HIGH,
    628  1.1.2.4  jdolecek 	    IST_MPSAFE | IST_EDGE, pic_ipi_xcall, (void *)-1);
    629  1.1.2.4  jdolecek 	intr_establish(ARMGIC_SGI_IPIBASE + IPI_GENERIC, IPL_HIGH,
    630  1.1.2.4  jdolecek 	    IST_MPSAFE | IST_EDGE, pic_ipi_generic, (void *)-1);
    631  1.1.2.4  jdolecek 	intr_establish(ARMGIC_SGI_IPIBASE + IPI_NOP, IPL_VM,
    632  1.1.2.4  jdolecek 	    IST_MPSAFE | IST_EDGE, pic_ipi_nop, (void *)-1);
    633  1.1.2.4  jdolecek 	intr_establish(ARMGIC_SGI_IPIBASE + IPI_SHOOTDOWN, IPL_SCHED,
    634  1.1.2.4  jdolecek 	    IST_MPSAFE | IST_EDGE, pic_ipi_shootdown, (void *)-1);
    635  1.1.2.3       tls #ifdef DDB
    636  1.1.2.4  jdolecek 	intr_establish(ARMGIC_SGI_IPIBASE + IPI_DDB, IPL_HIGH,
    637  1.1.2.4  jdolecek 	    IST_MPSAFE | IST_EDGE, pic_ipi_ddb, NULL);
    638      1.1      matt #endif
    639      1.1      matt #ifdef __HAVE_PREEMPTION
    640  1.1.2.4  jdolecek 	intr_establish(ARMGIC_SGI_IPIBASE + IPI_KPREEMPT, IPL_VM,
    641  1.1.2.4  jdolecek 	    IST_MPSAFE | IST_EDGE, pic_ipi_kpreempt, (void *)-1);
    642      1.1      matt #endif
    643      1.1      matt #endif
    644      1.1      matt 
    645      1.1      matt 	const u_int ppis = popcount32(sc->sc_gic_valid_lines[0] >> 16);
    646      1.1      matt 	const u_int sgis = popcount32(sc->sc_gic_valid_lines[0] & 0xffff);
    647  1.1.2.4  jdolecek 	aprint_normal_dev(sc->sc_dev, "%u Priorities, %zu SPIs, %u PPIs, "
    648  1.1.2.4  jdolecek 	    "%u SGIs\n",  priorities, sc->sc_gic_lines - ppis - sgis, ppis,
    649  1.1.2.4  jdolecek 	    sgis);
    650      1.1      matt }
    651      1.1      matt 
    652      1.1      matt CFATTACH_DECL_NEW(armgic, 0,
    653      1.1      matt     armgic_match, armgic_attach, NULL, NULL);
    654