lkml.org 
[lkml]   [2019]   [Oct]   [27]   [last100]   RSS Feed
Views: [wrap][no wrap]   [headers]  [forward] 
 
Messages in this thread
    Patch in this message
    /
    From
    Subject[PATCH v2 27/36] irqchip/gic-v4.1: Plumb get/set_irqchip_state SGI callbacks
    Date
    To implement the get/set_irqchip_state callbacks (limited to the
    PENDING state), we have to use a particular set of hacks:

    - Reading the pending state is done by using a pair of new redistributor
    registers (GICR_VSGIR, GICR_VSGIPENDR), which allow the 16 interrupts
    state to be retrieved.
    - Setting the pending state is done by generating it as we'd otherwise do
    for a guest (writing to GITS_SGIR)
    - Clearing the pending state is done by emiting a VSGI command with the
    "clear" bit set.

    Signed-off-by: Marc Zyngier <maz@kernel.org>
    ---
    drivers/irqchip/irq-gic-v3-its.c | 56 ++++++++++++++++++++++++++++++
    include/linux/irqchip/arm-gic-v3.h | 14 ++++++++
    2 files changed, 70 insertions(+)

    diff --git a/drivers/irqchip/irq-gic-v3-its.c b/drivers/irqchip/irq-gic-v3-its.c
    index b9cef419f006..58dd497dc274 100644
    --- a/drivers/irqchip/irq-gic-v3-its.c
    +++ b/drivers/irqchip/irq-gic-v3-its.c
    @@ -3690,11 +3690,67 @@ static int its_sgi_set_affinity(struct irq_data *d,
    return -EINVAL;
    }

    +static int its_sgi_set_irqchip_state(struct irq_data *d,
    + enum irqchip_irq_state which,
    + bool state)
    +{
    + if (which != IRQCHIP_STATE_PENDING)
    + return -EINVAL;
    +
    + if (state) {
    + struct its_vpe *vpe = irq_data_get_irq_chip_data(d);
    + struct its_node *its = find_4_1_its();
    + u64 val;
    +
    + val = FIELD_PREP(GITS_SGIR_VPEID, vpe->vpe_id);
    + val |= FIELD_PREP(GITS_SGIR_VINTID, d->hwirq);
    + writeq_relaxed(val, its->sgir_base + GITS_SGIR - SZ_128K);
    + } else {
    + its_configure_sgi(d, true);
    + }
    +
    + return 0;
    +}
    +
    +static int its_sgi_get_irqchip_state(struct irq_data *d,
    + enum irqchip_irq_state which, bool *val)
    +{
    + struct its_vpe *vpe = irq_data_get_irq_chip_data(d);
    + void __iomem *base = gic_data_rdist_cpu(vpe->col_idx)->rd_base + SZ_128K;
    + u32 count = 1000000; /* 1s! */
    + u32 status;
    +
    + if (which != IRQCHIP_STATE_PENDING)
    + return -EINVAL;
    +
    + writel_relaxed(vpe->vpe_id, base + GICR_VSGIR);
    + do {
    + status = readl_relaxed(base + GICR_VSGIPENDR);
    + if (!(status & GICR_VSGIPENDR_BUSY))
    + goto out;
    +
    + count--;
    + if (!count) {
    + pr_err_ratelimited("Unable to get SGI status\n");
    + goto out;
    + }
    + cpu_relax();
    + udelay(1);
    + } while(count);
    +
    +out:
    + *val = !!(status & (1 << d->hwirq));
    +
    + return 0;
    +}
    +
    static struct irq_chip its_sgi_irq_chip = {
    .name = "GICv4.1-sgi",
    .irq_mask = its_sgi_mask_irq,
    .irq_unmask = its_sgi_unmask_irq,
    .irq_set_affinity = its_sgi_set_affinity,
    + .irq_set_irqchip_state = its_sgi_set_irqchip_state,
    + .irq_get_irqchip_state = its_sgi_get_irqchip_state,
    };

    static int its_sgi_irq_domain_alloc(struct irq_domain *domain,
    diff --git a/include/linux/irqchip/arm-gic-v3.h b/include/linux/irqchip/arm-gic-v3.h
    index c73176d3ab2b..cb8563554ed2 100644
    --- a/include/linux/irqchip/arm-gic-v3.h
    +++ b/include/linux/irqchip/arm-gic-v3.h
    @@ -340,6 +340,15 @@
    #define GICR_VPENDBASER_4_1_VGRP1EN (1ULL << 58)
    #define GICR_VPENDBASER_4_1_VPEID GENMASK_ULL(15, 0)

    +#define GICR_VSGIR 0x0080
    +
    +#define GICR_VSGIR_VPEID GENMASK(15, 0)
    +
    +#define GICR_VSGIPENDR 0x0088
    +
    +#define GICR_VSGIPENDR_BUSY (1U << 31)
    +#define GICR_VSGIPENDR_PENDING GENMASK(15, 0)
    +
    /*
    * ITS registers, offsets from ITS_base
    */
    @@ -363,6 +372,11 @@

    #define GITS_TRANSLATER 0x10040

    +#define GITS_SGIR 0x20020
    +
    +#define GITS_SGIR_VPEID GENMASK_ULL(47, 32)
    +#define GITS_SGIR_VINTID GENMASK_ULL(7, 0)
    +
    #define GITS_CTLR_ENABLE (1U << 0)
    #define GITS_CTLR_ImDe (1U << 1)
    #define GITS_CTLR_ITS_NUMBER_SHIFT 4
    --
    2.20.1
    \
     
     \ /
      Last update: 2019-10-27 15:46    [W:4.118 / U:0.008 seconds]
    ©2003-2020 Jasper Spaans|hosted at Digital Ocean and TransIP|Read the blog|Advertise on this site