root / target-mips / translate.c @ 6af0bf9c
History | View | Annotate | Download (42.5 kB)
1 |
/*
|
---|---|
2 |
* MIPS32 emulation for qemu: main translation routines.
|
3 |
*
|
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
|
17 |
* License along with this library; if not, write to the Free Software
|
18 |
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
19 |
*/
|
20 |
|
21 |
#include <stdarg.h> |
22 |
#include <stdlib.h> |
23 |
#include <stdio.h> |
24 |
#include <string.h> |
25 |
#include <inttypes.h> |
26 |
|
27 |
#include "cpu.h" |
28 |
#include "exec-all.h" |
29 |
#include "disas.h" |
30 |
|
31 |
#define MIPS_DEBUG_DISAS
|
32 |
//#define MIPS_SINGLE_STEP
|
33 |
|
34 |
enum {
|
35 |
#define DEF(s, n, copy_size) INDEX_op_ ## s, |
36 |
#include "opc.h" |
37 |
#undef DEF
|
38 |
NB_OPS, |
39 |
}; |
40 |
|
41 |
static uint16_t *gen_opc_ptr;
|
42 |
static uint32_t *gen_opparam_ptr;
|
43 |
|
44 |
#include "gen-op.h" |
45 |
|
46 |
const unsigned char *regnames[] = |
47 |
{ "r0", "at", "v0", "v1", "a0", "a1", "a2", "a3", |
48 |
"t0", "t1", "t2", "t3", "t4", "t5", "t6", "t7", |
49 |
"s0", "s1", "s2", "s3", "s4", "s5", "s6", "s7", |
50 |
"t8", "t9", "k0", "k1", "gp", "sp", "s8", "ra", }; |
51 |
|
52 |
/* Warning: no function for r0 register (hard wired to zero) */
|
53 |
#define GEN32(func, NAME) \
|
54 |
static GenOpFunc *NAME ## _table [32] = { \ |
55 |
NULL, NAME ## 1, NAME ## 2, NAME ## 3, \ |
56 |
NAME ## 4, NAME ## 5, NAME ## 6, NAME ## 7, \ |
57 |
NAME ## 8, NAME ## 9, NAME ## 10, NAME ## 11, \ |
58 |
NAME ## 12, NAME ## 13, NAME ## 14, NAME ## 15, \ |
59 |
NAME ## 16, NAME ## 17, NAME ## 18, NAME ## 19, \ |
60 |
NAME ## 20, NAME ## 21, NAME ## 22, NAME ## 23, \ |
61 |
NAME ## 24, NAME ## 25, NAME ## 26, NAME ## 27, \ |
62 |
NAME ## 28, NAME ## 29, NAME ## 30, NAME ## 31, \ |
63 |
}; \ |
64 |
static inline void func(int n) \ |
65 |
{ \ |
66 |
NAME ## _table[n](); \ |
67 |
} |
68 |
|
69 |
/* General purpose registers moves */
|
70 |
GEN32(gen_op_load_gpr_T0, gen_op_load_gpr_T0_gpr); |
71 |
GEN32(gen_op_load_gpr_T1, gen_op_load_gpr_T1_gpr); |
72 |
GEN32(gen_op_load_gpr_T2, gen_op_load_gpr_T2_gpr); |
73 |
|
74 |
GEN32(gen_op_store_T0_gpr, gen_op_store_T0_gpr_gpr); |
75 |
GEN32(gen_op_store_T1_gpr, gen_op_store_T1_gpr_gpr); |
76 |
|
77 |
typedef struct DisasContext { |
78 |
struct TranslationBlock *tb;
|
79 |
target_ulong pc, saved_pc; |
80 |
uint32_t opcode; |
81 |
/* Routine used to access memory */
|
82 |
int mem_idx;
|
83 |
uint32_t hflags, saved_hflags; |
84 |
uint32_t CP0_Status; |
85 |
int bstate;
|
86 |
target_ulong btarget; |
87 |
} DisasContext; |
88 |
|
89 |
enum {
|
90 |
BS_NONE = 0, /* We go out of the TB without reaching a branch or an |
91 |
* exception condition
|
92 |
*/
|
93 |
BS_STOP = 1, /* We want to stop translation for any reason */ |
94 |
BS_BRANCH = 2, /* We reached a branch condition */ |
95 |
BS_EXCP = 3, /* We reached an exception condition */ |
96 |
}; |
97 |
|
98 |
#if defined MIPS_DEBUG_DISAS
|
99 |
#define MIPS_DEBUG(fmt, args...) \
|
100 |
do { \
|
101 |
if (loglevel & CPU_LOG_TB_IN_ASM) { \
|
102 |
fprintf(logfile, "%08x: %08x " fmt "\n", \ |
103 |
ctx->pc, ctx->opcode , ##args); \ |
104 |
} \ |
105 |
} while (0) |
106 |
#else
|
107 |
#define MIPS_DEBUG(fmt, args...) do { } while(0) |
108 |
#endif
|
109 |
|
110 |
#define MIPS_INVAL(op) \
|
111 |
do { \
|
112 |
MIPS_DEBUG("Invalid %s %03x %03x %03x", op, ctx->opcode >> 26, \ |
113 |
ctx->opcode & 0x3F, ((ctx->opcode >> 16) & 0x1F)); \ |
114 |
} while (0) |
115 |
|
116 |
#define GEN_LOAD_REG_TN(Tn, Rn) \
|
117 |
do { \
|
118 |
if (Rn == 0) { \ |
119 |
glue(gen_op_reset_, Tn)(); \ |
120 |
} else { \
|
121 |
glue(gen_op_load_gpr_, Tn)(Rn); \ |
122 |
} \ |
123 |
} while (0) |
124 |
|
125 |
#define GEN_LOAD_IMM_TN(Tn, Imm) \
|
126 |
do { \
|
127 |
if (Imm == 0) { \ |
128 |
glue(gen_op_reset_, Tn)(); \ |
129 |
} else { \
|
130 |
glue(gen_op_set_, Tn)(Imm); \ |
131 |
} \ |
132 |
} while (0) |
133 |
|
134 |
#define GEN_STORE_TN_REG(Rn, Tn) \
|
135 |
do { \
|
136 |
if (Rn != 0) { \ |
137 |
glue(glue(gen_op_store_, Tn),_gpr)(Rn); \ |
138 |
} \ |
139 |
} while (0) |
140 |
|
141 |
static inline void save_cpu_state (DisasContext *ctx, int do_save_pc) |
142 |
{ |
143 |
#if defined MIPS_DEBUG_DISAS
|
144 |
if (loglevel & CPU_LOG_TB_IN_ASM) {
|
145 |
fprintf(logfile, "hflags %08x saved %08x\n",
|
146 |
ctx->hflags, ctx->saved_hflags); |
147 |
} |
148 |
#endif
|
149 |
if (do_save_pc && ctx->pc != ctx->saved_pc) {
|
150 |
gen_op_save_pc(ctx->pc); |
151 |
ctx->saved_pc = ctx->pc; |
152 |
} |
153 |
if (ctx->hflags != ctx->saved_hflags) {
|
154 |
gen_op_save_state(ctx->hflags); |
155 |
ctx->saved_hflags = ctx->hflags; |
156 |
if (ctx->hflags & MIPS_HFLAG_BR) {
|
157 |
gen_op_save_breg_target(); |
158 |
} else if (ctx->hflags & MIPS_HFLAG_B) { |
159 |
gen_op_save_btarget(ctx->btarget); |
160 |
} else if (ctx->hflags & MIPS_HFLAG_BMASK) { |
161 |
gen_op_save_bcond(); |
162 |
gen_op_save_btarget(ctx->btarget); |
163 |
} |
164 |
} |
165 |
} |
166 |
|
167 |
static inline void generate_exception (DisasContext *ctx, int excp) |
168 |
{ |
169 |
#if defined MIPS_DEBUG_DISAS
|
170 |
if (loglevel & CPU_LOG_TB_IN_ASM)
|
171 |
fprintf(logfile, "%s: raise exception %d\n", __func__, excp);
|
172 |
#endif
|
173 |
save_cpu_state(ctx, 1);
|
174 |
gen_op_raise_exception(excp); |
175 |
ctx->bstate = BS_EXCP; |
176 |
} |
177 |
|
178 |
#if defined(CONFIG_USER_ONLY)
|
179 |
#define op_ldst(name) gen_op_##name##_raw() |
180 |
#define OP_LD_TABLE(width)
|
181 |
#define OP_ST_TABLE(width)
|
182 |
#else
|
183 |
#define op_ldst(name) (*gen_op_##name[ctx->mem_idx])() |
184 |
#define OP_LD_TABLE(width) \
|
185 |
static GenOpFunc *gen_op_l##width[] = { \ |
186 |
&gen_op_l##width##_user, \ |
187 |
&gen_op_l##width##_kernel, \ |
188 |
} |
189 |
#define OP_ST_TABLE(width) \
|
190 |
static GenOpFunc *gen_op_s##width[] = { \ |
191 |
&gen_op_s##width##_user, \ |
192 |
&gen_op_s##width##_kernel, \ |
193 |
} |
194 |
#endif
|
195 |
|
196 |
#ifdef TARGET_MIPS64
|
197 |
OP_LD_TABLE(d); |
198 |
OP_LD_TABLE(dl); |
199 |
OP_LD_TABLE(dr); |
200 |
OP_ST_TABLE(d); |
201 |
OP_ST_TABLE(dl); |
202 |
OP_ST_TABLE(dr); |
203 |
#endif
|
204 |
OP_LD_TABLE(w); |
205 |
OP_LD_TABLE(wl); |
206 |
OP_LD_TABLE(wr); |
207 |
OP_ST_TABLE(w); |
208 |
OP_ST_TABLE(wl); |
209 |
OP_ST_TABLE(wr); |
210 |
OP_LD_TABLE(h); |
211 |
OP_LD_TABLE(hu); |
212 |
OP_ST_TABLE(h); |
213 |
OP_LD_TABLE(b); |
214 |
OP_LD_TABLE(bu); |
215 |
OP_ST_TABLE(b); |
216 |
OP_LD_TABLE(l); |
217 |
OP_ST_TABLE(c); |
218 |
|
219 |
/* Load and store */
|
220 |
static void gen_ldst (DisasContext *ctx, uint16_t opc, int rt, |
221 |
int base, int16_t offset)
|
222 |
{ |
223 |
const unsigned char *opn = "unk"; |
224 |
|
225 |
if (base == 0) { |
226 |
GEN_LOAD_IMM_TN(T0, offset); |
227 |
} else if (offset == 0) { |
228 |
gen_op_load_gpr_T0(base); |
229 |
} else {
|
230 |
gen_op_load_gpr_T0(base); |
231 |
gen_op_set_T1(offset); |
232 |
gen_op_add(); |
233 |
} |
234 |
/* Don't do NOP if destination is zero: we must perform the actual
|
235 |
* memory access
|
236 |
*/
|
237 |
switch (opc) {
|
238 |
#if defined(TARGET_MIPS64)
|
239 |
case OPC_LD:
|
240 |
#if defined (MIPS_HAS_UNALIGNED_LS)
|
241 |
case OPC_ULD:
|
242 |
#endif
|
243 |
op_ldst(ld); |
244 |
GEN_STORE_TN_REG(rt, T0); |
245 |
opn = "ld";
|
246 |
break;
|
247 |
case OPC_SD:
|
248 |
#if defined (MIPS_HAS_UNALIGNED_LS)
|
249 |
case OPC_USD:
|
250 |
#endif
|
251 |
GEN_LOAD_REG_TN(T1, rt); |
252 |
op_ldst(sd); |
253 |
opn = "sd";
|
254 |
break;
|
255 |
case OPC_LDL:
|
256 |
op_ldst(ldl); |
257 |
GEN_STORE_TN_REG(rt, T0); |
258 |
opn = "ldl";
|
259 |
break;
|
260 |
case OPC_SDL:
|
261 |
GEN_LOAD_REG_TN(T1, rt); |
262 |
op_ldst(sdl); |
263 |
opn = "sdl";
|
264 |
break;
|
265 |
case OPC_LDR:
|
266 |
op_ldst(ldr); |
267 |
GEN_STORE_TN_REG(rt, T0); |
268 |
opn = "ldr";
|
269 |
break;
|
270 |
case OPC_SDR:
|
271 |
GEN_LOAD_REG_TN(T1, rt); |
272 |
op_ldst(sdr); |
273 |
opn = "sdr";
|
274 |
break;
|
275 |
#endif
|
276 |
case OPC_LW:
|
277 |
#if defined (MIPS_HAS_UNALIGNED_LS)
|
278 |
case OPC_ULW:
|
279 |
#endif
|
280 |
op_ldst(lw); |
281 |
GEN_STORE_TN_REG(rt, T0); |
282 |
opn = "lw";
|
283 |
break;
|
284 |
case OPC_SW:
|
285 |
#if defined (MIPS_HAS_UNALIGNED_LS)
|
286 |
case OPC_USW:
|
287 |
#endif
|
288 |
GEN_LOAD_REG_TN(T1, rt); |
289 |
op_ldst(sw); |
290 |
opn = "sw";
|
291 |
break;
|
292 |
case OPC_LH:
|
293 |
#if defined (MIPS_HAS_UNALIGNED_LS)
|
294 |
case OPC_ULH:
|
295 |
#endif
|
296 |
op_ldst(lh); |
297 |
GEN_STORE_TN_REG(rt, T0); |
298 |
opn = "lh";
|
299 |
break;
|
300 |
case OPC_SH:
|
301 |
#if defined (MIPS_HAS_UNALIGNED_LS)
|
302 |
case OPC_USH:
|
303 |
#endif
|
304 |
GEN_LOAD_REG_TN(T1, rt); |
305 |
op_ldst(sh); |
306 |
opn = "sh";
|
307 |
break;
|
308 |
case OPC_LHU:
|
309 |
#if defined (MIPS_HAS_UNALIGNED_LS)
|
310 |
case OPC_ULHU:
|
311 |
#endif
|
312 |
op_ldst(lhu); |
313 |
GEN_STORE_TN_REG(rt, T0); |
314 |
opn = "lhu";
|
315 |
break;
|
316 |
case OPC_LB:
|
317 |
op_ldst(lb); |
318 |
GEN_STORE_TN_REG(rt, T0); |
319 |
opn = "lb";
|
320 |
break;
|
321 |
case OPC_SB:
|
322 |
GEN_LOAD_REG_TN(T1, rt); |
323 |
op_ldst(sb); |
324 |
opn = "sb";
|
325 |
break;
|
326 |
case OPC_LBU:
|
327 |
op_ldst(lbu); |
328 |
GEN_STORE_TN_REG(rt, T0); |
329 |
opn = "lbu";
|
330 |
break;
|
331 |
case OPC_LWL:
|
332 |
op_ldst(lwl); |
333 |
GEN_STORE_TN_REG(rt, T0); |
334 |
opn = "lwl";
|
335 |
break;
|
336 |
case OPC_SWL:
|
337 |
GEN_LOAD_REG_TN(T1, rt); |
338 |
op_ldst(swl); |
339 |
opn = "swr";
|
340 |
break;
|
341 |
case OPC_LWR:
|
342 |
op_ldst(lwr); |
343 |
GEN_STORE_TN_REG(rt, T0); |
344 |
opn = "lwr";
|
345 |
break;
|
346 |
case OPC_SWR:
|
347 |
GEN_LOAD_REG_TN(T1, rt); |
348 |
op_ldst(swr); |
349 |
opn = "swr";
|
350 |
break;
|
351 |
case OPC_LL:
|
352 |
op_ldst(ll); |
353 |
GEN_STORE_TN_REG(rt, T0); |
354 |
opn = "ll";
|
355 |
break;
|
356 |
case OPC_SC:
|
357 |
GEN_LOAD_REG_TN(T1, rt); |
358 |
op_ldst(sc); |
359 |
GEN_STORE_TN_REG(rt, T0); |
360 |
opn = "sc";
|
361 |
break;
|
362 |
default:
|
363 |
MIPS_INVAL("load/store");
|
364 |
generate_exception(ctx, EXCP_RI); |
365 |
return;
|
366 |
} |
367 |
MIPS_DEBUG("%s %s, %d(%s)", opn, regnames[rt], offset, regnames[base]);
|
368 |
} |
369 |
|
370 |
/* Arithmetic with immediate operand */
|
371 |
static void gen_arith_imm (DisasContext *ctx, uint16_t opc, int rt, |
372 |
int rs, int16_t imm)
|
373 |
{ |
374 |
uint32_t uimm; |
375 |
const unsigned char *opn = "unk"; |
376 |
|
377 |
if (rt == 0 && opc != OPC_ADDI) { |
378 |
/* if no destination, treat it as a NOP
|
379 |
* For addi, we must generate the overflow exception when needed.
|
380 |
*/
|
381 |
MIPS_DEBUG("NOP");
|
382 |
return;
|
383 |
} |
384 |
if (opc == OPC_ADDI || opc == OPC_ADDIU ||
|
385 |
opc == OPC_SLTI || opc == OPC_SLTIU) |
386 |
uimm = (int32_t)imm; /* Sign extent to 32 bits */
|
387 |
else
|
388 |
uimm = (uint16_t)imm; |
389 |
if (opc != OPC_LUI) {
|
390 |
GEN_LOAD_REG_TN(T0, rs); |
391 |
GEN_LOAD_IMM_TN(T1, uimm); |
392 |
} else {
|
393 |
uimm = uimm << 16;
|
394 |
GEN_LOAD_IMM_TN(T0, uimm); |
395 |
} |
396 |
switch (opc) {
|
397 |
case OPC_ADDI:
|
398 |
save_cpu_state(ctx, 1);
|
399 |
gen_op_addo(); |
400 |
opn = "addi";
|
401 |
break;
|
402 |
case OPC_ADDIU:
|
403 |
gen_op_add(); |
404 |
opn = "addiu";
|
405 |
break;
|
406 |
case OPC_SLTI:
|
407 |
gen_op_lt(); |
408 |
opn = "slti";
|
409 |
break;
|
410 |
case OPC_SLTIU:
|
411 |
gen_op_ltu(); |
412 |
opn = "sltiu";
|
413 |
break;
|
414 |
case OPC_ANDI:
|
415 |
gen_op_and(); |
416 |
opn = "andi";
|
417 |
break;
|
418 |
case OPC_ORI:
|
419 |
gen_op_or(); |
420 |
opn = "ori";
|
421 |
break;
|
422 |
case OPC_XORI:
|
423 |
gen_op_xor(); |
424 |
opn = "xori";
|
425 |
break;
|
426 |
case OPC_LUI:
|
427 |
opn = "lui";
|
428 |
break;
|
429 |
case OPC_SLL:
|
430 |
gen_op_sll(); |
431 |
opn = "sll";
|
432 |
break;
|
433 |
case OPC_SRA:
|
434 |
gen_op_sra(); |
435 |
opn = "sra";
|
436 |
break;
|
437 |
case OPC_SRL:
|
438 |
gen_op_srl(); |
439 |
opn = "srl";
|
440 |
break;
|
441 |
default:
|
442 |
MIPS_INVAL("imm arith");
|
443 |
generate_exception(ctx, EXCP_RI); |
444 |
return;
|
445 |
} |
446 |
GEN_STORE_TN_REG(rt, T0); |
447 |
MIPS_DEBUG("%s %s, %s, %x", opn, regnames[rt], regnames[rs], uimm);
|
448 |
} |
449 |
|
450 |
/* Arithmetic */
|
451 |
static void gen_arith (DisasContext *ctx, uint16_t opc, |
452 |
int rd, int rs, int rt) |
453 |
{ |
454 |
const unsigned char *opn = "unk"; |
455 |
|
456 |
if (rd == 0 && opc != OPC_ADD && opc != OPC_SUB) { |
457 |
/* if no destination, treat it as a NOP
|
458 |
* For add & sub, we must generate the overflow exception when needed.
|
459 |
*/
|
460 |
MIPS_DEBUG("NOP");
|
461 |
return;
|
462 |
} |
463 |
GEN_LOAD_REG_TN(T0, rs); |
464 |
GEN_LOAD_REG_TN(T1, rt); |
465 |
switch (opc) {
|
466 |
case OPC_ADD:
|
467 |
save_cpu_state(ctx, 1);
|
468 |
gen_op_addo(); |
469 |
opn = "add";
|
470 |
break;
|
471 |
case OPC_ADDU:
|
472 |
gen_op_add(); |
473 |
opn = "addu";
|
474 |
break;
|
475 |
case OPC_SUB:
|
476 |
save_cpu_state(ctx, 1);
|
477 |
gen_op_subo(); |
478 |
opn = "sub";
|
479 |
break;
|
480 |
case OPC_SUBU:
|
481 |
gen_op_sub(); |
482 |
opn = "subu";
|
483 |
break;
|
484 |
case OPC_SLT:
|
485 |
gen_op_lt(); |
486 |
opn = "slt";
|
487 |
break;
|
488 |
case OPC_SLTU:
|
489 |
gen_op_ltu(); |
490 |
opn = "sltu";
|
491 |
break;
|
492 |
case OPC_AND:
|
493 |
gen_op_and(); |
494 |
opn = "and";
|
495 |
break;
|
496 |
case OPC_NOR:
|
497 |
gen_op_nor(); |
498 |
opn = "nor";
|
499 |
break;
|
500 |
case OPC_OR:
|
501 |
gen_op_or(); |
502 |
opn = "or";
|
503 |
break;
|
504 |
case OPC_XOR:
|
505 |
gen_op_xor(); |
506 |
opn = "xor";
|
507 |
break;
|
508 |
case OPC_MUL:
|
509 |
gen_op_mul(); |
510 |
opn = "mul";
|
511 |
break;
|
512 |
case OPC_MOVN:
|
513 |
gen_op_movn(rd); |
514 |
opn = "movn";
|
515 |
goto print;
|
516 |
case OPC_MOVZ:
|
517 |
gen_op_movz(rd); |
518 |
opn = "movz";
|
519 |
goto print;
|
520 |
case OPC_SLLV:
|
521 |
gen_op_sllv(); |
522 |
opn = "sllv";
|
523 |
break;
|
524 |
case OPC_SRAV:
|
525 |
gen_op_srav(); |
526 |
opn = "srav";
|
527 |
break;
|
528 |
case OPC_SRLV:
|
529 |
gen_op_srlv(); |
530 |
opn = "srlv";
|
531 |
break;
|
532 |
default:
|
533 |
MIPS_INVAL("arith");
|
534 |
generate_exception(ctx, EXCP_RI); |
535 |
return;
|
536 |
} |
537 |
GEN_STORE_TN_REG(rd, T0); |
538 |
print:
|
539 |
MIPS_DEBUG("%s %s, %s, %s", opn, regnames[rd], regnames[rs], regnames[rt]);
|
540 |
} |
541 |
|
542 |
/* Arithmetic on HI/LO registers */
|
543 |
static void gen_HILO (DisasContext *ctx, uint16_t opc, int reg) |
544 |
{ |
545 |
const unsigned char *opn = "unk"; |
546 |
|
547 |
if (reg == 0 && (opc == OPC_MFHI || opc == OPC_MFLO)) { |
548 |
/* Treat as a NOP */
|
549 |
MIPS_DEBUG("NOP");
|
550 |
return;
|
551 |
} |
552 |
switch (opc) {
|
553 |
case OPC_MFHI:
|
554 |
gen_op_load_HI(); |
555 |
GEN_STORE_TN_REG(reg, T0); |
556 |
opn = "mfhi";
|
557 |
break;
|
558 |
case OPC_MFLO:
|
559 |
gen_op_load_LO(); |
560 |
GEN_STORE_TN_REG(reg, T0); |
561 |
opn = "mflo";
|
562 |
break;
|
563 |
case OPC_MTHI:
|
564 |
GEN_LOAD_REG_TN(T0, reg); |
565 |
gen_op_store_HI(); |
566 |
opn = "mthi";
|
567 |
break;
|
568 |
case OPC_MTLO:
|
569 |
GEN_LOAD_REG_TN(T0, reg); |
570 |
gen_op_store_LO(); |
571 |
opn = "mtlo";
|
572 |
break;
|
573 |
default:
|
574 |
MIPS_INVAL("HILO");
|
575 |
generate_exception(ctx, EXCP_RI); |
576 |
return;
|
577 |
} |
578 |
MIPS_DEBUG("%s %s", opn, regnames[reg]);
|
579 |
} |
580 |
|
581 |
static void gen_muldiv (DisasContext *ctx, uint16_t opc, |
582 |
int rs, int rt) |
583 |
{ |
584 |
const unsigned char *opn = "unk"; |
585 |
|
586 |
GEN_LOAD_REG_TN(T0, rs); |
587 |
GEN_LOAD_REG_TN(T1, rt); |
588 |
switch (opc) {
|
589 |
case OPC_DIV:
|
590 |
gen_op_div(); |
591 |
opn = "div";
|
592 |
break;
|
593 |
case OPC_DIVU:
|
594 |
gen_op_divu(); |
595 |
opn = "divu";
|
596 |
break;
|
597 |
case OPC_MULT:
|
598 |
gen_op_mult(); |
599 |
opn = "mult";
|
600 |
break;
|
601 |
case OPC_MULTU:
|
602 |
gen_op_multu(); |
603 |
opn = "multu";
|
604 |
break;
|
605 |
case OPC_MADD:
|
606 |
gen_op_madd(); |
607 |
opn = "madd";
|
608 |
break;
|
609 |
case OPC_MADDU:
|
610 |
gen_op_maddu(); |
611 |
opn = "maddu";
|
612 |
break;
|
613 |
case OPC_MSUB:
|
614 |
gen_op_msub(); |
615 |
opn = "msub";
|
616 |
break;
|
617 |
case OPC_MSUBU:
|
618 |
gen_op_msubu(); |
619 |
opn = "msubu";
|
620 |
break;
|
621 |
default:
|
622 |
MIPS_INVAL("mul/div");
|
623 |
generate_exception(ctx, EXCP_RI); |
624 |
return;
|
625 |
} |
626 |
MIPS_DEBUG("%s %s %s", opn, regnames[rs], regnames[rt]);
|
627 |
} |
628 |
|
629 |
static void gen_cl (DisasContext *ctx, uint16_t opc, |
630 |
int rd, int rs) |
631 |
{ |
632 |
const unsigned char *opn = "unk"; |
633 |
if (rd == 0) { |
634 |
/* Treat as a NOP */
|
635 |
MIPS_DEBUG("NOP");
|
636 |
return;
|
637 |
} |
638 |
GEN_LOAD_REG_TN(T0, rs); |
639 |
switch (opc) {
|
640 |
case OPC_CLO:
|
641 |
/* CLO */
|
642 |
gen_op_clo(); |
643 |
opn = "clo";
|
644 |
break;
|
645 |
case OPC_CLZ:
|
646 |
/* CLZ */
|
647 |
gen_op_clz(); |
648 |
opn = "clz";
|
649 |
break;
|
650 |
default:
|
651 |
MIPS_INVAL("CLx");
|
652 |
generate_exception(ctx, EXCP_RI); |
653 |
return;
|
654 |
} |
655 |
gen_op_store_T0_gpr(rd); |
656 |
MIPS_DEBUG("%s %s, %s", opn, regnames[rd], regnames[rs]);
|
657 |
} |
658 |
|
659 |
/* Traps */
|
660 |
static void gen_trap (DisasContext *ctx, uint16_t opc, |
661 |
int rs, int rt, int16_t imm) |
662 |
{ |
663 |
int cond;
|
664 |
|
665 |
cond = 0;
|
666 |
/* Load needed operands */
|
667 |
switch (opc) {
|
668 |
case OPC_TEQ:
|
669 |
case OPC_TGE:
|
670 |
case OPC_TGEU:
|
671 |
case OPC_TLT:
|
672 |
case OPC_TLTU:
|
673 |
case OPC_TNE:
|
674 |
/* Compare two registers */
|
675 |
if (rs != rt) {
|
676 |
GEN_LOAD_REG_TN(T0, rs); |
677 |
GEN_LOAD_REG_TN(T1, rt); |
678 |
cond = 1;
|
679 |
} |
680 |
case OPC_TEQI:
|
681 |
case OPC_TGEI:
|
682 |
case OPC_TGEIU:
|
683 |
case OPC_TLTI:
|
684 |
case OPC_TLTIU:
|
685 |
case OPC_TNEI:
|
686 |
/* Compare register to immediate */
|
687 |
if (rs != 0 || imm != 0) { |
688 |
GEN_LOAD_REG_TN(T0, rs); |
689 |
GEN_LOAD_IMM_TN(T1, (int32_t)imm); |
690 |
cond = 1;
|
691 |
} |
692 |
break;
|
693 |
} |
694 |
if (cond == 0) { |
695 |
switch (opc) {
|
696 |
case OPC_TEQ: /* rs == rs */ |
697 |
case OPC_TEQI: /* r0 == 0 */ |
698 |
case OPC_TGE: /* rs >= rs */ |
699 |
case OPC_TGEI: /* r0 >= 0 */ |
700 |
case OPC_TGEU: /* rs >= rs unsigned */ |
701 |
case OPC_TGEIU: /* r0 >= 0 unsigned */ |
702 |
/* Always trap */
|
703 |
gen_op_set_T0(1);
|
704 |
break;
|
705 |
case OPC_TLT: /* rs < rs */ |
706 |
case OPC_TLTI: /* r0 < 0 */ |
707 |
case OPC_TLTU: /* rs < rs unsigned */ |
708 |
case OPC_TLTIU: /* r0 < 0 unsigned */ |
709 |
case OPC_TNE: /* rs != rs */ |
710 |
case OPC_TNEI: /* r0 != 0 */ |
711 |
/* Never trap: treat as NOP */
|
712 |
return;
|
713 |
default:
|
714 |
MIPS_INVAL("TRAP");
|
715 |
generate_exception(ctx, EXCP_RI); |
716 |
return;
|
717 |
} |
718 |
} else {
|
719 |
switch (opc) {
|
720 |
case OPC_TEQ:
|
721 |
case OPC_TEQI:
|
722 |
gen_op_eq(); |
723 |
break;
|
724 |
case OPC_TGE:
|
725 |
case OPC_TGEI:
|
726 |
gen_op_ge(); |
727 |
break;
|
728 |
case OPC_TGEU:
|
729 |
case OPC_TGEIU:
|
730 |
gen_op_geu(); |
731 |
break;
|
732 |
case OPC_TLT:
|
733 |
case OPC_TLTI:
|
734 |
gen_op_lt(); |
735 |
break;
|
736 |
case OPC_TLTU:
|
737 |
case OPC_TLTIU:
|
738 |
gen_op_ltu(); |
739 |
break;
|
740 |
case OPC_TNE:
|
741 |
case OPC_TNEI:
|
742 |
gen_op_ne(); |
743 |
break;
|
744 |
default:
|
745 |
MIPS_INVAL("TRAP");
|
746 |
generate_exception(ctx, EXCP_RI); |
747 |
return;
|
748 |
} |
749 |
} |
750 |
save_cpu_state(ctx, 1);
|
751 |
gen_op_trap(); |
752 |
ctx->bstate = BS_STOP; |
753 |
} |
754 |
|
755 |
/* Branches (before delay slot) */
|
756 |
static void gen_compute_branch (DisasContext *ctx, uint16_t opc, |
757 |
int rs, int rt, int32_t offset) |
758 |
{ |
759 |
target_ulong btarget; |
760 |
int blink, bcond;
|
761 |
|
762 |
btarget = -1;
|
763 |
blink = 0;
|
764 |
bcond = 0;
|
765 |
/* Load needed operands */
|
766 |
switch (opc) {
|
767 |
case OPC_BEQ:
|
768 |
case OPC_BEQL:
|
769 |
case OPC_BNE:
|
770 |
case OPC_BNEL:
|
771 |
/* Compare two registers */
|
772 |
if (rs != rt) {
|
773 |
GEN_LOAD_REG_TN(T0, rs); |
774 |
GEN_LOAD_REG_TN(T1, rt); |
775 |
bcond = 1;
|
776 |
} |
777 |
btarget = ctx->pc + 4 + offset;
|
778 |
break;
|
779 |
case OPC_BGEZ:
|
780 |
case OPC_BGEZAL:
|
781 |
case OPC_BGEZALL:
|
782 |
case OPC_BGEZL:
|
783 |
case OPC_BGTZ:
|
784 |
case OPC_BGTZL:
|
785 |
case OPC_BLEZ:
|
786 |
case OPC_BLEZL:
|
787 |
case OPC_BLTZ:
|
788 |
case OPC_BLTZAL:
|
789 |
case OPC_BLTZALL:
|
790 |
case OPC_BLTZL:
|
791 |
/* Compare to zero */
|
792 |
if (rs != 0) { |
793 |
gen_op_load_gpr_T0(rs); |
794 |
bcond = 1;
|
795 |
} |
796 |
btarget = ctx->pc + 4 + offset;
|
797 |
break;
|
798 |
case OPC_J:
|
799 |
case OPC_JAL:
|
800 |
/* Jump to immediate */
|
801 |
btarget = ((ctx->pc + 4) & 0xFF000000) | offset; |
802 |
break;
|
803 |
case OPC_JR:
|
804 |
case OPC_JALR:
|
805 |
/* Jump to register */
|
806 |
if (offset != 0) { |
807 |
/* Only hint = 0 is valid */
|
808 |
generate_exception(ctx, EXCP_RI); |
809 |
return;
|
810 |
} |
811 |
GEN_LOAD_REG_TN(T2, rs); |
812 |
break;
|
813 |
default:
|
814 |
MIPS_INVAL("branch/jump");
|
815 |
generate_exception(ctx, EXCP_RI); |
816 |
return;
|
817 |
} |
818 |
if (bcond == 0) { |
819 |
/* No condition to be computed */
|
820 |
switch (opc) {
|
821 |
case OPC_BEQ: /* rx == rx */ |
822 |
case OPC_BEQL: /* rx == rx likely */ |
823 |
case OPC_BGEZ: /* 0 >= 0 */ |
824 |
case OPC_BGEZL: /* 0 >= 0 likely */ |
825 |
case OPC_BLEZ: /* 0 <= 0 */ |
826 |
case OPC_BLEZL: /* 0 <= 0 likely */ |
827 |
/* Always take */
|
828 |
ctx->hflags |= MIPS_HFLAG_DS | MIPS_HFLAG_B; |
829 |
MIPS_DEBUG("balways");
|
830 |
break;
|
831 |
case OPC_BGEZAL: /* 0 >= 0 */ |
832 |
case OPC_BGEZALL: /* 0 >= 0 likely */ |
833 |
/* Always take and link */
|
834 |
blink = 31;
|
835 |
ctx->hflags |= MIPS_HFLAG_DS | MIPS_HFLAG_B; |
836 |
MIPS_DEBUG("balways and link");
|
837 |
break;
|
838 |
case OPC_BNE: /* rx != rx */ |
839 |
case OPC_BGTZ: /* 0 > 0 */ |
840 |
case OPC_BLTZ: /* 0 < 0 */ |
841 |
case OPC_BLTZAL: /* 0 < 0 */ |
842 |
/* Treated as NOP */
|
843 |
MIPS_DEBUG("bnever (NOP)");
|
844 |
return;
|
845 |
case OPC_BNEL: /* rx != rx likely */ |
846 |
case OPC_BGTZL: /* 0 > 0 likely */ |
847 |
case OPC_BLTZALL: /* 0 < 0 likely */ |
848 |
case OPC_BLTZL: /* 0 < 0 likely */ |
849 |
/* Skip the instruction in the delay slot */
|
850 |
MIPS_DEBUG("bnever and skip");
|
851 |
gen_op_branch((long)ctx->tb, ctx->pc + 4); |
852 |
return;
|
853 |
case OPC_J:
|
854 |
ctx->hflags |= MIPS_HFLAG_DS | MIPS_HFLAG_B; |
855 |
MIPS_DEBUG("j %08x", btarget);
|
856 |
break;
|
857 |
case OPC_JAL:
|
858 |
blink = 31;
|
859 |
ctx->hflags |= MIPS_HFLAG_DS | MIPS_HFLAG_B; |
860 |
MIPS_DEBUG("jal %08x", btarget);
|
861 |
break;
|
862 |
case OPC_JR:
|
863 |
ctx->hflags |= MIPS_HFLAG_DS | MIPS_HFLAG_BR; |
864 |
MIPS_DEBUG("jr %s", regnames[rs]);
|
865 |
break;
|
866 |
case OPC_JALR:
|
867 |
blink = rt; |
868 |
ctx->hflags |= MIPS_HFLAG_DS | MIPS_HFLAG_BR; |
869 |
MIPS_DEBUG("jalr %s, %s", regnames[rt], regnames[rs]);
|
870 |
break;
|
871 |
default:
|
872 |
MIPS_INVAL("branch/jump");
|
873 |
generate_exception(ctx, EXCP_RI); |
874 |
return;
|
875 |
} |
876 |
} else {
|
877 |
switch (opc) {
|
878 |
case OPC_BEQ:
|
879 |
gen_op_eq(); |
880 |
MIPS_DEBUG("beq %s, %s, %08x",
|
881 |
regnames[rs], regnames[rt], btarget); |
882 |
goto not_likely;
|
883 |
case OPC_BEQL:
|
884 |
gen_op_eq(); |
885 |
MIPS_DEBUG("beql %s, %s, %08x",
|
886 |
regnames[rs], regnames[rt], btarget); |
887 |
goto likely;
|
888 |
case OPC_BNE:
|
889 |
gen_op_ne(); |
890 |
MIPS_DEBUG("bne %s, %s, %08x",
|
891 |
regnames[rs], regnames[rt], btarget); |
892 |
goto not_likely;
|
893 |
case OPC_BNEL:
|
894 |
gen_op_ne(); |
895 |
MIPS_DEBUG("bnel %s, %s, %08x",
|
896 |
regnames[rs], regnames[rt], btarget); |
897 |
goto likely;
|
898 |
case OPC_BGEZ:
|
899 |
gen_op_gez(); |
900 |
MIPS_DEBUG("bgez %s, %08x", regnames[rs], btarget);
|
901 |
goto not_likely;
|
902 |
case OPC_BGEZL:
|
903 |
gen_op_gez(); |
904 |
MIPS_DEBUG("bgezl %s, %08x", regnames[rs], btarget);
|
905 |
goto likely;
|
906 |
case OPC_BGEZAL:
|
907 |
gen_op_gez(); |
908 |
MIPS_DEBUG("bgezal %s, %08x", regnames[rs], btarget);
|
909 |
blink = 31;
|
910 |
goto not_likely;
|
911 |
case OPC_BGEZALL:
|
912 |
gen_op_gez(); |
913 |
blink = 31;
|
914 |
MIPS_DEBUG("bgezall %s, %08x", regnames[rs], btarget);
|
915 |
goto likely;
|
916 |
case OPC_BGTZ:
|
917 |
gen_op_gtz(); |
918 |
MIPS_DEBUG("bgtz %s, %08x", regnames[rs], btarget);
|
919 |
goto not_likely;
|
920 |
case OPC_BGTZL:
|
921 |
gen_op_gtz(); |
922 |
MIPS_DEBUG("bgtzl %s, %08x", regnames[rs], btarget);
|
923 |
goto likely;
|
924 |
case OPC_BLEZ:
|
925 |
gen_op_lez(); |
926 |
MIPS_DEBUG("blez %s, %08x", regnames[rs], btarget);
|
927 |
goto not_likely;
|
928 |
case OPC_BLEZL:
|
929 |
gen_op_lez(); |
930 |
MIPS_DEBUG("blezl %s, %08x", regnames[rs], btarget);
|
931 |
goto likely;
|
932 |
case OPC_BLTZ:
|
933 |
gen_op_ltz(); |
934 |
MIPS_DEBUG("bltz %s, %08x", regnames[rs], btarget);
|
935 |
goto not_likely;
|
936 |
case OPC_BLTZL:
|
937 |
gen_op_ltz(); |
938 |
MIPS_DEBUG("bltzl %s, %08x", regnames[rs], btarget);
|
939 |
goto likely;
|
940 |
case OPC_BLTZAL:
|
941 |
gen_op_ltz(); |
942 |
blink = 31;
|
943 |
MIPS_DEBUG("bltzal %s, %08x", regnames[rs], btarget);
|
944 |
not_likely:
|
945 |
ctx->hflags |= MIPS_HFLAG_DS | MIPS_HFLAG_BC; |
946 |
break;
|
947 |
case OPC_BLTZALL:
|
948 |
gen_op_ltz(); |
949 |
blink = 31;
|
950 |
MIPS_DEBUG("bltzall %s, %08x", regnames[rs], btarget);
|
951 |
likely:
|
952 |
ctx->hflags |= MIPS_HFLAG_DS | MIPS_HFLAG_BL; |
953 |
break;
|
954 |
} |
955 |
gen_op_set_bcond(); |
956 |
} |
957 |
MIPS_DEBUG("enter ds: link %d cond %02x target %08x",
|
958 |
blink, ctx->hflags, btarget); |
959 |
ctx->btarget = btarget; |
960 |
if (blink > 0) { |
961 |
gen_op_set_T0(ctx->pc + 8);
|
962 |
gen_op_store_T0_gpr(blink); |
963 |
} |
964 |
return;
|
965 |
} |
966 |
|
967 |
/* CP0 (MMU and control) */
|
968 |
static void gen_cp0 (DisasContext *ctx, uint16_t opc, int rt, int rd) |
969 |
{ |
970 |
const unsigned char *opn = "unk"; |
971 |
|
972 |
if (!(ctx->CP0_Status & (1 << CP0St_CU0))) { |
973 |
if (loglevel & CPU_LOG_TB_IN_ASM) {
|
974 |
fprintf(logfile, "CP0 is not usable\n");
|
975 |
} |
976 |
gen_op_raise_exception_err(EXCP_CpU, 0);
|
977 |
return;
|
978 |
} |
979 |
switch (opc) {
|
980 |
case OPC_MFC0:
|
981 |
if (rt == 0) { |
982 |
/* Treat as NOP */
|
983 |
return;
|
984 |
} |
985 |
gen_op_mfc0(rd, ctx->opcode & 0x7);
|
986 |
gen_op_store_T0_gpr(rt); |
987 |
opn = "mfc0";
|
988 |
break;
|
989 |
case OPC_MTC0:
|
990 |
/* If we get an exception, we want to restart at next instruction */
|
991 |
ctx->pc += 4;
|
992 |
save_cpu_state(ctx, 1);
|
993 |
ctx->pc -= 4;
|
994 |
GEN_LOAD_REG_TN(T0, rt); |
995 |
gen_op_mtc0(rd, ctx->opcode & 0x7);
|
996 |
/* Stop translation as we may have switched the execution mode */
|
997 |
ctx->bstate = BS_STOP; |
998 |
opn = "mtc0";
|
999 |
break;
|
1000 |
#if defined(MIPS_USES_R4K_TLB)
|
1001 |
case OPC_TLBWI:
|
1002 |
gen_op_tlbwi(); |
1003 |
opn = "tlbwi";
|
1004 |
break;
|
1005 |
case OPC_TLBWR:
|
1006 |
gen_op_tlbwr(); |
1007 |
opn = "tlbwr";
|
1008 |
break;
|
1009 |
case OPC_TLBP:
|
1010 |
gen_op_tlbp(); |
1011 |
opn = "tlbp";
|
1012 |
break;
|
1013 |
case OPC_TLBR:
|
1014 |
gen_op_tlbr(); |
1015 |
opn = "tlbr";
|
1016 |
break;
|
1017 |
#endif
|
1018 |
case OPC_ERET:
|
1019 |
opn = "eret";
|
1020 |
save_cpu_state(ctx, 0);
|
1021 |
gen_op_eret(); |
1022 |
ctx->bstate = BS_EXCP; |
1023 |
break;
|
1024 |
case OPC_DERET:
|
1025 |
opn = "deret";
|
1026 |
if (!(ctx->hflags & MIPS_HFLAG_DM)) {
|
1027 |
generate_exception(ctx, EXCP_RI); |
1028 |
} else {
|
1029 |
save_cpu_state(ctx, 0);
|
1030 |
gen_op_deret(); |
1031 |
ctx->bstate = BS_EXCP; |
1032 |
} |
1033 |
break;
|
1034 |
/* XXX: TODO: WAIT */
|
1035 |
default:
|
1036 |
if (loglevel & CPU_LOG_TB_IN_ASM) {
|
1037 |
fprintf(logfile, "Invalid CP0 opcode: %08x %03x %03x %03x\n",
|
1038 |
ctx->opcode, ctx->opcode >> 26, ctx->opcode & 0x3F, |
1039 |
((ctx->opcode >> 16) & 0x1F)); |
1040 |
} |
1041 |
generate_exception(ctx, EXCP_RI); |
1042 |
return;
|
1043 |
} |
1044 |
MIPS_DEBUG("%s %s %d", opn, regnames[rt], rd);
|
1045 |
} |
1046 |
|
1047 |
/* Coprocessor 1 (FPU) */
|
1048 |
|
1049 |
/* ISA extensions */
|
1050 |
/* MIPS16 extension to MIPS32 */
|
1051 |
/* SmartMIPS extension to MIPS32 */
|
1052 |
|
1053 |
#ifdef TARGET_MIPS64
|
1054 |
static void gen_arith64 (DisasContext *ctx, uint16_t opc) |
1055 |
{ |
1056 |
if (func == 0x02 && rd == 0) { |
1057 |
/* NOP */
|
1058 |
return;
|
1059 |
} |
1060 |
if (rs == 0 || rt == 0) { |
1061 |
gen_op_reset_T0(); |
1062 |
gen_op_save64(); |
1063 |
} else {
|
1064 |
gen_op_load_gpr_T0(rs); |
1065 |
gen_op_load_gpr_T1(rt); |
1066 |
gen_op_save64(); |
1067 |
if (func & 0x01) |
1068 |
gen_op_mul64u(); |
1069 |
else
|
1070 |
gen_op_mul64s(); |
1071 |
} |
1072 |
if (func & 0x02) |
1073 |
gen_op_add64(); |
1074 |
else
|
1075 |
gen_op_sub64(); |
1076 |
} |
1077 |
|
1078 |
/* Coprocessor 3 (FPU) */
|
1079 |
|
1080 |
/* MDMX extension to MIPS64 */
|
1081 |
/* MIPS-3D extension to MIPS64 */
|
1082 |
|
1083 |
#endif
|
1084 |
|
1085 |
static void decode_opc (DisasContext *ctx) |
1086 |
{ |
1087 |
int32_t offset; |
1088 |
int rs, rt, rd, sa;
|
1089 |
uint16_t op, op1; |
1090 |
int16_t imm; |
1091 |
|
1092 |
if ((ctx->hflags & MIPS_HFLAG_DS) &&
|
1093 |
(ctx->hflags & MIPS_HFLAG_BL)) { |
1094 |
/* Handle blikely not taken case */
|
1095 |
MIPS_DEBUG("blikely condition (%08x)", ctx->pc + 4); |
1096 |
gen_op_blikely((long)ctx->tb, ctx->pc + 4, |
1097 |
ctx->hflags & ~(MIPS_HFLAG_BMASK | MIPS_HFLAG_DS)); |
1098 |
} |
1099 |
op = ctx->opcode >> 26;
|
1100 |
rs = ((ctx->opcode >> 21) & 0x1F); |
1101 |
rt = ((ctx->opcode >> 16) & 0x1F); |
1102 |
rd = ((ctx->opcode >> 11) & 0x1F); |
1103 |
sa = ((ctx->opcode >> 6) & 0x1F); |
1104 |
imm = (int16_t)ctx->opcode; |
1105 |
switch (op) {
|
1106 |
case 0x00: /* Special opcode */ |
1107 |
op1 = ctx->opcode & 0x3F;
|
1108 |
switch (op1) {
|
1109 |
case 0x00: /* Arithmetic with immediate */ |
1110 |
case 0x02 ... 0x03: |
1111 |
gen_arith_imm(ctx, op1 | EXT_SPECIAL, rd, rt, sa); |
1112 |
break;
|
1113 |
case 0x04: /* Arithmetic */ |
1114 |
case 0x06 ... 0x07: |
1115 |
case 0x0A ... 0x0B: |
1116 |
case 0x20 ... 0x27: |
1117 |
case 0x2A ... 0x2B: |
1118 |
gen_arith(ctx, op1 | EXT_SPECIAL, rd, rs, rt); |
1119 |
break;
|
1120 |
case 0x18 ... 0x1B: /* MULT / DIV */ |
1121 |
gen_muldiv(ctx, op1 | EXT_SPECIAL, rs, rt); |
1122 |
break;
|
1123 |
case 0x08 ... 0x09: /* Jumps */ |
1124 |
gen_compute_branch(ctx, op1 | EXT_SPECIAL, rs, rd, sa); |
1125 |
return;
|
1126 |
case 0x30 ... 0x34: /* Traps */ |
1127 |
case 0x36: |
1128 |
gen_trap(ctx, op1 | EXT_SPECIAL, rs, rt, -1);
|
1129 |
break;
|
1130 |
case 0x10: /* Move from HI/LO */ |
1131 |
case 0x12: |
1132 |
gen_HILO(ctx, op1 | EXT_SPECIAL, rd); |
1133 |
break;
|
1134 |
case 0x11: |
1135 |
case 0x13: /* Move to HI/LO */ |
1136 |
gen_HILO(ctx, op1 | EXT_SPECIAL, rs); |
1137 |
break;
|
1138 |
case 0x0C: /* SYSCALL */ |
1139 |
generate_exception(ctx, EXCP_SYSCALL); |
1140 |
break;
|
1141 |
case 0x0D: /* BREAK */ |
1142 |
generate_exception(ctx, EXCP_BREAK); |
1143 |
break;
|
1144 |
case 0x0F: /* SYNC */ |
1145 |
/* Treat as a noop */
|
1146 |
break;
|
1147 |
case 0x05: /* Pmon entry point */ |
1148 |
gen_op_pmon((ctx->opcode >> 6) & 0x1F); |
1149 |
break;
|
1150 |
#if defined (MIPS_HAS_MOVCI)
|
1151 |
case 0x01: /* MOVCI */ |
1152 |
#endif
|
1153 |
#if defined (TARGET_MIPS64)
|
1154 |
case 0x14: /* MIPS64 specific opcodes */ |
1155 |
case 0x16: |
1156 |
case 0x17: |
1157 |
case 0x1C ... 0x1F: |
1158 |
case 0x2C ... 0x2F: |
1159 |
case 0x37: |
1160 |
case 0x39 ... 0x3B: |
1161 |
case 0x3E ... 0x3F: |
1162 |
#endif
|
1163 |
default: /* Invalid */ |
1164 |
MIPS_INVAL("special");
|
1165 |
generate_exception(ctx, EXCP_RI); |
1166 |
break;
|
1167 |
} |
1168 |
break;
|
1169 |
case 0x1C: /* Special2 opcode */ |
1170 |
op1 = ctx->opcode & 0x3F;
|
1171 |
switch (op1) {
|
1172 |
#if defined (MIPS_USES_R4K_EXT)
|
1173 |
/* Those instructions are not part of MIPS32 core */
|
1174 |
case 0x00 ... 0x01: /* Multiply and add/sub */ |
1175 |
case 0x04 ... 0x05: |
1176 |
gen_muldiv(ctx, op1 | EXT_SPECIAL2, rs, rt); |
1177 |
break;
|
1178 |
case 0x02: /* MUL */ |
1179 |
gen_arith(ctx, op1 | EXT_SPECIAL2, rd, rs, rt); |
1180 |
break;
|
1181 |
case 0x20 ... 0x21: /* CLO / CLZ */ |
1182 |
gen_cl(ctx, op1 | EXT_SPECIAL2, rd, rs); |
1183 |
break;
|
1184 |
#endif
|
1185 |
case 0x3F: /* SDBBP */ |
1186 |
/* XXX: not clear which exception should be raised
|
1187 |
* when in debug mode...
|
1188 |
*/
|
1189 |
if (!(ctx->hflags & MIPS_HFLAG_DM)) {
|
1190 |
generate_exception(ctx, EXCP_DBp); |
1191 |
} else {
|
1192 |
generate_exception(ctx, EXCP_DBp); |
1193 |
} |
1194 |
/* Treat as a noop */
|
1195 |
break;
|
1196 |
default: /* Invalid */ |
1197 |
MIPS_INVAL("special2");
|
1198 |
generate_exception(ctx, EXCP_RI); |
1199 |
break;
|
1200 |
} |
1201 |
break;
|
1202 |
case 0x01: /* B REGIMM opcode */ |
1203 |
op1 = ((ctx->opcode >> 16) & 0x1F); |
1204 |
switch (op1) {
|
1205 |
case 0x00 ... 0x03: /* REGIMM branches */ |
1206 |
case 0x10 ... 0x13: |
1207 |
gen_compute_branch(ctx, op1 | EXT_REGIMM, rs, -1, imm << 2); |
1208 |
return;
|
1209 |
case 0x08 ... 0x0C: /* Traps */ |
1210 |
case 0x0E: |
1211 |
gen_trap(ctx, op1 | EXT_REGIMM, rs, -1, imm);
|
1212 |
break;
|
1213 |
default: /* Invalid */ |
1214 |
MIPS_INVAL("REGIMM");
|
1215 |
generate_exception(ctx, EXCP_RI); |
1216 |
break;
|
1217 |
} |
1218 |
break;
|
1219 |
case 0x10: /* CP0 opcode */ |
1220 |
op1 = ((ctx->opcode >> 21) & 0x1F); |
1221 |
switch (op1) {
|
1222 |
case 0x00: |
1223 |
case 0x04: |
1224 |
gen_cp0(ctx, op1 | EXT_CP0, rt, rd); |
1225 |
break;
|
1226 |
default:
|
1227 |
gen_cp0(ctx, (ctx->opcode & 0x1F) | EXT_CP0, rt, rd);
|
1228 |
break;
|
1229 |
} |
1230 |
break;
|
1231 |
case 0x08 ... 0x0F: /* Arithmetic with immediate opcode */ |
1232 |
gen_arith_imm(ctx, op, rt, rs, imm); |
1233 |
break;
|
1234 |
case 0x02 ... 0x03: /* Jump */ |
1235 |
offset = (int32_t)(ctx->opcode & 0x03FFFFFF) << 2; |
1236 |
gen_compute_branch(ctx, op, rs, rt, offset); |
1237 |
return;
|
1238 |
case 0x04 ... 0x07: /* Branch */ |
1239 |
case 0x14 ... 0x17: |
1240 |
gen_compute_branch(ctx, op, rs, rt, imm << 2);
|
1241 |
return;
|
1242 |
case 0x20 ... 0x26: /* Load and stores */ |
1243 |
case 0x28 ... 0x2E: |
1244 |
case 0x30: |
1245 |
case 0x38: |
1246 |
gen_ldst(ctx, op, rt, rs, imm); |
1247 |
break;
|
1248 |
case 0x2F: /* Cache operation */ |
1249 |
/* Treat as a noop */
|
1250 |
break;
|
1251 |
case 0x33: /* Prefetch */ |
1252 |
/* Treat as a noop */
|
1253 |
break;
|
1254 |
case 0x3F: /* HACK */ |
1255 |
break;
|
1256 |
#if defined(MIPS_USES_FPU)
|
1257 |
case 0x31 ... 0x32: /* Floating point load/store */ |
1258 |
case 0x35 ... 0x36: |
1259 |
case 0x3A ... 0x3B: |
1260 |
case 0x3D ... 0x3E: |
1261 |
/* Not implemented */
|
1262 |
/* XXX: not correct */
|
1263 |
#endif
|
1264 |
case 0x11: /* CP1 opcode */ |
1265 |
/* Not implemented */
|
1266 |
/* XXX: not correct */
|
1267 |
case 0x12: /* CP2 opcode */ |
1268 |
/* Not implemented */
|
1269 |
/* XXX: not correct */
|
1270 |
case 0x13: /* CP3 opcode */ |
1271 |
/* Not implemented */
|
1272 |
/* XXX: not correct */
|
1273 |
#if defined (TARGET_MIPS64)
|
1274 |
case 0x18 ... 0x1B: |
1275 |
case 0x27: |
1276 |
case 0x34: |
1277 |
case 0x37: |
1278 |
/* MIPS64 opcodes */
|
1279 |
#endif
|
1280 |
#if defined (MIPS_HAS_JALX)
|
1281 |
case 0x1D: |
1282 |
/* JALX: not implemented */
|
1283 |
#endif
|
1284 |
case 0x1E: |
1285 |
/* ASE specific */
|
1286 |
#if defined (MIPS_HAS_LSC)
|
1287 |
case 0x31: /* LWC1 */ |
1288 |
case 0x32: /* LWC2 */ |
1289 |
case 0x35: /* SDC1 */ |
1290 |
case 0x36: /* SDC2 */ |
1291 |
#endif
|
1292 |
default: /* Invalid */ |
1293 |
MIPS_INVAL("");
|
1294 |
generate_exception(ctx, EXCP_RI); |
1295 |
break;
|
1296 |
} |
1297 |
if (ctx->hflags & MIPS_HFLAG_DS) {
|
1298 |
int hflags = ctx->hflags;
|
1299 |
/* Branches completion */
|
1300 |
ctx->hflags &= ~(MIPS_HFLAG_BMASK | MIPS_HFLAG_DS); |
1301 |
ctx->bstate = BS_BRANCH; |
1302 |
save_cpu_state(ctx, 0);
|
1303 |
switch (hflags & MIPS_HFLAG_BMASK) {
|
1304 |
case MIPS_HFLAG_B:
|
1305 |
/* unconditional branch */
|
1306 |
MIPS_DEBUG("unconditional branch");
|
1307 |
gen_op_branch((long)ctx->tb, ctx->btarget);
|
1308 |
break;
|
1309 |
case MIPS_HFLAG_BL:
|
1310 |
/* blikely taken case */
|
1311 |
MIPS_DEBUG("blikely branch taken");
|
1312 |
gen_op_branch((long)ctx->tb, ctx->btarget);
|
1313 |
break;
|
1314 |
case MIPS_HFLAG_BC:
|
1315 |
/* Conditional branch */
|
1316 |
MIPS_DEBUG("conditional branch");
|
1317 |
gen_op_bcond((long)ctx->tb, ctx->btarget, ctx->pc + 4); |
1318 |
break;
|
1319 |
case MIPS_HFLAG_BR:
|
1320 |
/* unconditional branch to register */
|
1321 |
MIPS_DEBUG("branch to register");
|
1322 |
gen_op_breg(); |
1323 |
break;
|
1324 |
default:
|
1325 |
MIPS_DEBUG("unknown branch");
|
1326 |
break;
|
1327 |
} |
1328 |
} |
1329 |
} |
1330 |
|
1331 |
int gen_intermediate_code_internal (CPUState *env, TranslationBlock *tb,
|
1332 |
int search_pc)
|
1333 |
{ |
1334 |
DisasContext ctx, *ctxp = &ctx; |
1335 |
target_ulong pc_start; |
1336 |
uint16_t *gen_opc_end; |
1337 |
int j, lj = -1; |
1338 |
|
1339 |
pc_start = tb->pc; |
1340 |
gen_opc_ptr = gen_opc_buf; |
1341 |
gen_opc_end = gen_opc_buf + OPC_MAX_SIZE; |
1342 |
gen_opparam_ptr = gen_opparam_buf; |
1343 |
ctx.pc = pc_start; |
1344 |
ctx.tb = tb; |
1345 |
ctx.bstate = BS_NONE; |
1346 |
/* Restore delay slot state */
|
1347 |
ctx.hflags = env->hflags; |
1348 |
ctx.saved_hflags = ctx.hflags; |
1349 |
if (ctx.hflags & MIPS_HFLAG_BR) {
|
1350 |
gen_op_restore_breg_target(); |
1351 |
} else if (ctx.hflags & MIPS_HFLAG_B) { |
1352 |
ctx.btarget = env->btarget; |
1353 |
} else if (ctx.hflags & MIPS_HFLAG_BMASK) { |
1354 |
/* If we are in the delay slot of a conditional branch,
|
1355 |
* restore the branch condition from env->bcond to T2
|
1356 |
*/
|
1357 |
ctx.btarget = env->btarget; |
1358 |
gen_op_restore_bcond(); |
1359 |
} |
1360 |
#if defined(CONFIG_USER_ONLY)
|
1361 |
ctx.mem_idx = 0;
|
1362 |
#else
|
1363 |
ctx.mem_idx = (ctx.hflags & MIPS_HFLAG_MODE) == MIPS_HFLAG_UM ? 0 : 1; |
1364 |
#endif
|
1365 |
ctx.CP0_Status = env->CP0_Status; |
1366 |
#ifdef DEBUG_DISAS
|
1367 |
if (loglevel & CPU_LOG_TB_CPU) {
|
1368 |
fprintf(logfile, "------------------------------------------------\n");
|
1369 |
cpu_dump_state(env, logfile, fprintf, 0);
|
1370 |
} |
1371 |
#endif
|
1372 |
#if defined MIPS_DEBUG_DISAS
|
1373 |
if (loglevel & CPU_LOG_TB_IN_ASM)
|
1374 |
fprintf(logfile, "\ntb %p super %d cond %04x %04x\n",
|
1375 |
tb, ctx.mem_idx, ctx.hflags, env->hflags); |
1376 |
#endif
|
1377 |
while (ctx.bstate == BS_NONE && gen_opc_ptr < gen_opc_end) {
|
1378 |
if (search_pc) {
|
1379 |
j = gen_opc_ptr - gen_opc_buf; |
1380 |
save_cpu_state(ctxp, 1);
|
1381 |
if (lj < j) {
|
1382 |
lj++; |
1383 |
while (lj < j)
|
1384 |
gen_opc_instr_start[lj++] = 0;
|
1385 |
gen_opc_pc[lj] = ctx.pc; |
1386 |
gen_opc_instr_start[lj] = 1;
|
1387 |
} |
1388 |
} |
1389 |
ctx.opcode = ldl_code(ctx.pc); |
1390 |
decode_opc(&ctx); |
1391 |
ctx.pc += 4;
|
1392 |
if ((ctx.pc & (TARGET_PAGE_SIZE - 1)) == 0) |
1393 |
break;
|
1394 |
#if defined (MIPS_SINGLE_STEP)
|
1395 |
break;
|
1396 |
#endif
|
1397 |
} |
1398 |
if (ctx.bstate != BS_BRANCH && ctx.bstate != BS_EXCP) {
|
1399 |
save_cpu_state(ctxp, 0);
|
1400 |
gen_op_branch((long)ctx.tb, ctx.pc);
|
1401 |
} |
1402 |
gen_op_reset_T0(); |
1403 |
/* Generate the return instruction */
|
1404 |
gen_op_exit_tb(); |
1405 |
*gen_opc_ptr = INDEX_op_end; |
1406 |
if (search_pc) {
|
1407 |
j = gen_opc_ptr - gen_opc_buf; |
1408 |
lj++; |
1409 |
while (lj <= j)
|
1410 |
gen_opc_instr_start[lj++] = 0;
|
1411 |
tb->size = 0;
|
1412 |
} else {
|
1413 |
tb->size = ctx.pc - pc_start; |
1414 |
} |
1415 |
#ifdef DEBUG_DISAS
|
1416 |
#if defined MIPS_DEBUG_DISAS
|
1417 |
if (loglevel & CPU_LOG_TB_IN_ASM)
|
1418 |
fprintf(logfile, "\n");
|
1419 |
#endif
|
1420 |
if (loglevel & CPU_LOG_TB_IN_ASM) {
|
1421 |
fprintf(logfile, "IN: %s\n", lookup_symbol(pc_start));
|
1422 |
target_disas(logfile, pc_start, ctx.pc - pc_start, 0);
|
1423 |
fprintf(logfile, "\n");
|
1424 |
} |
1425 |
if (loglevel & CPU_LOG_TB_OP) {
|
1426 |
fprintf(logfile, "OP:\n");
|
1427 |
dump_ops(gen_opc_buf, gen_opparam_buf); |
1428 |
fprintf(logfile, "\n");
|
1429 |
} |
1430 |
if (loglevel & CPU_LOG_TB_CPU) {
|
1431 |
fprintf(logfile, "---------------- %d %08x\n", ctx.bstate, ctx.hflags);
|
1432 |
} |
1433 |
#endif
|
1434 |
|
1435 |
return 0; |
1436 |
} |
1437 |
|
1438 |
int gen_intermediate_code (CPUState *env, struct TranslationBlock *tb) |
1439 |
{ |
1440 |
return gen_intermediate_code_internal(env, tb, 0); |
1441 |
} |
1442 |
|
1443 |
int gen_intermediate_code_pc (CPUState *env, struct TranslationBlock *tb) |
1444 |
{ |
1445 |
return gen_intermediate_code_internal(env, tb, 1); |
1446 |
} |
1447 |
|
1448 |
void cpu_dump_state (CPUState *env, FILE *f,
|
1449 |
int (*cpu_fprintf)(FILE *f, const char *fmt, ...), |
1450 |
int flags)
|
1451 |
{ |
1452 |
int i;
|
1453 |
|
1454 |
cpu_fprintf(f, "pc=0x%08x HI=0x%08x LO=0x%08x ds %04x %08x %d\n",
|
1455 |
env->PC, env->HI, env->LO, env->hflags, env->btarget, env->bcond); |
1456 |
for (i = 0; i < 32; i++) { |
1457 |
if ((i & 3) == 0) |
1458 |
cpu_fprintf(f, "GPR%02d:", i);
|
1459 |
cpu_fprintf(f, " %s %08x", regnames[i], env->gpr[i]);
|
1460 |
if ((i & 3) == 3) |
1461 |
cpu_fprintf(f, "\n");
|
1462 |
} |
1463 |
cpu_fprintf(f, "CP0 Status 0x%08x Cause 0x%08x EPC 0x%08x\n",
|
1464 |
env->CP0_Status, env->CP0_Cause, env->CP0_EPC); |
1465 |
cpu_fprintf(f, " Config0 0x%08x Config1 0x%08x LLAddr 0x%08x\n",
|
1466 |
env->CP0_Config0, env->CP0_Config1, env->CP0_LLAddr); |
1467 |
} |
1468 |
|
1469 |
CPUMIPSState *cpu_mips_init (void)
|
1470 |
{ |
1471 |
CPUMIPSState *env; |
1472 |
|
1473 |
cpu_exec_init(); |
1474 |
env = qemu_mallocz(sizeof(CPUMIPSState));
|
1475 |
if (!env)
|
1476 |
return NULL; |
1477 |
tlb_flush(env, 1);
|
1478 |
/* Minimal init */
|
1479 |
env->PC = 0xBFC00000;
|
1480 |
#if defined (MIPS_USES_R4K_TLB)
|
1481 |
env->CP0_random = MIPS_TLB_NB - 1;
|
1482 |
#endif
|
1483 |
env->CP0_Wired = 0;
|
1484 |
env->CP0_Config0 = MIPS_CONFIG0; |
1485 |
#if defined (MIPS_CONFIG1)
|
1486 |
env->CP0_Config1 = MIPS_CONFIG1; |
1487 |
#endif
|
1488 |
#if defined (MIPS_CONFIG2)
|
1489 |
env->CP0_Config2 = MIPS_CONFIG2; |
1490 |
#endif
|
1491 |
#if defined (MIPS_CONFIG3)
|
1492 |
env->CP0_Config3 = MIPS_CONFIG3; |
1493 |
#endif
|
1494 |
env->CP0_Status = (1 << CP0St_CU0) | (1 << CP0St_BEV); |
1495 |
env->CP0_WatchLo = 0;
|
1496 |
env->hflags = MIPS_HFLAG_ERL; |
1497 |
/* Count register increments in debug mode, EJTAG version 1 */
|
1498 |
env->CP0_Debug = (1 << CP0DB_CNT) | (0x1 << CP0DB_VER); |
1499 |
env->CP0_PRid = MIPS_CPU; |
1500 |
env->exception_index = EXCP_NONE; |
1501 |
|
1502 |
cpu_single_env = env; |
1503 |
|
1504 |
return env;
|
1505 |
} |