]> git.proxmox.com Git - mirror_qemu.git/blame - target-mips/helper.c
Disable phsyical memory handling in userspace emulation.
[mirror_qemu.git] / target-mips / helper.c
CommitLineData
6af0bf9c
FB
1/*
2 * MIPS emulation helpers for qemu.
5fafdf24 3 *
6af0bf9c
FB
4 * Copyright (c) 2004-2005 Jocelyn Mayer
5 *
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2 of the License, or (at your option) any later version.
10 *
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
15 *
16 * You should have received a copy of the GNU Lesser General Public
8167ee88 17 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
6af0bf9c 18 */
e37e863f
FB
19#include <stdarg.h>
20#include <stdlib.h>
21#include <stdio.h>
22#include <string.h>
23#include <inttypes.h>
24#include <signal.h>
e37e863f
FB
25
26#include "cpu.h"
27#include "exec-all.h"
6af0bf9c 28
43057ab1
FB
29enum {
30 TLBRET_DIRTY = -4,
31 TLBRET_INVALID = -3,
32 TLBRET_NOMATCH = -2,
33 TLBRET_BADADDR = -1,
34 TLBRET_MATCH = 0
35};
36
29929e34 37/* no MMU emulation */
60c9af07 38int no_mmu_map_address (CPUState *env, target_phys_addr_t *physical, int *prot,
6af0bf9c 39 target_ulong address, int rw, int access_type)
29929e34
TS
40{
41 *physical = address;
42 *prot = PAGE_READ | PAGE_WRITE;
43 return TLBRET_MATCH;
44}
45
46/* fixed mapping MMU emulation */
60c9af07 47int fixed_mmu_map_address (CPUState *env, target_phys_addr_t *physical, int *prot,
29929e34
TS
48 target_ulong address, int rw, int access_type)
49{
50 if (address <= (int32_t)0x7FFFFFFFUL) {
51 if (!(env->CP0_Status & (1 << CP0St_ERL)))
52 *physical = address + 0x40000000UL;
53 else
54 *physical = address;
55 } else if (address <= (int32_t)0xBFFFFFFFUL)
56 *physical = address & 0x1FFFFFFF;
57 else
58 *physical = address;
59
60 *prot = PAGE_READ | PAGE_WRITE;
61 return TLBRET_MATCH;
62}
63
64/* MIPS32/MIPS64 R4000-style MMU emulation */
60c9af07 65int r4k_map_address (CPUState *env, target_phys_addr_t *physical, int *prot,
29929e34 66 target_ulong address, int rw, int access_type)
6af0bf9c 67{
925fd0f2 68 uint8_t ASID = env->CP0_EntryHi & 0xFF;
3b1c8be4 69 int i;
6af0bf9c 70
ead9360e 71 for (i = 0; i < env->tlb->tlb_in_use; i++) {
c227f099 72 r4k_tlb_t *tlb = &env->tlb->mmu.r4k.tlb[i];
3b1c8be4 73 /* 1k pages are not supported. */
f2e9ebef 74 target_ulong mask = tlb->PageMask | ~(TARGET_PAGE_MASK << 1);
3b1c8be4 75 target_ulong tag = address & ~mask;
f2e9ebef 76 target_ulong VPN = tlb->VPN & ~mask;
d26bc211 77#if defined(TARGET_MIPS64)
e034e2c3 78 tag &= env->SEGMask;
100ce988 79#endif
3b1c8be4 80
6af0bf9c 81 /* Check ASID, virtual page number & size */
f2e9ebef 82 if ((tlb->G == 1 || tlb->ASID == ASID) && VPN == tag) {
6af0bf9c 83 /* TLB match */
f2e9ebef 84 int n = !!(address & mask & ~(mask >> 1));
6af0bf9c 85 /* Check access rights */
f2e9ebef 86 if (!(n ? tlb->V1 : tlb->V0))
43057ab1 87 return TLBRET_INVALID;
f2e9ebef 88 if (rw == 0 || (n ? tlb->D1 : tlb->D0)) {
3b1c8be4 89 *physical = tlb->PFN[n] | (address & (mask >> 1));
9fb63ac2 90 *prot = PAGE_READ;
98c1b82b 91 if (n ? tlb->D1 : tlb->D0)
9fb63ac2 92 *prot |= PAGE_WRITE;
43057ab1 93 return TLBRET_MATCH;
6af0bf9c 94 }
43057ab1 95 return TLBRET_DIRTY;
6af0bf9c
FB
96 }
97 }
43057ab1 98 return TLBRET_NOMATCH;
6af0bf9c 99}
6af0bf9c 100
932e71cd 101#if !defined(CONFIG_USER_ONLY)
60c9af07 102static int get_physical_address (CPUState *env, target_phys_addr_t *physical,
43057ab1
FB
103 int *prot, target_ulong address,
104 int rw, int access_type)
6af0bf9c 105{
b4ab4b4e 106 /* User mode can only access useg/xuseg */
43057ab1 107 int user_mode = (env->hflags & MIPS_HFLAG_MODE) == MIPS_HFLAG_UM;
671880e6
TS
108 int supervisor_mode = (env->hflags & MIPS_HFLAG_MODE) == MIPS_HFLAG_SM;
109 int kernel_mode = !user_mode && !supervisor_mode;
d26bc211 110#if defined(TARGET_MIPS64)
b4ab4b4e
TS
111 int UX = (env->CP0_Status & (1 << CP0St_UX)) != 0;
112 int SX = (env->CP0_Status & (1 << CP0St_SX)) != 0;
113 int KX = (env->CP0_Status & (1 << CP0St_KX)) != 0;
114#endif
43057ab1
FB
115 int ret = TLBRET_MATCH;
116
6af0bf9c 117#if 0
93fcfe39 118 qemu_log("user mode %d h %08x\n", user_mode, env->hflags);
6af0bf9c 119#endif
b4ab4b4e 120
b4ab4b4e
TS
121 if (address <= (int32_t)0x7FFFFFFFUL) {
122 /* useg */
996ba2cc 123 if (env->CP0_Status & (1 << CP0St_ERL)) {
29929e34 124 *physical = address & 0xFFFFFFFF;
6af0bf9c 125 *prot = PAGE_READ | PAGE_WRITE;
996ba2cc 126 } else {
ead9360e 127 ret = env->tlb->map_address(env, physical, prot, address, rw, access_type);
6af0bf9c 128 }
d26bc211 129#if defined(TARGET_MIPS64)
89fc88da 130 } else if (address < 0x4000000000000000ULL) {
b4ab4b4e 131 /* xuseg */
6958549d 132 if (UX && address <= (0x3FFFFFFFFFFFFFFFULL & env->SEGMask)) {
ead9360e 133 ret = env->tlb->map_address(env, physical, prot, address, rw, access_type);
6958549d
AJ
134 } else {
135 ret = TLBRET_BADADDR;
b4ab4b4e 136 }
89fc88da 137 } else if (address < 0x8000000000000000ULL) {
b4ab4b4e 138 /* xsseg */
6958549d
AJ
139 if ((supervisor_mode || kernel_mode) &&
140 SX && address <= (0x7FFFFFFFFFFFFFFFULL & env->SEGMask)) {
ead9360e 141 ret = env->tlb->map_address(env, physical, prot, address, rw, access_type);
6958549d
AJ
142 } else {
143 ret = TLBRET_BADADDR;
b4ab4b4e 144 }
89fc88da 145 } else if (address < 0xC000000000000000ULL) {
b4ab4b4e 146 /* xkphys */
671880e6 147 if (kernel_mode && KX &&
6d35524c
TS
148 (address & 0x07FFFFFFFFFFFFFFULL) <= env->PAMask) {
149 *physical = address & env->PAMask;
b4ab4b4e 150 *prot = PAGE_READ | PAGE_WRITE;
6958549d
AJ
151 } else {
152 ret = TLBRET_BADADDR;
153 }
89fc88da 154 } else if (address < 0xFFFFFFFF80000000ULL) {
b4ab4b4e 155 /* xkseg */
6958549d
AJ
156 if (kernel_mode && KX &&
157 address <= (0xFFFFFFFF7FFFFFFFULL & env->SEGMask)) {
ead9360e 158 ret = env->tlb->map_address(env, physical, prot, address, rw, access_type);
6958549d
AJ
159 } else {
160 ret = TLBRET_BADADDR;
161 }
b4ab4b4e 162#endif
5dc4b744 163 } else if (address < (int32_t)0xA0000000UL) {
6af0bf9c 164 /* kseg0 */
671880e6
TS
165 if (kernel_mode) {
166 *physical = address - (int32_t)0x80000000UL;
167 *prot = PAGE_READ | PAGE_WRITE;
168 } else {
169 ret = TLBRET_BADADDR;
170 }
5dc4b744 171 } else if (address < (int32_t)0xC0000000UL) {
6af0bf9c 172 /* kseg1 */
671880e6
TS
173 if (kernel_mode) {
174 *physical = address - (int32_t)0xA0000000UL;
175 *prot = PAGE_READ | PAGE_WRITE;
176 } else {
177 ret = TLBRET_BADADDR;
178 }
5dc4b744 179 } else if (address < (int32_t)0xE0000000UL) {
89fc88da 180 /* sseg (kseg2) */
671880e6
TS
181 if (supervisor_mode || kernel_mode) {
182 ret = env->tlb->map_address(env, physical, prot, address, rw, access_type);
183 } else {
184 ret = TLBRET_BADADDR;
185 }
6af0bf9c
FB
186 } else {
187 /* kseg3 */
6af0bf9c 188 /* XXX: debug segment is not emulated */
671880e6
TS
189 if (kernel_mode) {
190 ret = env->tlb->map_address(env, physical, prot, address, rw, access_type);
191 } else {
192 ret = TLBRET_BADADDR;
193 }
6af0bf9c
FB
194 }
195#if 0
93fcfe39
AL
196 qemu_log(TARGET_FMT_lx " %d %d => " TARGET_FMT_lx " %d (%d)\n",
197 address, rw, access_type, *physical, *prot, ret);
6af0bf9c
FB
198#endif
199
200 return ret;
201}
932e71cd 202#endif
6af0bf9c 203
1147e189
AJ
204static void raise_mmu_exception(CPUState *env, target_ulong address,
205 int rw, int tlb_error)
206{
207 int exception = 0, error_code = 0;
208
209 switch (tlb_error) {
210 default:
211 case TLBRET_BADADDR:
212 /* Reference to kernel address from user mode or supervisor mode */
213 /* Reference to supervisor address from user mode */
214 if (rw)
215 exception = EXCP_AdES;
216 else
217 exception = EXCP_AdEL;
218 break;
219 case TLBRET_NOMATCH:
220 /* No TLB match for a mapped address */
221 if (rw)
222 exception = EXCP_TLBS;
223 else
224 exception = EXCP_TLBL;
225 error_code = 1;
226 break;
227 case TLBRET_INVALID:
228 /* TLB match with no valid bit */
229 if (rw)
230 exception = EXCP_TLBS;
231 else
232 exception = EXCP_TLBL;
233 break;
234 case TLBRET_DIRTY:
235 /* TLB match but 'D' bit is cleared */
236 exception = EXCP_LTLBL;
237 break;
238
239 }
240 /* Raise exception */
241 env->CP0_BadVAddr = address;
242 env->CP0_Context = (env->CP0_Context & ~0x007fffff) |
243 ((address >> 9) & 0x007ffff0);
244 env->CP0_EntryHi =
245 (env->CP0_EntryHi & 0xFF) | (address & (TARGET_PAGE_MASK << 1));
246#if defined(TARGET_MIPS64)
247 env->CP0_EntryHi &= env->SEGMask;
248 env->CP0_XContext = (env->CP0_XContext & ((~0ULL) << (env->SEGBITS - 7))) |
249 ((address & 0xC00000000000ULL) >> (55 - env->SEGBITS)) |
250 ((address & ((1ULL << env->SEGBITS) - 1) & 0xFFFFFFFFFFFFE000ULL) >> 9);
251#endif
252 env->exception_index = exception;
253 env->error_code = error_code;
254}
255
c227f099 256target_phys_addr_t cpu_get_phys_page_debug(CPUState *env, target_ulong addr)
6af0bf9c 257{
932e71cd
AJ
258#if defined(CONFIG_USER_ONLY)
259 return addr;
260#else
60c9af07 261 target_phys_addr_t phys_addr;
932e71cd 262 int prot;
6af0bf9c 263
932e71cd
AJ
264 if (get_physical_address(env, &phys_addr, &prot, addr, 0, ACCESS_INT) != 0)
265 return -1;
266 return phys_addr;
267#endif
6af0bf9c 268}
6af0bf9c 269
6af0bf9c 270int cpu_mips_handle_mmu_fault (CPUState *env, target_ulong address, int rw,
6ebbf390 271 int mmu_idx, int is_softmmu)
6af0bf9c 272{
932e71cd 273#if !defined(CONFIG_USER_ONLY)
60c9af07 274 target_phys_addr_t physical;
6af0bf9c 275 int prot;
932e71cd 276#endif
6af0bf9c
FB
277 int access_type;
278 int ret = 0;
279
4ad40f36 280#if 0
93fcfe39 281 log_cpu_state(env, 0);
4ad40f36 282#endif
93fcfe39
AL
283 qemu_log("%s pc " TARGET_FMT_lx " ad " TARGET_FMT_lx " rw %d mmu_idx %d smmu %d\n",
284 __func__, env->active_tc.PC, address, rw, mmu_idx, is_softmmu);
4ad40f36
FB
285
286 rw &= 1;
287
6af0bf9c
FB
288 /* data access */
289 /* XXX: put correct access by using cpu_restore_state()
290 correctly */
291 access_type = ACCESS_INT;
932e71cd
AJ
292#if defined(CONFIG_USER_ONLY)
293 ret = TLBRET_NOMATCH;
294#else
6af0bf9c
FB
295 ret = get_physical_address(env, &physical, &prot,
296 address, rw, access_type);
60c9af07 297 qemu_log("%s address=" TARGET_FMT_lx " ret %d physical " TARGET_FMT_plx " prot %d\n",
93fcfe39 298 __func__, address, ret, physical, prot);
43057ab1
FB
299 if (ret == TLBRET_MATCH) {
300 ret = tlb_set_page(env, address & TARGET_PAGE_MASK,
301 physical & TARGET_PAGE_MASK, prot,
6ebbf390 302 mmu_idx, is_softmmu);
932e71cd
AJ
303 } else if (ret < 0)
304#endif
305 {
1147e189 306 raise_mmu_exception(env, address, rw, ret);
6af0bf9c
FB
307 ret = 1;
308 }
309
310 return ret;
311}
312
25b91e32 313#if !defined(CONFIG_USER_ONLY)
c36bbb28 314target_phys_addr_t cpu_mips_translate_address(CPUState *env, target_ulong address, int rw)
25b91e32
AJ
315{
316 target_phys_addr_t physical;
317 int prot;
318 int access_type;
319 int ret = 0;
320
321 rw &= 1;
322
323 /* data access */
324 access_type = ACCESS_INT;
325 ret = get_physical_address(env, &physical, &prot,
326 address, rw, access_type);
327 if (ret != TLBRET_MATCH) {
328 raise_mmu_exception(env, address, rw, ret);
c36bbb28
AJ
329 return -1LL;
330 } else {
331 return physical;
25b91e32 332 }
25b91e32
AJ
333}
334#endif
335
9a5d878f
TS
336static const char * const excp_names[EXCP_LAST + 1] = {
337 [EXCP_RESET] = "reset",
338 [EXCP_SRESET] = "soft reset",
339 [EXCP_DSS] = "debug single step",
340 [EXCP_DINT] = "debug interrupt",
341 [EXCP_NMI] = "non-maskable interrupt",
342 [EXCP_MCHECK] = "machine check",
343 [EXCP_EXT_INTERRUPT] = "interrupt",
344 [EXCP_DFWATCH] = "deferred watchpoint",
345 [EXCP_DIB] = "debug instruction breakpoint",
346 [EXCP_IWATCH] = "instruction fetch watchpoint",
347 [EXCP_AdEL] = "address error load",
348 [EXCP_AdES] = "address error store",
349 [EXCP_TLBF] = "TLB refill",
350 [EXCP_IBE] = "instruction bus error",
351 [EXCP_DBp] = "debug breakpoint",
352 [EXCP_SYSCALL] = "syscall",
353 [EXCP_BREAK] = "break",
354 [EXCP_CpU] = "coprocessor unusable",
355 [EXCP_RI] = "reserved instruction",
356 [EXCP_OVERFLOW] = "arithmetic overflow",
357 [EXCP_TRAP] = "trap",
358 [EXCP_FPE] = "floating point",
359 [EXCP_DDBS] = "debug data break store",
360 [EXCP_DWATCH] = "data watchpoint",
361 [EXCP_LTLBL] = "TLB modify",
362 [EXCP_TLBL] = "TLB load",
363 [EXCP_TLBS] = "TLB store",
364 [EXCP_DBE] = "data bus error",
365 [EXCP_DDBL] = "debug data break load",
366 [EXCP_THREAD] = "thread",
367 [EXCP_MDMX] = "MDMX",
368 [EXCP_C2E] = "precise coprocessor 2",
369 [EXCP_CACHE] = "cache error",
14e51cc7 370};
14e51cc7 371
32188a03
NF
372#if !defined(CONFIG_USER_ONLY)
373static target_ulong exception_resume_pc (CPUState *env)
374{
375 target_ulong bad_pc;
376 target_ulong isa_mode;
377
378 isa_mode = !!(env->hflags & MIPS_HFLAG_M16);
379 bad_pc = env->active_tc.PC | isa_mode;
380 if (env->hflags & MIPS_HFLAG_BMASK) {
381 /* If the exception was raised from a delay slot, come back to
382 the jump. */
383 bad_pc -= (env->hflags & MIPS_HFLAG_B16 ? 2 : 4);
384 }
385
386 return bad_pc;
387}
388#endif
389
6af0bf9c
FB
390void do_interrupt (CPUState *env)
391{
932e71cd
AJ
392#if !defined(CONFIG_USER_ONLY)
393 target_ulong offset;
394 int cause = -1;
395 const char *name;
100ce988 396
93fcfe39 397 if (qemu_log_enabled() && env->exception_index != EXCP_EXT_INTERRUPT) {
932e71cd
AJ
398 if (env->exception_index < 0 || env->exception_index > EXCP_LAST)
399 name = "unknown";
400 else
401 name = excp_names[env->exception_index];
b67bfe8d 402
93fcfe39
AL
403 qemu_log("%s enter: PC " TARGET_FMT_lx " EPC " TARGET_FMT_lx " %s exception\n",
404 __func__, env->active_tc.PC, env->CP0_EPC, name);
932e71cd
AJ
405 }
406 if (env->exception_index == EXCP_EXT_INTERRUPT &&
407 (env->hflags & MIPS_HFLAG_DM))
408 env->exception_index = EXCP_DINT;
409 offset = 0x180;
410 switch (env->exception_index) {
411 case EXCP_DSS:
412 env->CP0_Debug |= 1 << CP0DB_DSS;
413 /* Debug single step cannot be raised inside a delay slot and
414 resume will always occur on the next instruction
415 (but we assume the pc has always been updated during
416 code translation). */
32188a03 417 env->CP0_DEPC = env->active_tc.PC | !!(env->hflags & MIPS_HFLAG_M16);
932e71cd
AJ
418 goto enter_debug_mode;
419 case EXCP_DINT:
420 env->CP0_Debug |= 1 << CP0DB_DINT;
421 goto set_DEPC;
422 case EXCP_DIB:
423 env->CP0_Debug |= 1 << CP0DB_DIB;
424 goto set_DEPC;
425 case EXCP_DBp:
426 env->CP0_Debug |= 1 << CP0DB_DBp;
427 goto set_DEPC;
428 case EXCP_DDBS:
429 env->CP0_Debug |= 1 << CP0DB_DDBS;
430 goto set_DEPC;
431 case EXCP_DDBL:
432 env->CP0_Debug |= 1 << CP0DB_DDBL;
433 set_DEPC:
32188a03
NF
434 env->CP0_DEPC = exception_resume_pc(env);
435 env->hflags &= ~MIPS_HFLAG_BMASK;
0eaef5aa 436 enter_debug_mode:
932e71cd
AJ
437 env->hflags |= MIPS_HFLAG_DM | MIPS_HFLAG_64 | MIPS_HFLAG_CP0;
438 env->hflags &= ~(MIPS_HFLAG_KSU);
439 /* EJTAG probe trap enable is not implemented... */
440 if (!(env->CP0_Status & (1 << CP0St_EXL)))
441 env->CP0_Cause &= ~(1 << CP0Ca_BD);
442 env->active_tc.PC = (int32_t)0xBFC00480;
32188a03
NF
443 /* Exception handlers are entered in 32-bit mode. */
444 env->hflags &= ~(MIPS_HFLAG_M16);
932e71cd
AJ
445 break;
446 case EXCP_RESET:
447 cpu_reset(env);
448 break;
449 case EXCP_SRESET:
450 env->CP0_Status |= (1 << CP0St_SR);
451 memset(env->CP0_WatchLo, 0, sizeof(*env->CP0_WatchLo));
452 goto set_error_EPC;
453 case EXCP_NMI:
454 env->CP0_Status |= (1 << CP0St_NMI);
0eaef5aa 455 set_error_EPC:
32188a03
NF
456 env->CP0_ErrorEPC = exception_resume_pc(env);
457 env->hflags &= ~MIPS_HFLAG_BMASK;
932e71cd
AJ
458 env->CP0_Status |= (1 << CP0St_ERL) | (1 << CP0St_BEV);
459 env->hflags |= MIPS_HFLAG_64 | MIPS_HFLAG_CP0;
460 env->hflags &= ~(MIPS_HFLAG_KSU);
461 if (!(env->CP0_Status & (1 << CP0St_EXL)))
462 env->CP0_Cause &= ~(1 << CP0Ca_BD);
463 env->active_tc.PC = (int32_t)0xBFC00000;
32188a03
NF
464 /* Exception handlers are entered in 32-bit mode. */
465 env->hflags &= ~(MIPS_HFLAG_M16);
932e71cd
AJ
466 break;
467 case EXCP_EXT_INTERRUPT:
468 cause = 0;
469 if (env->CP0_Cause & (1 << CP0Ca_IV))
470 offset = 0x200;
471 goto set_EPC;
472 case EXCP_LTLBL:
473 cause = 1;
474 goto set_EPC;
475 case EXCP_TLBL:
476 cause = 2;
477 if (env->error_code == 1 && !(env->CP0_Status & (1 << CP0St_EXL))) {
0eaef5aa 478#if defined(TARGET_MIPS64)
932e71cd
AJ
479 int R = env->CP0_BadVAddr >> 62;
480 int UX = (env->CP0_Status & (1 << CP0St_UX)) != 0;
481 int SX = (env->CP0_Status & (1 << CP0St_SX)) != 0;
482 int KX = (env->CP0_Status & (1 << CP0St_KX)) != 0;
0eaef5aa 483
932e71cd
AJ
484 if ((R == 0 && UX) || (R == 1 && SX) || (R == 3 && KX))
485 offset = 0x080;
486 else
0eaef5aa 487#endif
932e71cd
AJ
488 offset = 0x000;
489 }
490 goto set_EPC;
491 case EXCP_TLBS:
492 cause = 3;
493 if (env->error_code == 1 && !(env->CP0_Status & (1 << CP0St_EXL))) {
0eaef5aa 494#if defined(TARGET_MIPS64)
932e71cd
AJ
495 int R = env->CP0_BadVAddr >> 62;
496 int UX = (env->CP0_Status & (1 << CP0St_UX)) != 0;
497 int SX = (env->CP0_Status & (1 << CP0St_SX)) != 0;
498 int KX = (env->CP0_Status & (1 << CP0St_KX)) != 0;
0eaef5aa 499
932e71cd
AJ
500 if ((R == 0 && UX) || (R == 1 && SX) || (R == 3 && KX))
501 offset = 0x080;
502 else
0eaef5aa 503#endif
932e71cd
AJ
504 offset = 0x000;
505 }
506 goto set_EPC;
507 case EXCP_AdEL:
508 cause = 4;
509 goto set_EPC;
510 case EXCP_AdES:
511 cause = 5;
512 goto set_EPC;
513 case EXCP_IBE:
514 cause = 6;
515 goto set_EPC;
516 case EXCP_DBE:
517 cause = 7;
518 goto set_EPC;
519 case EXCP_SYSCALL:
520 cause = 8;
521 goto set_EPC;
522 case EXCP_BREAK:
523 cause = 9;
524 goto set_EPC;
525 case EXCP_RI:
526 cause = 10;
527 goto set_EPC;
528 case EXCP_CpU:
529 cause = 11;
530 env->CP0_Cause = (env->CP0_Cause & ~(0x3 << CP0Ca_CE)) |
531 (env->error_code << CP0Ca_CE);
532 goto set_EPC;
533 case EXCP_OVERFLOW:
534 cause = 12;
535 goto set_EPC;
536 case EXCP_TRAP:
537 cause = 13;
538 goto set_EPC;
539 case EXCP_FPE:
540 cause = 15;
541 goto set_EPC;
542 case EXCP_C2E:
543 cause = 18;
544 goto set_EPC;
545 case EXCP_MDMX:
546 cause = 22;
547 goto set_EPC;
548 case EXCP_DWATCH:
549 cause = 23;
550 /* XXX: TODO: manage defered watch exceptions */
551 goto set_EPC;
552 case EXCP_MCHECK:
553 cause = 24;
554 goto set_EPC;
555 case EXCP_THREAD:
556 cause = 25;
557 goto set_EPC;
558 case EXCP_CACHE:
559 cause = 30;
560 if (env->CP0_Status & (1 << CP0St_BEV)) {
561 offset = 0x100;
562 } else {
563 offset = 0x20000100;
564 }
0eaef5aa 565 set_EPC:
932e71cd 566 if (!(env->CP0_Status & (1 << CP0St_EXL))) {
32188a03 567 env->CP0_EPC = exception_resume_pc(env);
932e71cd 568 if (env->hflags & MIPS_HFLAG_BMASK) {
932e71cd 569 env->CP0_Cause |= (1 << CP0Ca_BD);
0eaef5aa 570 } else {
932e71cd 571 env->CP0_Cause &= ~(1 << CP0Ca_BD);
0eaef5aa 572 }
932e71cd
AJ
573 env->CP0_Status |= (1 << CP0St_EXL);
574 env->hflags |= MIPS_HFLAG_64 | MIPS_HFLAG_CP0;
575 env->hflags &= ~(MIPS_HFLAG_KSU);
6af0bf9c 576 }
932e71cd
AJ
577 env->hflags &= ~MIPS_HFLAG_BMASK;
578 if (env->CP0_Status & (1 << CP0St_BEV)) {
579 env->active_tc.PC = (int32_t)0xBFC00200;
580 } else {
581 env->active_tc.PC = (int32_t)(env->CP0_EBase & ~0x3ff);
6af0bf9c 582 }
932e71cd 583 env->active_tc.PC += offset;
32188a03
NF
584 /* Exception handlers are entered in 32-bit mode. */
585 env->hflags &= ~(MIPS_HFLAG_M16);
932e71cd
AJ
586 env->CP0_Cause = (env->CP0_Cause & ~(0x1f << CP0Ca_EC)) | (cause << CP0Ca_EC);
587 break;
588 default:
93fcfe39 589 qemu_log("Invalid MIPS exception %d. Exiting\n", env->exception_index);
932e71cd
AJ
590 printf("Invalid MIPS exception %d. Exiting\n", env->exception_index);
591 exit(1);
592 }
93fcfe39
AL
593 if (qemu_log_enabled() && env->exception_index != EXCP_EXT_INTERRUPT) {
594 qemu_log("%s: PC " TARGET_FMT_lx " EPC " TARGET_FMT_lx " cause %d\n"
932e71cd
AJ
595 " S %08x C %08x A " TARGET_FMT_lx " D " TARGET_FMT_lx "\n",
596 __func__, env->active_tc.PC, env->CP0_EPC, cause,
597 env->CP0_Status, env->CP0_Cause, env->CP0_BadVAddr,
598 env->CP0_DEPC);
6af0bf9c 599 }
932e71cd 600#endif
6af0bf9c
FB
601 env->exception_index = EXCP_NONE;
602}
2ee4aed8 603
29929e34 604void r4k_invalidate_tlb (CPUState *env, int idx, int use_extra)
2ee4aed8 605{
c227f099 606 r4k_tlb_t *tlb;
3b1c8be4
TS
607 target_ulong addr;
608 target_ulong end;
609 uint8_t ASID = env->CP0_EntryHi & 0xFF;
610 target_ulong mask;
2ee4aed8 611
ead9360e 612 tlb = &env->tlb->mmu.r4k.tlb[idx];
f2e9ebef 613 /* The qemu TLB is flushed when the ASID changes, so no need to
2ee4aed8
FB
614 flush these entries again. */
615 if (tlb->G == 0 && tlb->ASID != ASID) {
616 return;
617 }
618
ead9360e 619 if (use_extra && env->tlb->tlb_in_use < MIPS_TLB_MAX) {
2ee4aed8 620 /* For tlbwr, we can shadow the discarded entry into
6958549d
AJ
621 a new (fake) TLB entry, as long as the guest can not
622 tell that it's there. */
ead9360e
TS
623 env->tlb->mmu.r4k.tlb[env->tlb->tlb_in_use] = *tlb;
624 env->tlb->tlb_in_use++;
2ee4aed8
FB
625 return;
626 }
627
3b1c8be4 628 /* 1k pages are not supported. */
f2e9ebef 629 mask = tlb->PageMask | ~(TARGET_PAGE_MASK << 1);
3b1c8be4 630 if (tlb->V0) {
f2e9ebef 631 addr = tlb->VPN & ~mask;
d26bc211 632#if defined(TARGET_MIPS64)
e034e2c3 633 if (addr >= (0xFFFFFFFF80000000ULL & env->SEGMask)) {
100ce988
TS
634 addr |= 0x3FFFFF0000000000ULL;
635 }
636#endif
3b1c8be4
TS
637 end = addr | (mask >> 1);
638 while (addr < end) {
639 tlb_flush_page (env, addr);
640 addr += TARGET_PAGE_SIZE;
641 }
642 }
643 if (tlb->V1) {
f2e9ebef 644 addr = (tlb->VPN & ~mask) | ((mask >> 1) + 1);
d26bc211 645#if defined(TARGET_MIPS64)
e034e2c3 646 if (addr >= (0xFFFFFFFF80000000ULL & env->SEGMask)) {
100ce988
TS
647 addr |= 0x3FFFFF0000000000ULL;
648 }
649#endif
3b1c8be4 650 end = addr | mask;
53715e48 651 while (addr - 1 < end) {
3b1c8be4
TS
652 tlb_flush_page (env, addr);
653 addr += TARGET_PAGE_SIZE;
654 }
655 }
2ee4aed8 656}