forked from Minki/linux
MIPS: Add guest CP0 accessors
Add guest CP0 accessors and guest TLB operations along the same lines as the existing macros and functions for the root CP0. Signed-off-by: James Hogan <james.hogan@imgtec.com> Acked-by: David Daney <david.daney@cavium.com> Cc: linux-mips@linux-mips.org Patchwork: https://patchwork.linux-mips.org/patch/13229/ Signed-off-by: Ralf Baechle <ralf@linux-mips.org>
This commit is contained in:
James Hogan
Ralf Baechle
parent
f913e9ea39
commit
7eb9111822
@ -1679,6 +1679,253 @@ do { \
|
||||
#define read_c0_brcm_sleepcount() __read_32bit_c0_register($22, 7)
|
||||
#define write_c0_brcm_sleepcount(val) __write_32bit_c0_register($22, 7, val)
|
||||
|
||||
/*
|
||||
* Macros to access the guest system control coprocessor
|
||||
*/
|
||||
|
||||
#define __read_32bit_gc0_register(source, sel) \
|
||||
({ int __res; \
|
||||
__asm__ __volatile__( \
|
||||
".set\tpush\n\t" \
|
||||
".set\tmips32r2\n\t" \
|
||||
".set\tvirt\n\t" \
|
||||
"mfgc0\t%0, " #source ", " #sel "\n\t" \
|
||||
".set\tpop" \
|
||||
: "=r" (__res)); \
|
||||
__res; \
|
||||
})
|
||||
|
||||
#define __read_64bit_gc0_register(source, sel) \
|
||||
({ unsigned long long __res; \
|
||||
__asm__ __volatile__( \
|
||||
".set\tpush\n\t" \
|
||||
".set\tmips64r2\n\t" \
|
||||
".set\tvirt\n\t" \
|
||||
"dmfgc0\t%0, " #source ", " #sel "\n\t" \
|
||||
".set\tpop" \
|
||||
: "=r" (__res)); \
|
||||
__res; \
|
||||
})
|
||||
|
||||
#define __write_32bit_gc0_register(register, sel, value) \
|
||||
do { \
|
||||
__asm__ __volatile__( \
|
||||
".set\tpush\n\t" \
|
||||
".set\tmips32r2\n\t" \
|
||||
".set\tvirt\n\t" \
|
||||
"mtgc0\t%z0, " #register ", " #sel "\n\t" \
|
||||
".set\tpop" \
|
||||
: : "Jr" ((unsigned int)(value))); \
|
||||
} while (0)
|
||||
|
||||
#define __write_64bit_gc0_register(register, sel, value) \
|
||||
do { \
|
||||
__asm__ __volatile__( \
|
||||
".set\tpush\n\t" \
|
||||
".set\tmips64r2\n\t" \
|
||||
".set\tvirt\n\t" \
|
||||
"dmtgc0\t%z0, " #register ", " #sel "\n\t" \
|
||||
".set\tpop" \
|
||||
: : "Jr" (value)); \
|
||||
} while (0)
|
||||
|
||||
#define __read_ulong_gc0_register(reg, sel) \
|
||||
((sizeof(unsigned long) == 4) ? \
|
||||
(unsigned long) __read_32bit_gc0_register(reg, sel) : \
|
||||
(unsigned long) __read_64bit_gc0_register(reg, sel))
|
||||
|
||||
#define __write_ulong_gc0_register(reg, sel, val) \
|
||||
do { \
|
||||
if (sizeof(unsigned long) == 4) \
|
||||
__write_32bit_gc0_register(reg, sel, val); \
|
||||
else \
|
||||
__write_64bit_gc0_register(reg, sel, val); \
|
||||
} while (0)
|
||||
|
||||
#define read_gc0_index() __read_32bit_gc0_register($0, 0)
|
||||
#define write_gc0_index(val) __write_32bit_gc0_register($0, 0, val)
|
||||
|
||||
#define read_gc0_entrylo0() __read_ulong_gc0_register($2, 0)
|
||||
#define write_gc0_entrylo0(val) __write_ulong_gc0_register($2, 0, val)
|
||||
|
||||
#define read_gc0_entrylo1() __read_ulong_gc0_register($3, 0)
|
||||
#define write_gc0_entrylo1(val) __write_ulong_gc0_register($3, 0, val)
|
||||
|
||||
#define read_gc0_context() __read_ulong_gc0_register($4, 0)
|
||||
#define write_gc0_context(val) __write_ulong_gc0_register($4, 0, val)
|
||||
|
||||
#define read_gc0_contextconfig() __read_32bit_gc0_register($4, 1)
|
||||
#define write_gc0_contextconfig(val) __write_32bit_gc0_register($4, 1, val)
|
||||
|
||||
#define read_gc0_userlocal() __read_ulong_gc0_register($4, 2)
|
||||
#define write_gc0_userlocal(val) __write_ulong_gc0_register($4, 2, val)
|
||||
|
||||
#define read_gc0_xcontextconfig() __read_ulong_gc0_register($4, 3)
|
||||
#define write_gc0_xcontextconfig(val) __write_ulong_gc0_register($4, 3, val)
|
||||
|
||||
#define read_gc0_pagemask() __read_32bit_gc0_register($5, 0)
|
||||
#define write_gc0_pagemask(val) __write_32bit_gc0_register($5, 0, val)
|
||||
|
||||
#define read_gc0_pagegrain() __read_32bit_gc0_register($5, 1)
|
||||
#define write_gc0_pagegrain(val) __write_32bit_gc0_register($5, 1, val)
|
||||
|
||||
#define read_gc0_segctl0() __read_ulong_gc0_register($5, 2)
|
||||
#define write_gc0_segctl0(val) __write_ulong_gc0_register($5, 2, val)
|
||||
|
||||
#define read_gc0_segctl1() __read_ulong_gc0_register($5, 3)
|
||||
#define write_gc0_segctl1(val) __write_ulong_gc0_register($5, 3, val)
|
||||
|
||||
#define read_gc0_segctl2() __read_ulong_gc0_register($5, 4)
|
||||
#define write_gc0_segctl2(val) __write_ulong_gc0_register($5, 4, val)
|
||||
|
||||
#define read_gc0_pwbase() __read_ulong_gc0_register($5, 5)
|
||||
#define write_gc0_pwbase(val) __write_ulong_gc0_register($5, 5, val)
|
||||
|
||||
#define read_gc0_pwfield() __read_ulong_gc0_register($5, 6)
|
||||
#define write_gc0_pwfield(val) __write_ulong_gc0_register($5, 6, val)
|
||||
|
||||
#define read_gc0_pwsize() __read_ulong_gc0_register($5, 7)
|
||||
#define write_gc0_pwsize(val) __write_ulong_gc0_register($5, 7, val)
|
||||
|
||||
#define read_gc0_wired() __read_32bit_gc0_register($6, 0)
|
||||
#define write_gc0_wired(val) __write_32bit_gc0_register($6, 0, val)
|
||||
|
||||
#define read_gc0_pwctl() __read_32bit_gc0_register($6, 6)
|
||||
#define write_gc0_pwctl(val) __write_32bit_gc0_register($6, 6, val)
|
||||
|
||||
#define read_gc0_hwrena() __read_32bit_gc0_register($7, 0)
|
||||
#define write_gc0_hwrena(val) __write_32bit_gc0_register($7, 0, val)
|
||||
|
||||
#define read_gc0_badvaddr() __read_ulong_gc0_register($8, 0)
|
||||
#define write_gc0_badvaddr(val) __write_ulong_gc0_register($8, 0, val)
|
||||
|
||||
#define read_gc0_badinstr() __read_32bit_gc0_register($8, 1)
|
||||
#define write_gc0_badinstr(val) __write_32bit_gc0_register($8, 1, val)
|
||||
|
||||
#define read_gc0_badinstrp() __read_32bit_gc0_register($8, 2)
|
||||
#define write_gc0_badinstrp(val) __write_32bit_gc0_register($8, 2, val)
|
||||
|
||||
#define read_gc0_count() __read_32bit_gc0_register($9, 0)
|
||||
|
||||
#define read_gc0_entryhi() __read_ulong_gc0_register($10, 0)
|
||||
#define write_gc0_entryhi(val) __write_ulong_gc0_register($10, 0, val)
|
||||
|
||||
#define read_gc0_compare() __read_32bit_gc0_register($11, 0)
|
||||
#define write_gc0_compare(val) __write_32bit_gc0_register($11, 0, val)
|
||||
|
||||
#define read_gc0_status() __read_32bit_gc0_register($12, 0)
|
||||
#define write_gc0_status(val) __write_32bit_gc0_register($12, 0, val)
|
||||
|
||||
#define read_gc0_intctl() __read_32bit_gc0_register($12, 1)
|
||||
#define write_gc0_intctl(val) __write_32bit_gc0_register($12, 1, val)
|
||||
|
||||
#define read_gc0_cause() __read_32bit_gc0_register($13, 0)
|
||||
#define write_gc0_cause(val) __write_32bit_gc0_register($13, 0, val)
|
||||
|
||||
#define read_gc0_epc() __read_ulong_gc0_register($14, 0)
|
||||
#define write_gc0_epc(val) __write_ulong_gc0_register($14, 0, val)
|
||||
|
||||
#define read_gc0_ebase() __read_32bit_gc0_register($15, 1)
|
||||
#define write_gc0_ebase(val) __write_32bit_gc0_register($15, 1, val)
|
||||
|
||||
#define read_gc0_ebase_64() __read_64bit_gc0_register($15, 1)
|
||||
#define write_gc0_ebase_64(val) __write_64bit_gc0_register($15, 1, val)
|
||||
|
||||
#define read_gc0_config() __read_32bit_gc0_register($16, 0)
|
||||
#define read_gc0_config1() __read_32bit_gc0_register($16, 1)
|
||||
#define read_gc0_config2() __read_32bit_gc0_register($16, 2)
|
||||
#define read_gc0_config3() __read_32bit_gc0_register($16, 3)
|
||||
#define read_gc0_config4() __read_32bit_gc0_register($16, 4)
|
||||
#define read_gc0_config5() __read_32bit_gc0_register($16, 5)
|
||||
#define read_gc0_config6() __read_32bit_gc0_register($16, 6)
|
||||
#define read_gc0_config7() __read_32bit_gc0_register($16, 7)
|
||||
#define write_gc0_config(val) __write_32bit_gc0_register($16, 0, val)
|
||||
#define write_gc0_config1(val) __write_32bit_gc0_register($16, 1, val)
|
||||
#define write_gc0_config2(val) __write_32bit_gc0_register($16, 2, val)
|
||||
#define write_gc0_config3(val) __write_32bit_gc0_register($16, 3, val)
|
||||
#define write_gc0_config4(val) __write_32bit_gc0_register($16, 4, val)
|
||||
#define write_gc0_config5(val) __write_32bit_gc0_register($16, 5, val)
|
||||
#define write_gc0_config6(val) __write_32bit_gc0_register($16, 6, val)
|
||||
#define write_gc0_config7(val) __write_32bit_gc0_register($16, 7, val)
|
||||
|
||||
#define read_gc0_watchlo0() __read_ulong_gc0_register($18, 0)
|
||||
#define read_gc0_watchlo1() __read_ulong_gc0_register($18, 1)
|
||||
#define read_gc0_watchlo2() __read_ulong_gc0_register($18, 2)
|
||||
#define read_gc0_watchlo3() __read_ulong_gc0_register($18, 3)
|
||||
#define read_gc0_watchlo4() __read_ulong_gc0_register($18, 4)
|
||||
#define read_gc0_watchlo5() __read_ulong_gc0_register($18, 5)
|
||||
#define read_gc0_watchlo6() __read_ulong_gc0_register($18, 6)
|
||||
#define read_gc0_watchlo7() __read_ulong_gc0_register($18, 7)
|
||||
#define write_gc0_watchlo0(val) __write_ulong_gc0_register($18, 0, val)
|
||||
#define write_gc0_watchlo1(val) __write_ulong_gc0_register($18, 1, val)
|
||||
#define write_gc0_watchlo2(val) __write_ulong_gc0_register($18, 2, val)
|
||||
#define write_gc0_watchlo3(val) __write_ulong_gc0_register($18, 3, val)
|
||||
#define write_gc0_watchlo4(val) __write_ulong_gc0_register($18, 4, val)
|
||||
#define write_gc0_watchlo5(val) __write_ulong_gc0_register($18, 5, val)
|
||||
#define write_gc0_watchlo6(val) __write_ulong_gc0_register($18, 6, val)
|
||||
#define write_gc0_watchlo7(val) __write_ulong_gc0_register($18, 7, val)
|
||||
|
||||
#define read_gc0_watchhi0() __read_32bit_gc0_register($19, 0)
|
||||
#define read_gc0_watchhi1() __read_32bit_gc0_register($19, 1)
|
||||
#define read_gc0_watchhi2() __read_32bit_gc0_register($19, 2)
|
||||
#define read_gc0_watchhi3() __read_32bit_gc0_register($19, 3)
|
||||
#define read_gc0_watchhi4() __read_32bit_gc0_register($19, 4)
|
||||
#define read_gc0_watchhi5() __read_32bit_gc0_register($19, 5)
|
||||
#define read_gc0_watchhi6() __read_32bit_gc0_register($19, 6)
|
||||
#define read_gc0_watchhi7() __read_32bit_gc0_register($19, 7)
|
||||
#define write_gc0_watchhi0(val) __write_32bit_gc0_register($19, 0, val)
|
||||
#define write_gc0_watchhi1(val) __write_32bit_gc0_register($19, 1, val)
|
||||
#define write_gc0_watchhi2(val) __write_32bit_gc0_register($19, 2, val)
|
||||
#define write_gc0_watchhi3(val) __write_32bit_gc0_register($19, 3, val)
|
||||
#define write_gc0_watchhi4(val) __write_32bit_gc0_register($19, 4, val)
|
||||
#define write_gc0_watchhi5(val) __write_32bit_gc0_register($19, 5, val)
|
||||
#define write_gc0_watchhi6(val) __write_32bit_gc0_register($19, 6, val)
|
||||
#define write_gc0_watchhi7(val) __write_32bit_gc0_register($19, 7, val)
|
||||
|
||||
#define read_gc0_xcontext() __read_ulong_gc0_register($20, 0)
|
||||
#define write_gc0_xcontext(val) __write_ulong_gc0_register($20, 0, val)
|
||||
|
||||
#define read_gc0_perfctrl0() __read_32bit_gc0_register($25, 0)
|
||||
#define write_gc0_perfctrl0(val) __write_32bit_gc0_register($25, 0, val)
|
||||
#define read_gc0_perfcntr0() __read_32bit_gc0_register($25, 1)
|
||||
#define write_gc0_perfcntr0(val) __write_32bit_gc0_register($25, 1, val)
|
||||
#define read_gc0_perfcntr0_64() __read_64bit_gc0_register($25, 1)
|
||||
#define write_gc0_perfcntr0_64(val) __write_64bit_gc0_register($25, 1, val)
|
||||
#define read_gc0_perfctrl1() __read_32bit_gc0_register($25, 2)
|
||||
#define write_gc0_perfctrl1(val) __write_32bit_gc0_register($25, 2, val)
|
||||
#define read_gc0_perfcntr1() __read_32bit_gc0_register($25, 3)
|
||||
#define write_gc0_perfcntr1(val) __write_32bit_gc0_register($25, 3, val)
|
||||
#define read_gc0_perfcntr1_64() __read_64bit_gc0_register($25, 3)
|
||||
#define write_gc0_perfcntr1_64(val) __write_64bit_gc0_register($25, 3, val)
|
||||
#define read_gc0_perfctrl2() __read_32bit_gc0_register($25, 4)
|
||||
#define write_gc0_perfctrl2(val) __write_32bit_gc0_register($25, 4, val)
|
||||
#define read_gc0_perfcntr2() __read_32bit_gc0_register($25, 5)
|
||||
#define write_gc0_perfcntr2(val) __write_32bit_gc0_register($25, 5, val)
|
||||
#define read_gc0_perfcntr2_64() __read_64bit_gc0_register($25, 5)
|
||||
#define write_gc0_perfcntr2_64(val) __write_64bit_gc0_register($25, 5, val)
|
||||
#define read_gc0_perfctrl3() __read_32bit_gc0_register($25, 6)
|
||||
#define write_gc0_perfctrl3(val) __write_32bit_gc0_register($25, 6, val)
|
||||
#define read_gc0_perfcntr3() __read_32bit_gc0_register($25, 7)
|
||||
#define write_gc0_perfcntr3(val) __write_32bit_gc0_register($25, 7, val)
|
||||
#define read_gc0_perfcntr3_64() __read_64bit_gc0_register($25, 7)
|
||||
#define write_gc0_perfcntr3_64(val) __write_64bit_gc0_register($25, 7, val)
|
||||
|
||||
#define read_gc0_errorepc() __read_ulong_gc0_register($30, 0)
|
||||
#define write_gc0_errorepc(val) __write_ulong_gc0_register($30, 0, val)
|
||||
|
||||
#define read_gc0_kscratch1() __read_ulong_gc0_register($31, 2)
|
||||
#define read_gc0_kscratch2() __read_ulong_gc0_register($31, 3)
|
||||
#define read_gc0_kscratch3() __read_ulong_gc0_register($31, 4)
|
||||
#define read_gc0_kscratch4() __read_ulong_gc0_register($31, 5)
|
||||
#define read_gc0_kscratch5() __read_ulong_gc0_register($31, 6)
|
||||
#define read_gc0_kscratch6() __read_ulong_gc0_register($31, 7)
|
||||
#define write_gc0_kscratch1(val) __write_ulong_gc0_register($31, 2, val)
|
||||
#define write_gc0_kscratch2(val) __write_ulong_gc0_register($31, 3, val)
|
||||
#define write_gc0_kscratch3(val) __write_ulong_gc0_register($31, 4, val)
|
||||
#define write_gc0_kscratch4(val) __write_ulong_gc0_register($31, 5, val)
|
||||
#define write_gc0_kscratch5(val) __write_ulong_gc0_register($31, 6, val)
|
||||
#define write_gc0_kscratch6(val) __write_ulong_gc0_register($31, 7, val)
|
||||
|
||||
/*
|
||||
* Macros to access the floating point coprocessor control registers
|
||||
*/
|
||||
@ -2175,46 +2422,109 @@ static inline void tlb_write_random(void)
|
||||
}
|
||||
|
||||
/*
|
||||
* Manipulate bits in a c0 register.
|
||||
* Guest TLB operations.
|
||||
*
|
||||
* It is responsibility of the caller to take care of any TLB hazards.
|
||||
*/
|
||||
#define __BUILD_SET_C0(name) \
|
||||
static inline void guest_tlb_probe(void)
|
||||
{
|
||||
__asm__ __volatile__(
|
||||
".set push\n\t"
|
||||
".set noreorder\n\t"
|
||||
".set virt\n\t"
|
||||
"tlbgp\n\t"
|
||||
".set pop");
|
||||
}
|
||||
|
||||
static inline void guest_tlb_read(void)
|
||||
{
|
||||
__asm__ __volatile__(
|
||||
".set push\n\t"
|
||||
".set noreorder\n\t"
|
||||
".set virt\n\t"
|
||||
"tlbgr\n\t"
|
||||
".set pop");
|
||||
}
|
||||
|
||||
static inline void guest_tlb_write_indexed(void)
|
||||
{
|
||||
__asm__ __volatile__(
|
||||
".set push\n\t"
|
||||
".set noreorder\n\t"
|
||||
".set virt\n\t"
|
||||
"tlbgwi\n\t"
|
||||
".set pop");
|
||||
}
|
||||
|
||||
static inline void guest_tlb_write_random(void)
|
||||
{
|
||||
__asm__ __volatile__(
|
||||
".set push\n\t"
|
||||
".set noreorder\n\t"
|
||||
".set virt\n\t"
|
||||
"tlbgwr\n\t"
|
||||
".set pop");
|
||||
}
|
||||
|
||||
/*
|
||||
* Guest TLB Invalidate Flush
|
||||
*/
|
||||
static inline void guest_tlbinvf(void)
|
||||
{
|
||||
__asm__ __volatile__(
|
||||
".set push\n\t"
|
||||
".set noreorder\n\t"
|
||||
".set virt\n\t"
|
||||
"tlbginvf\n\t"
|
||||
".set pop");
|
||||
}
|
||||
|
||||
/*
|
||||
* Manipulate bits in a register.
|
||||
*/
|
||||
#define __BUILD_SET_COMMON(name) \
|
||||
static inline unsigned int \
|
||||
set_c0_##name(unsigned int set) \
|
||||
set_##name(unsigned int set) \
|
||||
{ \
|
||||
unsigned int res, new; \
|
||||
\
|
||||
res = read_c0_##name(); \
|
||||
res = read_##name(); \
|
||||
new = res | set; \
|
||||
write_c0_##name(new); \
|
||||
write_##name(new); \
|
||||
\
|
||||
return res; \
|
||||
} \
|
||||
\
|
||||
static inline unsigned int \
|
||||
clear_c0_##name(unsigned int clear) \
|
||||
clear_##name(unsigned int clear) \
|
||||
{ \
|
||||
unsigned int res, new; \
|
||||
\
|
||||
res = read_c0_##name(); \
|
||||
res = read_##name(); \
|
||||
new = res & ~clear; \
|
||||
write_c0_##name(new); \
|
||||
write_##name(new); \
|
||||
\
|
||||
return res; \
|
||||
} \
|
||||
\
|
||||
static inline unsigned int \
|
||||
change_c0_##name(unsigned int change, unsigned int val) \
|
||||
change_##name(unsigned int change, unsigned int val) \
|
||||
{ \
|
||||
unsigned int res, new; \
|
||||
\
|
||||
res = read_c0_##name(); \
|
||||
res = read_##name(); \
|
||||
new = res & ~change; \
|
||||
new |= (val & change); \
|
||||
write_c0_##name(new); \
|
||||
write_##name(new); \
|
||||
\
|
||||
return res; \
|
||||
}
|
||||
|
||||
/*
|
||||
* Manipulate bits in a c0 register.
|
||||
*/
|
||||
#define __BUILD_SET_C0(name) __BUILD_SET_COMMON(c0_##name)
|
||||
|
||||
__BUILD_SET_C0(status)
|
||||
__BUILD_SET_C0(cause)
|
||||
__BUILD_SET_C0(config)
|
||||
@ -2236,6 +2546,15 @@ __BUILD_SET_C0(brcm_cmt_ctrl)
|
||||
__BUILD_SET_C0(brcm_config)
|
||||
__BUILD_SET_C0(brcm_mode)
|
||||
|
||||
/*
|
||||
* Manipulate bits in a guest c0 register.
|
||||
*/
|
||||
#define __BUILD_SET_GC0(name) __BUILD_SET_COMMON(gc0_##name)
|
||||
|
||||
__BUILD_SET_GC0(status)
|
||||
__BUILD_SET_GC0(cause)
|
||||
__BUILD_SET_GC0(ebase)
|
||||
|
||||
/*
|
||||
* Return low 10 bits of ebase.
|
||||
* Note that under KVM (MIPSVZ) this returns vcpu id.
|
||||
|
||||
Loading…
Reference in New Issue
Block a user