[PATCH] bsps/arm/shared: Add GICv3 implementation
Joel Sherrill
joel at rtems.org
Fri Jan 17 22:20:30 UTC 2020
On Fri, Jan 17, 2020 at 1:24 PM Jeff Kubascik <jeff.kubascik at dornerworks.com>
wrote:
> Hello,
>
> Have there been any updates on this patch? I do not see it in mainline.
>
I was hoping someone would comment. :)
>
> I am currently using it for work on the arm/xen BSP to add support for
> platforms
> with a GICv3 interrupt controller. With a few minor changes, I have
> confirm that
> it works with the Xen hypervisor on qemu. Before I can submit these
> patches,
> though, this patch would need to be accepted first.
>
Thank you for using it and reporting back. I just pushed it and look
forward to your
patch.
CC'ing Kinsey so he is on the lookout for your patch and verifies it still
works
on HPSC Qemu.
--joel
> On 8/16/2019 3:14 PM, Kinsey Moore wrote:
> > This adds support for the GICv3 interrupt controller along with the
> > redistributor to control SGIs and PPIs which wasn't present in GICv2
> > implementations. GICv3 implementations only optionally support
> > memory-mapped GICC interface interaction and require system register
> > access be implemented, so the GICC interface is accessed only
> > through system registers.
> > ---
> > bsps/arm/include/bsp/arm-gic-irq.h | 15 +-
> > bsps/arm/include/bsp/arm-gic-regs.h | 76 ++++++++-
> > bsps/arm/shared/irq/irq-gic.c | 16 ++
> > bsps/arm/shared/irq/irq-gicv3.c | 329
> ++++++++++++++++++++++++++++++++++++
> > 4 files changed, 427 insertions(+), 9 deletions(-)
> > create mode 100644 bsps/arm/shared/irq/irq-gicv3.c
> >
> > diff --git a/bsps/arm/include/bsp/arm-gic-irq.h
> b/bsps/arm/include/bsp/arm-gic-irq.h
> > index b3e893de72..219c3c7189 100644
> > --- a/bsps/arm/include/bsp/arm-gic-irq.h
> > +++ b/bsps/arm/include/bsp/arm-gic-irq.h
> > @@ -85,6 +85,12 @@ typedef enum {
> > ARM_GIC_IRQ_SOFTWARE_IRQ_TO_SELF
> > } arm_gic_irq_software_irq_target_filter;
> >
> > +void arm_gic_trigger_sgi(
> > + rtems_vector_number vector,
> > + arm_gic_irq_software_irq_target_filter filter,
> > + uint8_t targets
> > +);
> > +
> > static inline rtems_status_code arm_gic_irq_generate_software_irq(
> > rtems_vector_number vector,
> > arm_gic_irq_software_irq_target_filter filter,
> > @@ -94,14 +100,7 @@ static inline rtems_status_code
> arm_gic_irq_generate_software_irq(
> > rtems_status_code sc = RTEMS_SUCCESSFUL;
> >
> > if (vector <= ARM_GIC_IRQ_SGI_15) {
> > - volatile gic_dist *dist = ARM_GIC_DIST;
> > -
> > - dist->icdsgir = GIC_DIST_ICDSGIR_TARGET_LIST_FILTER(filter)
> > - | GIC_DIST_ICDSGIR_CPU_TARGET_LIST(targets)
> > -#ifdef BSP_ARM_GIC_ENABLE_FIQ_FOR_GROUP_0
> > - | GIC_DIST_ICDSGIR_NSATT
> > -#endif
> > - | GIC_DIST_ICDSGIR_SGIINTID(vector);
> > + arm_gic_trigger_sgi(vector, filter, targets);
> > } else {
> > sc = RTEMS_INVALID_ID;
> > }
> > diff --git a/bsps/arm/include/bsp/arm-gic-regs.h
> b/bsps/arm/include/bsp/arm-gic-regs.h
> > index 2915313b71..8a65294b6f 100644
> > --- a/bsps/arm/include/bsp/arm-gic-regs.h
> > +++ b/bsps/arm/include/bsp/arm-gic-regs.h
> > @@ -86,7 +86,18 @@ typedef struct {
> > } gic_cpuif;
> >
> > typedef struct {
> > + /* GICD_CTLR */
> > uint32_t icddcr;
> > +/* GICv3 only */
> > +#define GIC_DIST_ICDDCR_RWP BSP_BIT32(31)
> > +#define GIC_DIST_ICDDCR_E1NWF BSP_BIT32(7)
> > +#define GIC_DIST_ICDDCR_DS BSP_BIT32(6)
> > +#define GIC_DIST_ICDDCR_ARE_NS BSP_BIT32(5)
> > +#define GIC_DIST_ICDDCR_ARE_S BSP_BIT32(4)
> > +#define GIC_DIST_ICDDCR_ENABLE_GRP1S BSP_BIT32(2)
> > +#define GIC_DIST_ICDDCR_ENABLE_GRP1NS BSP_BIT32(1)
> > +#define GIC_DIST_ICDDCR_ENABLE_GRP0 BSP_BIT32(0)
> > +/* GICv1/GICv2 */
> > #define GIC_DIST_ICDDCR_ENABLE_GRP_1 BSP_BIT32(1)
> > #define GIC_DIST_ICDDCR_ENABLE BSP_BIT32(0)
> > uint32_t icdictr;
> > @@ -126,7 +137,9 @@ typedef struct {
> > uint8_t icdiptr[256];
> > uint32_t reserved_900[192];
> > uint32_t icdicfr[64];
> > - uint32_t reserved_d00[128];
> > + /* GICD_IGRPMODR GICv3 only, reserved in GICv1/GICv2 */
> > + uint32_t icdigmr[32];
> > + uint32_t reserved_d80[96];
> > uint32_t icdsgir;
> > #define GIC_DIST_ICDSGIR_TARGET_LIST_FILTER(val) BSP_FLD32(val, 24, 25)
> > #define GIC_DIST_ICDSGIR_TARGET_LIST_FILTER_GET(reg) BSP_FLD32GET(reg,
> 24, 25)
> > @@ -140,4 +153,65 @@ typedef struct {
> > #define GIC_DIST_ICDSGIR_SGIINTID_SET(reg, val) BSP_FLD32SET(reg, val,
> 0, 3)
> > } gic_dist;
> >
> > +/* GICv3 only */
> > +typedef struct {
> > + /* GICR_CTLR */
> > + uint32_t icrrcr;
> > +#define GIC_REDIST_ICRRCR_UWP BSP_BIT32(31)
> > +#define GIC_REDIST_ICRRCR_DPG1S BSP_BIT32(26)
> > +#define GIC_REDIST_ICRRCR_DPG1NS BSP_BIT32(25)
> > +#define GIC_REDIST_ICRRCR_DPG0 BSP_BIT32(24)
> > +#define GIC_REDIST_ICRRCR_RWP BSP_BIT32(4)
> > +#define GIC_REDIST_ICRRCR_ENABLE_LPI BSP_BIT32(0)
> > + uint32_t icriidr;
> > + uint64_t icrtyper;
> > +#define GIC_REDIST_ICRTYPER_AFFINITY_VALUE(val) BSP_FLD64(val, 32, 63)
> > +#define GIC_REDIST_ICRTYPER_AFFINITY_VALUE_GET(reg) BSP_FLD64GET(reg,
> 32, 63)
> > +#define GIC_REDIST_ICRTYPER_AFFINITY_VALUE_SET(reg, val)
> BSP_FLD64SET(reg, val, 32, 63)
> > +#define GIC_REDIST_ICRTYPER_COMMON_LPI_AFFINITY(val) BSP_FLD64(val, 24,
> 25)
> > +#define GIC_REDIST_ICRTYPER_COMMON_LPI_AFFINITY_GET(reg)
> BSP_FLD64GET(reg, 24, 25)
> > +#define GIC_REDIST_ICRTYPER_COMMON_LPI_AFFINITY_SET(reg, val)
> BSP_FLD64SET(reg, val, 24, 25)
> > +#define GIC_REDIST_ICRTYPER_CPU_NUMBER(val) BSP_FLD64(val, 8, 23)
> > +#define GIC_REDIST_ICRTYPER_CPU_NUMBER_GET(reg) BSP_FLD64GET(reg, 8, 23)
> > +#define GIC_REDIST_ICRTYPER_CPU_NUMBER_SET(reg, val) BSP_FLD64SET(reg,
> val, 8, 23)
> > +#define GIC_REDIST_ICRTYPER_DPGS BSP_BIT64(5)
> > +#define GIC_REDIST_ICRTYPER_LAST BSP_BIT64(4)
> > +#define GIC_REDIST_ICRTYPER_DIRECT_LPI BSP_BIT64(3)
> > +#define GIC_REDIST_ICRTYPER_VLPIS BSP_BIT64(1)
> > +#define GIC_REDIST_ICRTYPER_PLPIS BSP_BIT64(0)
> > + uint32_t unused_10;
> > + uint32_t icrwaker;
> > +#define GIC_REDIST_ICRWAKER_CHILDREN_ASLEEP BSP_BIT32(2)
> > +#define GIC_REDIST_ICRWAKER_PROCESSOR_SLEEP BSP_BIT32(1)
> > +} gic_redist;
> > +
> > +/* GICv3 only */
> > +typedef struct {
> > + uint32_t reserved_0_80[32];
> > + /* GICR_IGROUPR0 */
> > + uint32_t icspigrpr[32];
> > + /* GICR_ISENABLER0 */
> > + uint32_t icspiser[32];
> > + /* GICR_ICENABLER0 */
> > + uint32_t icspicer[32];
> > + /* GICR_ISPENDR0 */
> > + uint32_t icspispendr[32];
> > + /* GICR_ICPENDR0 */
> > + uint32_t icspicpendr[32];
> > + /* GICR_ISACTIVER0 */
> > + uint32_t icspisar[32];
> > + /* GICR_ICACTIVER0 */
> > + uint32_t icspicar[32];
> > + /* GICR_IPRIORITYR */
> > + uint8_t icspiprior[32];
> > + uint32_t reserved_420_bfc[504];
> > + /* GICR_ICFGR0 */
> > + uint32_t icspicfgr0;
> > + /* GICR_ICFGR1 */
> > + uint32_t icspicfgr1;
> > + uint32_t reserved_c08_cfc[62];
> > + /* GICR_IGRPMODR0 */
> > + uint32_t icspigrpmodr[64];
> > +} gic_sgi_ppi;
> > +
> > #endif /* LIBBSP_ARM_SHARED_ARM_GIC_REGS_H */
> > diff --git a/bsps/arm/shared/irq/irq-gic.c
> b/bsps/arm/shared/irq/irq-gic.c
> > index 65a7e6f653..7cf469d0f7 100644
> > --- a/bsps/arm/shared/irq/irq-gic.c
> > +++ b/bsps/arm/shared/irq/irq-gic.c
> > @@ -262,3 +262,19 @@ void bsp_interrupt_get_affinity(
> >
> > _Processor_mask_From_uint32_t(affinity, targets, 0);
> > }
> > +
> > +void arm_gic_trigger_sgi(
> > + rtems_vector_number vector,
> > + arm_gic_irq_software_irq_target_filter filter,
> > + uint8_t targets
> > +)
> > +{
> > + volatile gic_dist *dist = ARM_GIC_DIST;
> > +
> > + dist->icdsgir = GIC_DIST_ICDSGIR_TARGET_LIST_FILTER(filter)
> > + | GIC_DIST_ICDSGIR_CPU_TARGET_LIST(targets)
> > +#ifdef BSP_ARM_GIC_ENABLE_FIQ_FOR_GROUP_0
> > + | GIC_DIST_ICDSGIR_NSATT
> > +#endif
> > + | GIC_DIST_ICDSGIR_SGIINTID(vector);
> > +}
> > diff --git a/bsps/arm/shared/irq/irq-gicv3.c
> b/bsps/arm/shared/irq/irq-gicv3.c
> > new file mode 100644
> > index 0000000000..138b565b9b
> > --- /dev/null
> > +++ b/bsps/arm/shared/irq/irq-gicv3.c
> > @@ -0,0 +1,329 @@
> > +/*
> > + * SPDX-License-Identifier: BSD-2-Clause
> > + *
> > + * Copyright (C) 2019 On-Line Applications Research Corporation (OAR)
> > + *
> > + * Redistribution and use in source and binary forms, with or without
> > + * modification, are permitted provided that the following conditions
> > + * are met:
> > + * 1. Redistributions of source code must retain the above copyright
> > + * notice, this list of conditions and the following disclaimer.
> > + * 2. Redistributions in binary form must reproduce the above copyright
> > + * notice, this list of conditions and the following disclaimer in
> the
> > + * documentation and/or other materials provided with the
> distribution.
> > + *
> > + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
> "AS IS"
> > + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
> TO, THE
> > + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
> PURPOSE
> > + * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
> CONTRIBUTORS BE
> > + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
> > + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
> > + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
> BUSINESS
> > + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
> IN
> > + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
> OTHERWISE)
> > + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
> OF THE
> > + * POSSIBILITY OF SUCH DAMAGE.
> > + */
> > +
> > +#include <bsp/arm-gic.h>
> > +
> > +#include <rtems/score/armv4.h>
> > +
> > +#include <libcpu/arm-cp15.h>
> > +
> > +#include <bsp/irq.h>
> > +#include <bsp/irq-generic.h>
> > +#include <bsp/start.h>
> > +
> > +#define PRIORITY_DEFAULT 127
> > +
> > +/* cpuif->iccicr */
> > +#define ICC_CTLR "p15, 0, %0, c12, c12, 4"
> > +
> > +/* cpuif->iccpmr */
> > +#define ICC_PMR "p15, 0, %0, c4, c6, 0"
> > +
> > +/* cpuif->iccbpr */
> > +#define ICC_BPR0 "p15, 0, %0, c12, c8, 3"
> > +#define ICC_BPR1 "p15, 0, %0, c12, c12, 3"
> > +
> > +/* cpuif->icciar */
> > +#define ICC_IAR0 "p15, 0, %0, c12, c8, 0"
> > +#define ICC_IAR1 "p15, 0, %0, c12, c12, 0"
> > +
> > +/* cpuif->icceoir */
> > +#define ICC_EOIR0 "p15, 0, %0, c12, c8, 1"
> > +#define ICC_EOIR1 "p15, 0, %0, c12, c12, 1"
> > +
> > +#define ICC_SRE "p15, 0, %0, c12, c12, 5"
> > +
> > +#define ICC_IGRPEN0 "p15, 0, %0, c12, c12, 6"
> > +#define ICC_IGRPEN1 "p15, 0, %0, c12, c12, 7"
> > +
> > +#define ICC_SGI1 "p15, 0, %Q0, %R0, c12"
> > +
> > +#define ICC_SGIR_AFFINITY3(val) BSP_FLD64(val, 48, 55)
> > +#define ICC_SGIR_AFFINITY3_GET(reg) BSP_FLD64GET(reg, 48, 55)
> > +#define ICC_SGIR_AFFINITY3_SET(reg, val) BSP_FLD64SET(reg, val, 48, 55)
> > +#define ICC_SGIR_IRM BSP_BIT32(40)
> > +#define ICC_SGIR_AFFINITY2(val) BSP_FLD64(val, 32, 39)
> > +#define ICC_SGIR_AFFINITY2_GET(reg) BSP_FLD64GET(reg, 32, 39)
> > +#define ICC_SGIR_AFFINITY2_SET(reg, val) BSP_FLD64SET(reg, val, 32, 39)
> > +#define ICC_SGIR_INTID(val) BSP_FLD64(val, 24, 27)
> > +#define ICC_SGIR_INTID_GET(reg) BSP_FLD64GET(reg, 24, 27)
> > +#define ICC_SGIR_INTID_SET(reg, val) BSP_FLD64SET(reg, val, 24, 27)
> > +#define ICC_SGIR_AFFINITY1(val) BSP_FLD64(val, 16, 23)
> > +#define ICC_SGIR_AFFINITY1_GET(reg) BSP_FLD64GET(reg, 16, 23)
> > +#define ICC_SGIR_AFFINITY1_SET(reg, val) BSP_FLD64SET(reg, val, 16, 23)
> > +#define ICC_SGIR_CPU_TARGET_LIST(val) BSP_FLD64(val, 0, 15)
> > +#define ICC_SGIR_CPU_TARGET_LIST_GET(reg) BSP_FLD64GET(reg, 0, 15)
> > +#define ICC_SGIR_CPU_TARGET_LIST_SET(reg, val) BSP_FLD64SET(reg, val,
> 0, 15)
> > +
> > +#define MPIDR "p15, 0, %0, c0, c0, 5"
> > +
> > +#define MPIDR_AFFINITY3(val) BSP_FLD64(val, 25, 29)
> > +#define MPIDR_AFFINITY3_GET(reg) BSP_FLD64GET(reg, 25, 29)
> > +#define MPIDR_AFFINITY3_SET(reg, val) BSP_FLD64SET(reg, val, 25, 29)
> > +#define MPIDR_AFFINITY2(val) BSP_FLD64(val, 16, 23)
> > +#define MPIDR_AFFINITY2_GET(reg) BSP_FLD64GET(reg, 16, 23)
> > +#define MPIDR_AFFINITY2_SET(reg, val) BSP_FLD64SET(reg, val, 16, 23)
> > +#define MPIDR_AFFINITY1(val) BSP_FLD64(val, 8, 15)
> > +#define MPIDR_AFFINITY1_GET(reg) BSP_FLD64GET(reg, 8, 15)
> > +#define MPIDR_AFFINITY1_SET(reg, val) BSP_FLD64SET(reg, val, 8, 15)
> > +#define MPIDR_AFFINITY0(val) BSP_FLD64(val, 0, 7)
> > +#define MPIDR_AFFINITY0_GET(reg) BSP_FLD64GET(reg, 0, 7)
> > +#define MPIDR_AFFINITY0_SET(reg, val) BSP_FLD64SET(reg, val, 0, 7)
> > +
> > +#define READ_SR(SR_NAME) \
> > +({ \
> > + uint32_t value; \
> > + __asm__ volatile("mrc " SR_NAME : "=r" (value) ); \
> > + value; \
> > +})
> > +
> > +#define WRITE_SR(SR_NAME, VALUE) \
> > + __asm__ volatile("mcr " SR_NAME " \n" : : "r" (VALUE) );
> > +
> > +#define WRITE64_SR(SR_NAME, VALUE) \
> > + __asm__ volatile("mcrr " SR_NAME " \n" : : "r" (VALUE) );
> > +
> > +#define ARM_GIC_REDIST ((volatile gic_redist *) BSP_ARM_GIC_REDIST_BASE)
> > +#define ARM_GIC_SGI_PPI (((volatile gic_sgi_ppi *)
> ((char*)BSP_ARM_GIC_REDIST_BASE + (1 << 16))))
> > +
> > +void bsp_interrupt_dispatch(void)
> > +{
> > + uint32_t icciar = READ_SR(ICC_IAR1);
> > + rtems_vector_number vector = GIC_CPUIF_ICCIAR_ACKINTID_GET(icciar);
> > + rtems_vector_number spurious = 1023;
> > +
> > + if (vector != spurious) {
> > + uint32_t psr = _ARMV4_Status_irq_enable();
> > + bsp_interrupt_handler_dispatch(vector);
> > +
> > + _ARMV4_Status_restore(psr);
> > +
> > + WRITE_SR(ICC_EOIR1, icciar);
> > + }
> > +}
> > +
> > +void bsp_interrupt_vector_enable(rtems_vector_number vector)
> > +{
> > + volatile gic_dist *dist = ARM_GIC_DIST;
> > + volatile gic_sgi_ppi *sgi_ppi = ARM_GIC_SGI_PPI;
> > +
> > + bsp_interrupt_assert(bsp_interrupt_is_valid_vector(vector));
> > +
> > + /* TODO(kmoore) This could use some cleanup and integration
> > + * Vectors below 32 are currently routed through the redistributor */
> > + if (vector >= 32) {
> > + gic_id_enable(dist, vector);
> > + } else {
> > + sgi_ppi->icspiser[0] = 1 << (vector % 32);
> > + }
> > +}
> > +
> > +void bsp_interrupt_vector_disable(rtems_vector_number vector)
> > +{
> > + volatile gic_dist *dist = ARM_GIC_DIST;
> > + volatile gic_sgi_ppi *sgi_ppi = ARM_GIC_SGI_PPI;
> > +
> > + bsp_interrupt_assert(bsp_interrupt_is_valid_vector(vector));
> > +
> > + if (vector >= 32) {
> > + gic_id_disable(dist, vector);
> > + } else {
> > + sgi_ppi->icspicer[0] = 1 << (vector % 32);
> > + }
> > +}
> > +
> > +static inline uint32_t get_id_count(volatile gic_dist *dist)
> > +{
> > + uint32_t id_count =
> GIC_DIST_ICDICTR_IT_LINES_NUMBER_GET(dist->icdictr);
> > +
> > + id_count = 32 * (id_count + 1);
> > + id_count = id_count <= 1020 ? id_count : 1020;
> > +
> > + return id_count;
> > +}
> > +
> > +static void init_cpu_interface(void)
> > +{
> > + uint32_t sre_value = 0x7;
> > + WRITE_SR(ICC_SRE, sre_value);
> > + WRITE_SR(ICC_PMR, GIC_CPUIF_ICCPMR_PRIORITY(0xff));
> > + WRITE_SR(ICC_BPR0, GIC_CPUIF_ICCBPR_BINARY_POINT(0x0));
> > +
> > + volatile gic_redist *redist = ARM_GIC_REDIST;
> > + uint32_t waker = redist->icrwaker;
> > + uint32_t waker_mask = GIC_REDIST_ICRWAKER_PROCESSOR_SLEEP;
> > + waker &= ~waker_mask;
> > + redist->icrwaker = waker;
> > +
> > + /* Set interrupt group to 1NS for SGI/PPI interrupts routed through
> the redistributor */
> > + volatile gic_sgi_ppi *sgi_ppi = ARM_GIC_SGI_PPI;
> > + sgi_ppi->icspigrpr[0] = 0xffffffff;
> > + sgi_ppi->icspigrpmodr[0] = 0;
> > + for (int id = 0; id < 32; id++) {
> > + sgi_ppi->icspiprior[id] = PRIORITY_DEFAULT;
> > + }
> > +
> > + /* Enable interrupt groups 0 and 1 */
> > + WRITE_SR(ICC_IGRPEN0, 0x1);
> > + WRITE_SR(ICC_IGRPEN1, 0x1);
> > + WRITE_SR(ICC_CTLR, 0x0);
> > +}
> > +
> > +rtems_status_code bsp_interrupt_facility_initialize(void)
> > +{
> > + volatile gic_dist *dist = ARM_GIC_DIST;
> > + uint32_t id_count = get_id_count(dist);
> > + uint32_t id;
> > +
> > + arm_cp15_set_exception_handler(
> > + ARM_EXCEPTION_IRQ,
> > + _ARMV4_Exception_interrupt
> > + );
> > +
> > + dist->icddcr = GIC_DIST_ICDDCR_ARE_NS | GIC_DIST_ICDDCR_ARE_S
> > + | GIC_DIST_ICDDCR_ENABLE_GRP1S |
> GIC_DIST_ICDDCR_ENABLE_GRP1NS
> > + | GIC_DIST_ICDDCR_ENABLE_GRP0;
> > +
> > + for (id = 0; id < id_count; id += 32) {
> > + /* Disable all interrupts */
> > + dist->icdicer[id / 32] = 0xffffffff;
> > +
> > + /* Set interrupt group to 1NS for all interrupts */
> > + dist->icdigr[id / 32] = 0xffffffff;
> > + dist->icdigmr[id / 32] = 0;
> > + }
> > +
> > + for (id = 0; id < id_count; ++id) {
> > + gic_id_set_priority(dist, id, PRIORITY_DEFAULT);
> > + }
> > +
> > + for (id = 32; id < id_count; ++id) {
> > + gic_id_set_targets(dist, id, 0x01);
> > + }
> > +
> > + init_cpu_interface();
> > + return RTEMS_SUCCESSFUL;
> > +}
> > +
> > +#ifdef RTEMS_SMP
> > +BSP_START_TEXT_SECTION void arm_gic_irq_initialize_secondary_cpu(void)
> > +{
> > + volatile gic_dist *dist = ARM_GIC_DIST;
> > +
> > + while ((dist->icddcr & GIC_DIST_ICDDCR_ENABLE) == 0) {
> > + /* Wait */
> > + }
> > +
> > +#error modify init_cpu_interface to use correct offsets for each CPU
> > + init_cpu_interface();
> > +}
> > +#endif
> > +
> > +rtems_status_code arm_gic_irq_set_priority(
> > + rtems_vector_number vector,
> > + uint8_t priority
> > +)
> > +{
> > + rtems_status_code sc = RTEMS_SUCCESSFUL;
> > +
> > + if (bsp_interrupt_is_valid_vector(vector)) {
> > + if (vector < 32) {
> > + volatile gic_sgi_ppi *sgi_ppi = ARM_GIC_SGI_PPI;
> > + sgi_ppi->icspiprior[vector] = priority;
> > + } else {
> > + volatile gic_dist *dist = ARM_GIC_DIST;
> > + gic_id_set_priority(dist, vector, priority);
> > + }
> > + } else {
> > + sc = RTEMS_INVALID_ID;
> > + }
> > +
> > + return sc;
> > +}
> > +
> > +rtems_status_code arm_gic_irq_get_priority(
> > + rtems_vector_number vector,
> > + uint8_t *priority
> > +)
> > +{
> > + rtems_status_code sc = RTEMS_SUCCESSFUL;
> > +
> > + if (bsp_interrupt_is_valid_vector(vector)) {
> > + if (vector < 32) {
> > + volatile gic_sgi_ppi *sgi_ppi = ARM_GIC_SGI_PPI;
> > + *priority = sgi_ppi->icspiprior[vector];
> > + } else {
> > + volatile gic_dist *dist = ARM_GIC_DIST;
> > + *priority = gic_id_get_priority(dist, vector);
> > + }
> > + } else {
> > + sc = RTEMS_INVALID_ID;
> > + }
> > +
> > + return sc;
> > +}
> > +
> > +void bsp_interrupt_set_affinity(
> > + rtems_vector_number vector,
> > + const Processor_mask *affinity
> > +)
> > +{
> > + volatile gic_dist *dist = ARM_GIC_DIST;
> > + uint8_t targets = (uint8_t) _Processor_mask_To_uint32_t(affinity, 0);
> > +
> > + gic_id_set_targets(dist, vector, targets);
> > +}
> > +
> > +void bsp_interrupt_get_affinity(
> > + rtems_vector_number vector,
> > + Processor_mask *affinity
> > +)
> > +{
> > + volatile gic_dist *dist = ARM_GIC_DIST;
> > + uint8_t targets = gic_id_get_targets(dist, vector);
> > +
> > + _Processor_mask_From_uint32_t(affinity, targets, 0);
> > +}
> > +
> > +void arm_gic_trigger_sgi(
> > + rtems_vector_number vector,
> > + arm_gic_irq_software_irq_target_filter filter,
> > + uint8_t targets
> > +)
> > +{
> > + /* TODO(kmoore) Handle filter:
> > + * ARM_GIC_IRQ_SOFTWARE_IRQ_TO_ALL_IN_LIST,
> > + * ARM_GIC_IRQ_SOFTWARE_IRQ_TO_ALL_EXCEPT_SELF,
> > + * ARM_GIC_IRQ_SOFTWARE_IRQ_TO_SELF */
> > + uint32_t mpidr = READ_SR(MPIDR);
> > + uint64_t value = ICC_SGIR_AFFINITY3(MPIDR_AFFINITY3_GET(mpidr))
> > + | ICC_SGIR_AFFINITY2(MPIDR_AFFINITY2_GET(mpidr))
> > + | ICC_SGIR_INTID(vector)
> > + | ICC_SGIR_AFFINITY1(MPIDR_AFFINITY1_GET(mpidr))
> > + | ICC_SGIR_CPU_TARGET_LIST(1);
> > + WRITE64_SR(ICC_SGI1, value);
> > +}
> >
>
> Thanks,
> Jeff Kubascik
> _______________________________________________
> devel mailing list
> devel at rtems.org
> http://lists.rtems.org/mailman/listinfo/devel
>
-------------- next part --------------
An HTML attachment was scrubbed...
URL: <http://lists.rtems.org/pipermail/devel/attachments/20200117/66222bcd/attachment-0001.html>
More information about the devel
mailing list