[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]
Re: [Qemu-devel] [PATCH v3 16/20] hw/intc/arm_gicv3: Implement gicv3_cpu
From: |
Shannon Zhao |
Subject: |
Re: [Qemu-devel] [PATCH v3 16/20] hw/intc/arm_gicv3: Implement gicv3_cpuif_update() |
Date: |
Wed, 15 Jun 2016 10:47:36 +0800 |
User-agent: |
Mozilla/5.0 (Windows NT 6.1; rv:24.0) Gecko/20100101 Thunderbird/24.4.0 |
On 2016/6/14 22:38, Peter Maydell wrote:
> Implement the gicv3_cpuif_update() function which deals with correctly
> asserting IRQ and FIQ based on the current running priority of the CPU,
> the priority of the highest priority pending interrupt and the CPU's
> current exception level and security state.
>
> Signed-off-by: Peter Maydell <address@hidden>
Reviewed-by: Shannon Zhao <address@hidden>
> ---
> hw/intc/arm_gicv3_cpuif.c | 140
> +++++++++++++++++++++++++++++++++++++++++++++-
> hw/intc/gicv3_internal.h | 5 +-
> trace-events | 2 +
> 3 files changed, 142 insertions(+), 5 deletions(-)
>
> diff --git a/hw/intc/arm_gicv3_cpuif.c b/hw/intc/arm_gicv3_cpuif.c
> index e112646..7faf3c0 100644
> --- a/hw/intc/arm_gicv3_cpuif.c
> +++ b/hw/intc/arm_gicv3_cpuif.c
> @@ -36,6 +36,142 @@ static bool gicv3_use_ns_bank(CPUARMState *env)
> return !arm_is_secure_below_el3(env);
> }
>
> +static int icc_highest_active_prio(GICv3CPUState *cs)
> +{
> + /* Calculate the current running priority based on the set bits
> + * in the Active Priority Registers.
> + */
> + int i;
> +
> + for (i = 0; i < ARRAY_SIZE(cs->icc_apr[0]); i++) {
> + uint32_t apr = cs->icc_apr[GICV3_G0][i] |
> + cs->icc_apr[GICV3_G1][i] | cs->icc_apr[GICV3_G1NS][i];
> +
> + if (!apr) {
> + continue;
> + }
> + return (i * 32 + ctz32(apr)) << (GIC_MIN_BPR + 1);
> + }
> + /* No current active interrupts: return idle priority */
> + return 0xff;
> +}
> +
> +static uint32_t icc_gprio_mask(GICv3CPUState *cs, int group)
> +{
> + /* Return a mask word which clears the subpriority bits from
> + * a priority value for an interrupt in the specified group.
> + * This depends on the BPR value:
> + * a BPR of 0 means the group priority bits are [7:1];
> + * a BPR of 1 means they are [7:2], and so on down to
> + * a BPR of 7 meaning no group priority bits at all.
> + * Which BPR to use depends on the group of the interrupt and
> + * the current ICC_CTLR.CBPR settings.
> + */
> + if ((group == GICV3_G1 && cs->icc_ctlr_el1[GICV3_S] & ICC_CTLR_EL1_CBPR)
> ||
> + (group == GICV3_G1NS &&
> + cs->icc_ctlr_el1[GICV3_NS] & ICC_CTLR_EL1_CBPR)) {
> + group = GICV3_G0;
> + }
> +
> + return ~0U << ((cs->icc_bpr[group] & 7) + 1);
> +}
> +
> +static bool icc_no_enabled_hppi(GICv3CPUState *cs)
> +{
> + /* Return true if there is no pending interrupt, or the
> + * highest priority pending interrupt is in a group which has been
> + * disabled at the CPU interface by the ICC_IGRPEN* register enable bits.
> + */
> + return cs->hppi.prio == 0xff || (cs->icc_igrpen[cs->hppi.grp] == 0);
> +}
> +
> +static bool icc_hppi_can_preempt(GICv3CPUState *cs)
> +{
> + /* Return true if we have a pending interrupt of sufficient
> + * priority to preempt.
> + */
> + int rprio;
> + uint32_t mask;
> +
> + if (icc_no_enabled_hppi(cs)) {
> + return false;
> + }
> +
> + if (cs->hppi.prio >= cs->icc_pmr_el1) {
> + /* Priority mask masks this interrupt */
> + return false;
> + }
> +
> + rprio = icc_highest_active_prio(cs);
> + if (rprio == 0xff) {
> + /* No currently running interrupt so we can preempt */
> + return true;
> + }
> +
> + mask = icc_gprio_mask(cs, cs->hppi.grp);
> +
> + /* We only preempt a running interrupt if the pending interrupt's
> + * group priority is sufficient (the subpriorities are not considered).
> + */
> + if ((cs->hppi.prio & mask) < (rprio & mask)) {
> + return true;
> + }
> +
> + return false;
> +}
> +
> +void gicv3_cpuif_update(GICv3CPUState *cs)
> +{
> + /* Tell the CPU about its highest priority pending interrupt */
> + int irqlevel = 0;
> + int fiqlevel = 0;
> + ARMCPU *cpu = ARM_CPU(cs->cpu);
> + CPUARMState *env = &cpu->env;
> +
> + trace_gicv3_cpuif_update(gicv3_redist_affid(cs), cs->hppi.irq,
> + cs->hppi.grp, cs->hppi.prio);
> +
> + if (cs->hppi.grp == GICV3_G1 && !arm_feature(env, ARM_FEATURE_EL3)) {
> + /* If a Security-enabled GIC sends a G1S interrupt to a
> + * Security-disabled CPU, we must treat it as if it were G0.
> + */
> + cs->hppi.grp = GICV3_G0;
> + }
> +
> + if (icc_hppi_can_preempt(cs)) {
> + /* We have an interrupt: should we signal it as IRQ or FIQ?
> + * This is described in the GICv3 spec section 4.6.2.
> + */
> + bool isfiq;
> +
> + switch (cs->hppi.grp) {
> + case GICV3_G0:
> + isfiq = true;
> + break;
> + case GICV3_G1:
> + isfiq = (!arm_is_secure(env) ||
> + (arm_current_el(env) == 3 && arm_el_is_aa64(env, 3)));
> + break;
> + case GICV3_G1NS:
> + isfiq = arm_is_secure(env);
> + break;
> + default:
> + g_assert_not_reached();
> + }
> +
> + if (isfiq) {
> + fiqlevel = 1;
> + } else {
> + irqlevel = 1;
> + }
> + }
> +
> + trace_gicv3_cpuif_set_irqs(gicv3_redist_affid(cs), fiqlevel, irqlevel);
> +
> + qemu_set_irq(cs->parent_fiq, fiqlevel);
> + qemu_set_irq(cs->parent_irq, irqlevel);
> +}
> +
> static uint64_t icc_pmr_read(CPUARMState *env, const ARMCPRegInfo *ri)
> {
> GICv3CPUState *cs = icc_cs_from_env(env);
> @@ -617,7 +753,9 @@ static const ARMCPRegInfo gicv3_cpuif_reginfo[] = {
>
> static void gicv3_cpuif_el_change_hook(ARMCPU *cpu, void *opaque)
> {
> - /* Do nothing for now. */
> + GICv3CPUState *cs = opaque;
> +
> + gicv3_cpuif_update(cs);
> }
>
> void gicv3_init_cpuif(GICv3State *s)
> diff --git a/hw/intc/gicv3_internal.h b/hw/intc/gicv3_internal.h
> index 13f951c..e469599 100644
> --- a/hw/intc/gicv3_internal.h
> +++ b/hw/intc/gicv3_internal.h
> @@ -222,10 +222,7 @@ void gicv3_init_cpuif(GICv3State *s);
> * current running priority or the CPU's current exception level or
> * security state.
> */
> -static inline void gicv3_cpuif_update(GICv3CPUState *cs)
> -{
> - /* This will be implemented in a later commit. */
> -}
> +void gicv3_cpuif_update(GICv3CPUState *cs);
>
> static inline uint32_t gicv3_iidr(void)
> {
> diff --git a/trace-events b/trace-events
> index baf12ba..c8fb467 100644
> --- a/trace-events
> +++ b/trace-events
> @@ -2179,6 +2179,8 @@ gicv3_icc_ctlr_read(uint32_t cpu, uint64_t val) "GICv3
> ICC_CTLR read cpu %x valu
> gicv3_icc_ctlr_write(uint32_t cpu, uint64_t val) "GICv3 ICC_CTLR write cpu
> %x value 0x%" PRIx64
> gicv3_icc_ctlr_el3_read(uint32_t cpu, uint64_t val) "GICv3 ICC_CTLR_EL3 read
> cpu %x value 0x%" PRIx64
> gicv3_icc_ctlr_el3_write(uint32_t cpu, uint64_t val) "GICv3 ICC_CTLR_EL3
> write cpu %x value 0x%" PRIx64
> +gicv3_cpuif_update(uint32_t cpuid, int irq, int grp, int prio) "GICv3 CPU
> i/f %x HPPI update: irq %d group %d prio %d"
> +gicv3_cpuif_set_irqs(uint32_t cpuid, int fiqlevel, int irqlevel) "GICv3 CPU
> i/f %x HPPI update: setting FIQ %d IRQ %d"
>
> # hw/intc/arm_gicv3_dist.c
> gicv3_dist_read(uint64_t offset, uint64_t data, unsigned size, bool secure)
> "GICv3 distributor read: offset 0x%" PRIx64 " data 0x%" PRIx64 " size %u
> secure %d"
>
--
Shannon
- [Qemu-devel] [PATCH v3 00/20] GICv3 emulation, Peter Maydell, 2016/06/14
- [Qemu-devel] [PATCH v3 02/20] bitops.h: Implement half-shuffle and half-unshuffle ops, Peter Maydell, 2016/06/14
- [Qemu-devel] [PATCH v3 17/20] hw/intc/arm_gicv3: Implement CPU i/f SGI generation registers, Peter Maydell, 2016/06/14
- [Qemu-devel] [PATCH v3 19/20] target-arm/machine.c: Allow user to request GICv3 emulation, Peter Maydell, 2016/06/14
- [Qemu-devel] [PATCH v3 16/20] hw/intc/arm_gicv3: Implement gicv3_cpuif_update(), Peter Maydell, 2016/06/14
- Re: [Qemu-devel] [PATCH v3 16/20] hw/intc/arm_gicv3: Implement gicv3_cpuif_update(),
Shannon Zhao <=
- [Qemu-devel] [PATCH v3 15/20] hw/intc/arm_gicv3: Implement GICv3 CPU interface registers, Peter Maydell, 2016/06/14
- [Qemu-devel] [PATCH v3 01/20] migration: Define VMSTATE_UINT64_2DARRAY, Peter Maydell, 2016/06/14
- [Qemu-devel] [PATCH v3 10/20] hw/intc/arm_gicv3: Implement functions to identify next pending irq, Peter Maydell, 2016/06/14
- [Qemu-devel] [PATCH v3 04/20] target-arm: Provide hook to tell GICv3 about changes of security state, Peter Maydell, 2016/06/14
- [Qemu-devel] [PATCH v3 14/20] hw/intc/arm_gicv3: Implement gicv3_set_irq(), Peter Maydell, 2016/06/14
- [Qemu-devel] [PATCH v3 09/20] hw/intc/arm_gicv3: ARM GICv3 device framework, Peter Maydell, 2016/06/14
- [Qemu-devel] [PATCH v3 05/20] target-arm: Add mp-affinity property for ARM CPU class, Peter Maydell, 2016/06/14
- [Qemu-devel] [PATCH v3 07/20] hw/intc/arm_gicv3: Move irq lines into GICv3CPUState structure, Peter Maydell, 2016/06/14