[src/trunk]: src/sys/arch/arm/cortex gicv3: Only use 1 of N SPI distribution ...

[jmcneill <jmcneill%NetBSD.org@localhost>]

details:   https://anonhg.NetBSD.org/src/rev/9e383dce3c74
branches:  trunk
changeset: 946622:9e383dce3c74
user:      jmcneill <jmcneill%NetBSD.org@localhost>
date:      Fri Dec 04 21:39:26 2020 +0000

description:
gicv3: Only use 1 of N SPI distribution when the feature is available.

A GICv3+ implementation is not guaranteed to support 1 of N SPI
distribution. Support for this feature is indicated in GICD_TYPER.No1N.

When No1N=1, route all interrupts to the primary PE by default and only
allow a single CPU target when updating affinity.

diffstat:

 sys/arch/arm/cortex/gicv3.c |  32 +++++++++++++++++++-------------
 sys/arch/arm/cortex/gicv3.h |   4 +++-
 2 files changed, 22 insertions(+), 14 deletions(-)

diffs (123 lines):

diff -r ca033a7d3e21 -r 9e383dce3c74 sys/arch/arm/cortex/gicv3.c
--- a/sys/arch/arm/cortex/gicv3.c       Fri Dec 04 20:39:10 2020 +0000
+++ b/sys/arch/arm/cortex/gicv3.c       Fri Dec 04 21:39:26 2020 +0000
@@ -1,4 +1,4 @@
-/* $NetBSD: gicv3.c,v 1.35 2020/11/24 23:31:56 jmcneill Exp $ */
+/* $NetBSD: gicv3.c,v 1.36 2020/12/04 21:39:26 jmcneill Exp $ */
 
 /*-
  * Copyright (c) 2018 Jared McNeill <jmcneill%invisible.ca@localhost>
@@ -31,7 +31,7 @@
 #define        _INTR_PRIVATE
 
 #include <sys/cdefs.h>
-__KERNEL_RCSID(0, "$NetBSD: gicv3.c,v 1.35 2020/11/24 23:31:56 jmcneill Exp $");
+__KERNEL_RCSID(0, "$NetBSD: gicv3.c,v 1.36 2020/12/04 21:39:26 jmcneill Exp $");
 
 #include <sys/param.h>
 #include <sys/kernel.h>
@@ -59,6 +59,8 @@
 #define        IPL_TO_PRIORITY(sc, ipl)        (((0xff - (ipl)) << (sc)->sc_priority_shift) & 0xff)
 #define        IPL_TO_PMR(sc, ipl)             (((0xff - (ipl)) << (sc)->sc_pmr_shift) & 0xff)
 
+#define        GIC_SUPPORTS_1OFN(sc)           (((sc)->sc_gicd_typer & GICD_TYPER_No1N) == 0)
+
 #define        GIC_PRIO_SHIFT_NS               4
 #define        GIC_PRIO_SHIFT_S                3
 
@@ -186,11 +188,13 @@
                        gicr_write_4(sc, n, GICR_IPRIORITYRn(is->is_irq / 4), ipriority);
                }
        } else {
-               if (is->is_mpsafe) {
-                       /* Route MP-safe interrupts to all participating PEs */
+               /*
+                * If 1 of N SPI routing is supported, route MP-safe interrupts to all
+                * participating PEs. Otherwise, just route to the primary PE.
+                */
+               if (is->is_mpsafe && GIC_SUPPORTS_1OFN(sc)) {
                        irouter = GICD_IROUTER_Interrupt_Routing_mode;
                } else {
-                       /* Route non-MP-safe interrupts to the primary PE only */
                        irouter = sc->sc_irouter[0];
                }
                gicd_write_8(sc, GICD_IROUTER(is->is_irq), irouter);
@@ -482,12 +486,13 @@
                return EINVAL;
 
        const int set = kcpuset_countset(affinity);
-       if (set == ncpu)
+       if (set == 1) {
+               irouter = sc->sc_irouter[kcpuset_ffs(affinity) - 1];
+       } else if (set == ncpu && GIC_SUPPORTS_1OFN(sc)) {
                irouter = GICD_IROUTER_Interrupt_Routing_mode;
-       else if (set == 1)
-               irouter = sc->sc_irouter[kcpuset_ffs(affinity) - 1];
-       else
+       } else {
                return EINVAL;
+       }
 
        gicd_write_8(sc, GICD_IROUTER(irq), irouter);
 
@@ -820,7 +825,6 @@
 int
 gicv3_init(struct gicv3_softc *sc)
 {
-       const uint32_t gicd_typer = gicd_read_4(sc, GICD_TYPER);
        int n;
 
        KASSERT(CPU_IS_PRIMARY(curcpu()));
@@ -830,6 +834,8 @@
        for (n = 0; n < MAXCPUS; n++)
                sc->sc_irouter[n] = UINT64_MAX;
 
+       sc->sc_gicd_typer = gicd_read_4(sc, GICD_TYPER);
+
        /*
         * We don't alwayst have a consistent view of priorities between the
         * CPU interface (ICC_PMR_EL1) and the GICD/GICR registers. Detect
@@ -855,14 +861,14 @@
            sc->sc_quirks);
 
        sc->sc_pic.pic_ops = &gicv3_picops;
-       sc->sc_pic.pic_maxsources = GICD_TYPER_LINES(gicd_typer);
+       sc->sc_pic.pic_maxsources = GICD_TYPER_LINES(sc->sc_gicd_typer);
        snprintf(sc->sc_pic.pic_name, sizeof(sc->sc_pic.pic_name), "gicv3");
 #ifdef MULTIPROCESSOR
        sc->sc_pic.pic_cpus = kcpuset_running;
 #endif
        pic_add(&sc->sc_pic, 0);
 
-       if ((gicd_typer & GICD_TYPER_LPIS) != 0) {
+       if ((sc->sc_gicd_typer & GICD_TYPER_LPIS) != 0) {
                sc->sc_lpi.pic_ops = &gicv3_lpiops;
                sc->sc_lpi.pic_maxsources = 8192;       /* Min. required by GICv3 spec */
                snprintf(sc->sc_lpi.pic_name, sizeof(sc->sc_lpi.pic_name), "gicv3-lpi");
@@ -893,7 +899,7 @@
        gicv3_dist_enable(sc);
 
        gicv3_cpu_init(&sc->sc_pic, curcpu());
-       if ((gicd_typer & GICD_TYPER_LPIS) != 0)
+       if ((sc->sc_gicd_typer & GICD_TYPER_LPIS) != 0)
                gicv3_lpi_cpu_init(&sc->sc_lpi, curcpu());
 
 #ifdef MULTIPROCESSOR
diff -r ca033a7d3e21 -r 9e383dce3c74 sys/arch/arm/cortex/gicv3.h
--- a/sys/arch/arm/cortex/gicv3.h       Fri Dec 04 20:39:10 2020 +0000
+++ b/sys/arch/arm/cortex/gicv3.h       Fri Dec 04 21:39:26 2020 +0000
@@ -1,4 +1,4 @@
-/* $NetBSD: gicv3.h,v 1.9 2020/11/24 23:31:56 jmcneill Exp $ */
+/* $NetBSD: gicv3.h,v 1.10 2020/12/04 21:39:26 jmcneill Exp $ */
 
 /*-
  * Copyright (c) 2018 Jared McNeill <jmcneill%invisible.ca@localhost>
@@ -64,6 +64,8 @@
        u_int                   sc_quirks;
 #define        GICV3_QUIRK_RK3399      __BIT(0)        /* Rockchip RK3399 GIC-500 */
 
+       uint32_t                sc_gicd_typer;
+
        u_int                   sc_priority_shift;
        u_int                   sc_pmr_shift;