[PATCH] bsps/arm/shared: Add GICv3 implementation
Jeff Kubascik
jeff.kubascik at dornerworks.com
Fri Jan 17 19:25:49 UTC 2020
Hello,
Have there been any updates on this patch? I do not see it in mainline.
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.
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
More information about the devel
mailing list