mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-30 03:27:44 -04:00
irqchip: GIC: Add support for irq_[get, set]_irqchip_state()
Add the required hooks for the internal state of an interrupt to be exposed to other subsystems. Signed-off-by: Marc Zyngier <[email protected]> Cc: [email protected] Cc: Abhijeet Dharmapurikar <[email protected]> Cc: Stephen Boyd <[email protected]> Cc: Phong Vo <[email protected]> Cc: Linus Walleij <[email protected]> Cc: Tin Huynh <[email protected]> Cc: Y Vo <[email protected]> Cc: Toan Le <[email protected]> Cc: Bjorn Andersson <[email protected]> Cc: Jason Cooper <[email protected]> Cc: Arnd Bergmann <[email protected]> Link: http://lkml.kernel.org/r/[email protected] Signed-off-by: Thomas Gleixner <[email protected]>
This commit is contained in:
parent
1b7047edfc
commit
567178077c
1 changed files with 65 additions and 4 deletions
|
|
@ -151,13 +151,24 @@ static inline unsigned int gic_irq(struct irq_data *d)
|
|||
/*
|
||||
* Routines to acknowledge, disable and enable interrupts
|
||||
*/
|
||||
static void gic_mask_irq(struct irq_data *d)
|
||||
static void gic_poke_irq(struct irq_data *d, u32 offset)
|
||||
{
|
||||
u32 mask = 1 << (gic_irq(d) % 32);
|
||||
writel_relaxed(mask, gic_dist_base(d) + offset + (gic_irq(d) / 32) * 4);
|
||||
}
|
||||
|
||||
static int gic_peek_irq(struct irq_data *d, u32 offset)
|
||||
{
|
||||
u32 mask = 1 << (gic_irq(d) % 32);
|
||||
return !!(readl_relaxed(gic_dist_base(d) + offset + (gic_irq(d) / 32) * 4) & mask);
|
||||
}
|
||||
|
||||
static void gic_mask_irq(struct irq_data *d)
|
||||
{
|
||||
unsigned long flags;
|
||||
|
||||
raw_spin_lock_irqsave(&irq_controller_lock, flags);
|
||||
writel_relaxed(mask, gic_dist_base(d) + GIC_DIST_ENABLE_CLEAR + (gic_irq(d) / 32) * 4);
|
||||
gic_poke_irq(d, GIC_DIST_ENABLE_CLEAR);
|
||||
if (gic_arch_extn.irq_mask)
|
||||
gic_arch_extn.irq_mask(d);
|
||||
raw_spin_unlock_irqrestore(&irq_controller_lock, flags);
|
||||
|
|
@ -165,13 +176,12 @@ static void gic_mask_irq(struct irq_data *d)
|
|||
|
||||
static void gic_unmask_irq(struct irq_data *d)
|
||||
{
|
||||
u32 mask = 1 << (gic_irq(d) % 32);
|
||||
unsigned long flags;
|
||||
|
||||
raw_spin_lock_irqsave(&irq_controller_lock, flags);
|
||||
if (gic_arch_extn.irq_unmask)
|
||||
gic_arch_extn.irq_unmask(d);
|
||||
writel_relaxed(mask, gic_dist_base(d) + GIC_DIST_ENABLE_SET + (gic_irq(d) / 32) * 4);
|
||||
gic_poke_irq(d, GIC_DIST_ENABLE_SET);
|
||||
raw_spin_unlock_irqrestore(&irq_controller_lock, flags);
|
||||
}
|
||||
|
||||
|
|
@ -186,6 +196,55 @@ static void gic_eoi_irq(struct irq_data *d)
|
|||
writel_relaxed(gic_irq(d), gic_cpu_base(d) + GIC_CPU_EOI);
|
||||
}
|
||||
|
||||
static int gic_irq_set_irqchip_state(struct irq_data *d,
|
||||
enum irqchip_irq_state which, bool val)
|
||||
{
|
||||
u32 reg;
|
||||
|
||||
switch (which) {
|
||||
case IRQCHIP_STATE_PENDING:
|
||||
reg = val ? GIC_DIST_PENDING_SET : GIC_DIST_PENDING_CLEAR;
|
||||
break;
|
||||
|
||||
case IRQCHIP_STATE_ACTIVE:
|
||||
reg = val ? GIC_DIST_ACTIVE_SET : GIC_DIST_ACTIVE_CLEAR;
|
||||
break;
|
||||
|
||||
case IRQCHIP_STATE_MASKED:
|
||||
reg = val ? GIC_DIST_ENABLE_CLEAR : GIC_DIST_ENABLE_SET;
|
||||
break;
|
||||
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
gic_poke_irq(d, reg);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int gic_irq_get_irqchip_state(struct irq_data *d,
|
||||
enum irqchip_irq_state which, bool *val)
|
||||
{
|
||||
switch (which) {
|
||||
case IRQCHIP_STATE_PENDING:
|
||||
*val = gic_peek_irq(d, GIC_DIST_PENDING_SET);
|
||||
break;
|
||||
|
||||
case IRQCHIP_STATE_ACTIVE:
|
||||
*val = gic_peek_irq(d, GIC_DIST_ACTIVE_SET);
|
||||
break;
|
||||
|
||||
case IRQCHIP_STATE_MASKED:
|
||||
*val = !gic_peek_irq(d, GIC_DIST_ENABLE_SET);
|
||||
break;
|
||||
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int gic_set_type(struct irq_data *d, unsigned int type)
|
||||
{
|
||||
void __iomem *base = gic_dist_base(d);
|
||||
|
|
@ -329,6 +388,8 @@ static struct irq_chip gic_chip = {
|
|||
.irq_set_affinity = gic_set_affinity,
|
||||
#endif
|
||||
.irq_set_wake = gic_set_wake,
|
||||
.irq_get_irqchip_state = gic_irq_get_irqchip_state,
|
||||
.irq_set_irqchip_state = gic_irq_set_irqchip_state,
|
||||
};
|
||||
|
||||
void __init gic_cascade_irq(unsigned int gic_nr, unsigned int irq)
|
||||
|
|
|
|||
Loading…
Reference in a new issue