@@ -165,7 +165,7 @@ static void irq_handler(struct pt_regs *regs __unused)
return;
}
- gic_write_eoir(irqstat);
+ gic_write_eoir(irqstat, 1);
smp_rmb(); /* pairs with wmb in stats_reset */
++acked[smp_processor_id()];
@@ -27,13 +27,13 @@ static u32 cntfrq;
static volatile bool ipi_ready, ipi_received;
static void *vgic_dist_base;
-static void (*write_eoir)(u32 irqstat);
+static void (*write_eoir)(u32 irqstat, int group);
static void ipi_irq_handler(struct pt_regs *regs)
{
ipi_ready = false;
ipi_received = true;
- gic_write_eoir(gic_read_iar(1));
+ gic_write_eoir(gic_read_iar(1), 1);
ipi_ready = true;
}
@@ -135,7 +135,7 @@ static void eoi_exec(void)
int spurious_id = 1023; /* writes to EOI are ignored */
/* Avoid measuring assert(..) in gic_write_eoir */
- write_eoir(spurious_id);
+ write_eoir(spurious_id, 1);
}
struct exit_test {
@@ -137,7 +137,7 @@ static void irq_handler(struct pt_regs *regs)
u32 irqstat = gic_read_iar(1);
u32 irqnr = gic_iar_irqnr(irqstat);
- gic_write_eoir(irqstat);
+ gic_write_eoir(irqstat, 1);
if (irqnr == pl031_irq) {
report(" RTC RIS == 1", readl(&pl031->ris) == 1);
@@ -154,7 +154,7 @@ static void irq_handler(struct pt_regs *regs)
u32 irqnr = gic_iar_irqnr(irqstat);
if (irqnr != GICC_INT_SPURIOUS)
- gic_write_eoir(irqstat);
+ gic_write_eoir(irqstat, 1);
if (irqnr == PPI(vtimer_info.irq)) {
info = &vtimer_info;
@@ -17,6 +17,7 @@
#define ICC_PMR __ACCESS_CP15(c4, 0, c6, 0)
#define ICC_SGI1R __ACCESS_CP15_64(0, c12)
#define ICC_IAR0 __ACCESS_CP15(c12, 0, c8, 0)
+#define ICC_EOIR0 __ACCESS_CP15(c12, 0, c8, 1)
#define ICC_IAR1 __ACCESS_CP15(c12, 0, c12, 0)
#define ICC_EOIR1 __ACCESS_CP15(c12, 0, c12, 1)
#define ICC_IGRPEN1 __ACCESS_CP15(c12, 0, c12, 7)
@@ -44,9 +45,12 @@ static inline u32 gicv3_read_iar(int group)
return irqstat;
}
-static inline void gicv3_write_eoir(u32 irq)
+static inline void gicv3_write_eoir(u32 irq, int group)
{
- write_sysreg(irq, ICC_EOIR1);
+ if (group == 0)
+ write_sysreg(irq, ICC_EOIR0);
+ else
+ write_sysreg(irq, ICC_EOIR1);
isb();
}
@@ -34,7 +34,7 @@ extern int gicv2_init(void);
extern void gicv2_enable_defaults(void);
extern u32 gicv2_read_iar(int group);
extern u32 gicv2_iar_irqnr(u32 iar);
-extern void gicv2_write_eoir(u32 irqstat);
+extern void gicv2_write_eoir(u32 irqstat, int group);
extern void gicv2_ipi_send_single(int irq, int cpu);
extern void gicv2_ipi_send_mask(int irq, const cpumask_t *dest);
@@ -71,7 +71,7 @@ extern int gicv3_init(void);
extern void gicv3_enable_defaults(void);
extern u32 gicv3_read_iar(int group);
extern u32 gicv3_iar_irqnr(u32 iar);
-extern void gicv3_write_eoir(u32 irqstat);
+extern void gicv3_write_eoir(u32 irqstat, int group);
extern void gicv3_ipi_send_single(int irq, int cpu);
extern void gicv3_ipi_send_mask(int irq, const cpumask_t *dest);
extern void gicv3_set_redist_base(size_t stride);
@@ -70,7 +70,7 @@ extern void gic_enable_defaults(void);
extern int gic_version(void);
extern u32 gic_read_iar(int group);
extern u32 gic_iar_irqnr(u32 iar);
-extern void gic_write_eoir(u32 irqstat);
+extern void gic_write_eoir(u32 irqstat, int group);
extern void gic_ipi_send_single(int irq, int cpu);
extern void gic_ipi_send_mask(int irq, const cpumask_t *dest);
@@ -37,7 +37,7 @@ u32 gicv2_iar_irqnr(u32 iar)
return iar & GICC_IAR_INT_ID_MASK;
}
-void gicv2_write_eoir(u32 irqstat)
+void gicv2_write_eoir(u32 irqstat, int group)
{
writel(irqstat, gicv2_cpu_base() + GICC_EOIR);
}
@@ -14,7 +14,7 @@ struct gic_common_ops {
void (*enable_defaults)(void);
u32 (*read_iar)(int group);
u32 (*iar_irqnr)(u32 iar);
- void (*write_eoir)(u32 irqstat);
+ void (*write_eoir)(u32 irqstat, int group);
void (*ipi_send_single)(int irq, int cpu);
void (*ipi_send_mask)(int irq, const cpumask_t *dest);
};
@@ -129,10 +129,10 @@ u32 gic_iar_irqnr(u32 iar)
return gic_common_ops->iar_irqnr(iar);
}
-void gic_write_eoir(u32 irqstat)
+void gic_write_eoir(u32 irqstat, int group)
{
assert(gic_common_ops && gic_common_ops->write_eoir);
- gic_common_ops->write_eoir(irqstat);
+ gic_common_ops->write_eoir(irqstat, group);
}
void gic_ipi_send_single(int irq, int cpu)
@@ -12,6 +12,7 @@
#define ICC_PMR_EL1 sys_reg(3, 0, 4, 6, 0)
#define ICC_IAR0_EL1 sys_reg(3, 0, 12, 8, 0)
+#define ICC_EOIR0_EL1 sys_reg(3, 0, 12, 8, 1)
#define ICC_SGI1R_EL1 sys_reg(3, 0, 12, 11, 5)
#define ICC_IAR1_EL1 sys_reg(3, 0, 12, 12, 0)
#define ICC_EOIR1_EL1 sys_reg(3, 0, 12, 12, 1)
@@ -52,9 +53,14 @@ static inline u32 gicv3_read_iar(int group)
return (u64)irqstat;
}
-static inline void gicv3_write_eoir(u32 irq)
+static inline void gicv3_write_eoir(u32 irq, int group)
{
- asm volatile("msr_s " xstr(ICC_EOIR1_EL1) ", %0" : : "r" ((u64)irq));
+ if (group == 0)
+ asm volatile("msr_s " xstr(ICC_EOIR0_EL1) ", %0"
+ : : "r" ((u64)irq));
+ else
+ asm volatile("msr_s " xstr(ICC_EOIR1_EL1) ", %0"
+ : : "r" ((u64)irq));
isb();
}
EOIing GIC group 0 interrupt requires us to use a different system register on GICv3. To allow us to differentiate the two groups later, add a group parameter to write_eoir(). For GICv2 we can use the same CPU interface register to EOI group 0 IRQs as well, so we ignore the parameter here. For now this is still using group 1 on every caller. Signed-off-by: Andre Przywara <andre.przywara@arm.com> --- arm/gic.c | 2 +- arm/micro-bench.c | 6 +++--- arm/pl031.c | 2 +- arm/timer.c | 2 +- lib/arm/asm/arch_gicv3.h | 8 ++++++-- lib/arm/asm/gic-v2.h | 2 +- lib/arm/asm/gic-v3.h | 2 +- lib/arm/asm/gic.h | 2 +- lib/arm/gic-v2.c | 2 +- lib/arm/gic.c | 6 +++--- lib/arm64/asm/arch_gicv3.h | 10 ++++++++-- 11 files changed, 27 insertions(+), 17 deletions(-)