|
@@ -80,18 +80,8 @@
|
|
|
#include <linux/stringify.h>
|
|
|
#include <asm/barrier.h>
|
|
|
|
|
|
-#define read_gicreg(r) \
|
|
|
- ({ \
|
|
|
- u64 reg; \
|
|
|
- asm volatile("mrs_s %0, " __stringify(r) : "=r" (reg)); \
|
|
|
- reg; \
|
|
|
- })
|
|
|
-
|
|
|
-#define write_gicreg(v,r) \
|
|
|
- do { \
|
|
|
- u64 __val = (v); \
|
|
|
- asm volatile("msr_s " __stringify(r) ", %0" : : "r" (__val));\
|
|
|
- } while (0)
|
|
|
+#define read_gicreg read_sysreg_s
|
|
|
+#define write_gicreg write_sysreg_s
|
|
|
|
|
|
/*
|
|
|
* Low-level accessors
|
|
@@ -102,13 +92,13 @@
|
|
|
|
|
|
static inline void gic_write_eoir(u32 irq)
|
|
|
{
|
|
|
- asm volatile("msr_s " __stringify(ICC_EOIR1_EL1) ", %0" : : "r" ((u64)irq));
|
|
|
+ write_sysreg_s(irq, ICC_EOIR1_EL1);
|
|
|
isb();
|
|
|
}
|
|
|
|
|
|
static inline void gic_write_dir(u32 irq)
|
|
|
{
|
|
|
- asm volatile("msr_s " __stringify(ICC_DIR_EL1) ", %0" : : "r" ((u64)irq));
|
|
|
+ write_sysreg_s(irq, ICC_DIR_EL1);
|
|
|
isb();
|
|
|
}
|
|
|
|
|
@@ -116,7 +106,7 @@ static inline u64 gic_read_iar_common(void)
|
|
|
{
|
|
|
u64 irqstat;
|
|
|
|
|
|
- asm volatile("mrs_s %0, " __stringify(ICC_IAR1_EL1) : "=r" (irqstat));
|
|
|
+ irqstat = read_sysreg_s(ICC_IAR1_EL1);
|
|
|
dsb(sy);
|
|
|
return irqstat;
|
|
|
}
|
|
@@ -134,10 +124,12 @@ static inline u64 gic_read_iar_cavium_thunderx(void)
|
|
|
|
|
|
asm volatile(
|
|
|
"nop;nop;nop;nop\n\t"
|
|
|
- "nop;nop;nop;nop\n\t"
|
|
|
- "mrs_s %0, " __stringify(ICC_IAR1_EL1) "\n\t"
|
|
|
- "nop;nop;nop;nop"
|
|
|
- : "=r" (irqstat));
|
|
|
+ "nop;nop;nop;nop");
|
|
|
+
|
|
|
+ irqstat = read_sysreg_s(ICC_IAR1_EL1);
|
|
|
+
|
|
|
+ asm volatile(
|
|
|
+ "nop;nop;nop;nop");
|
|
|
mb();
|
|
|
|
|
|
return irqstat;
|
|
@@ -145,37 +137,34 @@ static inline u64 gic_read_iar_cavium_thunderx(void)
|
|
|
|
|
|
static inline void gic_write_pmr(u32 val)
|
|
|
{
|
|
|
- asm volatile("msr_s " __stringify(ICC_PMR_EL1) ", %0" : : "r" ((u64)val));
|
|
|
+ write_sysreg_s(val, ICC_PMR_EL1);
|
|
|
}
|
|
|
|
|
|
static inline void gic_write_ctlr(u32 val)
|
|
|
{
|
|
|
- asm volatile("msr_s " __stringify(ICC_CTLR_EL1) ", %0" : : "r" ((u64)val));
|
|
|
+ write_sysreg_s(val, ICC_CTLR_EL1);
|
|
|
isb();
|
|
|
}
|
|
|
|
|
|
static inline void gic_write_grpen1(u32 val)
|
|
|
{
|
|
|
- asm volatile("msr_s " __stringify(ICC_GRPEN1_EL1) ", %0" : : "r" ((u64)val));
|
|
|
+ write_sysreg_s(val, ICC_GRPEN1_EL1);
|
|
|
isb();
|
|
|
}
|
|
|
|
|
|
static inline void gic_write_sgi1r(u64 val)
|
|
|
{
|
|
|
- asm volatile("msr_s " __stringify(ICC_SGI1R_EL1) ", %0" : : "r" (val));
|
|
|
+ write_sysreg_s(val, ICC_SGI1R_EL1);
|
|
|
}
|
|
|
|
|
|
static inline u32 gic_read_sre(void)
|
|
|
{
|
|
|
- u64 val;
|
|
|
-
|
|
|
- asm volatile("mrs_s %0, " __stringify(ICC_SRE_EL1) : "=r" (val));
|
|
|
- return val;
|
|
|
+ return read_sysreg_s(ICC_SRE_EL1);
|
|
|
}
|
|
|
|
|
|
static inline void gic_write_sre(u32 val)
|
|
|
{
|
|
|
- asm volatile("msr_s " __stringify(ICC_SRE_EL1) ", %0" : : "r" ((u64)val));
|
|
|
+ write_sysreg_s(val, ICC_SRE_EL1);
|
|
|
isb();
|
|
|
}
|
|
|
|