mirror of https://gitee.com/openkylin/qemu.git
Full MIPS64 MMU implementation, by Aurelien Jarno.
git-svn-id: svn://svn.savannah.nongnu.org/qemu/trunk@2820 c046a42c-6fe2-441c-8c8c-71466251a162
This commit is contained in:
parent
f1b0aa5de7
commit
100ce98812
|
@ -76,6 +76,9 @@ int r4k_map_address (CPUState *env, target_ulong *physical, int *prot,
|
|||
target_ulong mask = tlb->PageMask | ~(TARGET_PAGE_MASK << 1);
|
||||
target_ulong tag = address & ~mask;
|
||||
target_ulong VPN = tlb->VPN & ~mask;
|
||||
#ifdef TARGET_MIPS64
|
||||
tag &= 0xC00000FFFFFFFFFFULL;
|
||||
#endif
|
||||
|
||||
/* Check ASID, virtual page number & size */
|
||||
if ((tlb->G == 1 || tlb->ASID == ASID) && VPN == tag) {
|
||||
|
@ -295,10 +298,16 @@ int cpu_mips_handle_mmu_fault (CPUState *env, target_ulong address, int rw,
|
|||
}
|
||||
/* Raise exception */
|
||||
env->CP0_BadVAddr = address;
|
||||
env->CP0_Context = (env->CP0_Context & 0xff800000) |
|
||||
env->CP0_Context = (env->CP0_Context & ~0x007fffff) |
|
||||
((address >> 9) & 0x007ffff0);
|
||||
env->CP0_EntryHi =
|
||||
(env->CP0_EntryHi & 0xFF) | (address & (TARGET_PAGE_MASK << 1));
|
||||
#ifdef TARGET_MIPS64
|
||||
env->CP0_EntryHi &= 0xc00000ffffffffffULL;
|
||||
env->CP0_XContext = (env->CP0_XContext & 0xfffffffe00000000ULL) |
|
||||
((address >> 31) & 0x0000000180000000ULL) |
|
||||
((address >> 9) & 0x000000007ffffff0ULL);
|
||||
#endif
|
||||
env->exception_index = exception;
|
||||
env->error_code = error_code;
|
||||
ret = 1;
|
||||
|
@ -411,8 +420,19 @@ void do_interrupt (CPUState *env)
|
|||
goto set_EPC;
|
||||
case EXCP_TLBL:
|
||||
cause = 2;
|
||||
if (env->error_code == 1 && !(env->CP0_Status & (1 << CP0St_EXL)))
|
||||
offset = 0x000;
|
||||
if (env->error_code == 1 && !(env->CP0_Status & (1 << CP0St_EXL))) {
|
||||
#ifdef TARGET_MIPS64
|
||||
int R = env->CP0_BadVAddr >> 62;
|
||||
int UX = (env->CP0_Status & (1 << CP0St_UX)) != 0;
|
||||
int SX = (env->CP0_Status & (1 << CP0St_SX)) != 0;
|
||||
int KX = (env->CP0_Status & (1 << CP0St_KX)) != 0;
|
||||
|
||||
if ((R == 0 && UX) || (R == 1 && SX) || (R == 3 && KX))
|
||||
offset = 0x080;
|
||||
else
|
||||
#endif
|
||||
offset = 0x000;
|
||||
}
|
||||
goto set_EPC;
|
||||
case EXCP_IBE:
|
||||
cause = 6;
|
||||
|
@ -448,8 +468,19 @@ void do_interrupt (CPUState *env)
|
|||
goto set_EPC;
|
||||
case EXCP_TLBS:
|
||||
cause = 3;
|
||||
if (env->error_code == 1 && !(env->CP0_Status & (1 << CP0St_EXL)))
|
||||
offset = 0x000;
|
||||
if (env->error_code == 1 && !(env->CP0_Status & (1 << CP0St_EXL))) {
|
||||
#ifdef TARGET_MIPS64
|
||||
int R = env->CP0_BadVAddr >> 62;
|
||||
int UX = (env->CP0_Status & (1 << CP0St_UX)) != 0;
|
||||
int SX = (env->CP0_Status & (1 << CP0St_SX)) != 0;
|
||||
int KX = (env->CP0_Status & (1 << CP0St_KX)) != 0;
|
||||
|
||||
if ((R == 0 && UX) || (R == 1 && SX) || (R == 3 && KX))
|
||||
offset = 0x080;
|
||||
else
|
||||
#endif
|
||||
offset = 0x000;
|
||||
}
|
||||
set_EPC:
|
||||
if (!(env->CP0_Status & (1 << CP0St_EXL))) {
|
||||
if (env->hflags & MIPS_HFLAG_BMASK) {
|
||||
|
@ -520,6 +551,11 @@ void r4k_invalidate_tlb (CPUState *env, int idx, int use_extra)
|
|||
mask = tlb->PageMask | ~(TARGET_PAGE_MASK << 1);
|
||||
if (tlb->V0) {
|
||||
addr = tlb->VPN & ~mask;
|
||||
#ifdef TARGET_MIPS64
|
||||
if (addr >= 0xC00000FF80000000ULL) {
|
||||
addr |= 0x3FFFFF0000000000ULL;
|
||||
}
|
||||
#endif
|
||||
end = addr | (mask >> 1);
|
||||
while (addr < end) {
|
||||
tlb_flush_page (env, addr);
|
||||
|
@ -528,6 +564,11 @@ void r4k_invalidate_tlb (CPUState *env, int idx, int use_extra)
|
|||
}
|
||||
if (tlb->V1) {
|
||||
addr = (tlb->VPN & ~mask) | ((mask >> 1) + 1);
|
||||
#ifdef TARGET_MIPS64
|
||||
if (addr >= 0xC00000FF80000000ULL) {
|
||||
addr |= 0x3FFFFF0000000000ULL;
|
||||
}
|
||||
#endif
|
||||
end = addr | mask;
|
||||
while (addr < end) {
|
||||
tlb_flush_page (env, addr);
|
||||
|
|
|
@ -1317,8 +1317,10 @@ void op_mtc0_entryhi (void)
|
|||
target_ulong old, val;
|
||||
|
||||
/* 1k pages not implemented */
|
||||
/* Ignore MIPS64 TLB for now */
|
||||
val = (target_ulong)(int32_t)T0 & ~(target_ulong)0x1F00;
|
||||
val = T0 & ((TARGET_PAGE_MASK << 1) | 0xFF);
|
||||
#ifdef TARGET_MIPS64
|
||||
val = T0 & 0xC00000FFFFFFFFFFULL;
|
||||
#endif
|
||||
old = env->CP0_EntryHi;
|
||||
env->CP0_EntryHi = val;
|
||||
/* If the ASID changes, flush qemu's TLB. */
|
||||
|
|
|
@ -391,6 +391,9 @@ static void r4k_fill_tlb (int idx)
|
|||
/* XXX: detect conflicting TLBs and raise a MCHECK exception when needed */
|
||||
tlb = &env->mmu.r4k.tlb[idx];
|
||||
tlb->VPN = env->CP0_EntryHi & (TARGET_PAGE_MASK << 1);
|
||||
#ifdef TARGET_MIPS64
|
||||
tlb->VPN &= 0xC00000FFFFFFFFFFULL;
|
||||
#endif
|
||||
tlb->ASID = env->CP0_EntryHi & 0xFF;
|
||||
tlb->PageMask = env->CP0_PageMask;
|
||||
tlb->G = env->CP0_EntryLo0 & env->CP0_EntryLo1 & 1;
|
||||
|
|
Loading…
Reference in New Issue