lkml.org 
[lkml]   [2012]   [Aug]   [20]   [last100]   RSS Feed
Views: [wrap][no wrap]   [headers]  [forward] 
 
Messages in this thread
    Patch in this message
    /
    From
    Subject[PATCH 11/12] ARM: VIC: Add a couple of low-level FIQ management helpers
    Date
    Just a couple of calls to manage VIC FIQ routing. We'll use them for
    KGDB FIQ support on ARM Versatile machines.

    Signed-off-by: Anton Vorontsov <anton.vorontsov@linaro.org>
    ---
    arch/arm/common/vic.c | 28 ++++++++++++++++++++++++++++
    arch/arm/include/asm/hardware/vic.h | 2 ++
    2 files changed, 30 insertions(+)

    diff --git a/arch/arm/common/vic.c b/arch/arm/common/vic.c
    index e0d5388..df2fc82 100644
    --- a/arch/arm/common/vic.c
    +++ b/arch/arm/common/vic.c
    @@ -66,6 +66,34 @@ static struct vic_device vic_devices[CONFIG_ARM_VIC_NR];

    static int vic_id;

    +static void __iomem *vic_base(struct irq_data *d)
    +{
    + return (void __iomem *)irq_data_get_irq_chip_data(d);
    +}
    +
    +void vic_fiq_select(unsigned int irq, bool on)
    +{
    + void __iomem *base = vic_base(&irq_to_desc(irq)->irq_data);
    + void __iomem *sel = base + VIC_INT_SELECT;
    + u32 msk = 1 << irq;
    + u32 val;
    +
    + pr_debug("rerouting VIC vector %d to %s\n", irq, on ? "FIQ" : "IRQ");
    +
    + val = readl(sel);
    + val &= ~msk;
    + if (on)
    + val |= msk;
    + writel(val, sel);
    +}
    +
    +bool vic_is_fiq_rised(unsigned int irq)
    +{
    + void __iomem *base = vic_base(&irq_to_desc(irq)->irq_data);
    +
    + return readl(base + VIC_FIQ_STATUS) & (1 << irq);
    +}
    +
    /**
    * vic_init2 - common initialisation code
    * @base: Base of the VIC.
    diff --git a/arch/arm/include/asm/hardware/vic.h b/arch/arm/include/asm/hardware/vic.h
    index e14af1a..2728975 100644
    --- a/arch/arm/include/asm/hardware/vic.h
    +++ b/arch/arm/include/asm/hardware/vic.h
    @@ -52,6 +52,8 @@ void __vic_init(void __iomem *base, unsigned int irq_start, u32 vic_sources,
    void vic_init(void __iomem *base, unsigned int irq_start, u32 vic_sources, u32 resume_sources);
    int vic_of_init(struct device_node *node, struct device_node *parent);
    void vic_handle_irq(struct pt_regs *regs);
    +void vic_fiq_select(unsigned int irq, bool on);
    +bool vic_is_fiq_rised(unsigned int irq);

    #endif /* __ASSEMBLY__ */
    #endif
    --
    1.7.11.5


    \
     
     \ /
      Last update: 2012-08-20 17:21    [W:2.737 / U:0.092 seconds]
    ©2003-2020 Jasper Spaans|hosted at Digital Ocean and TransIP|Read the blog|Advertise on this site