2 * LatticeMico32 main translation routines.
4 * Copyright (c) 2010 Michael Walle <michael@walle.cc>
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.
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.
16 * You should have received a copy of the GNU Lesser General Public
17 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
21 #include "disas/disas.h"
25 #include "hw/lm32_pic.h"
32 # define LOG_DIS(...) qemu_log_mask(CPU_LOG_TB_IN_ASM, ## __VA_ARGS__)
34 # define LOG_DIS(...) do { } while (0)
37 #define EXTRACT_FIELD(src, start, end) \
38 (((src) >> start) & ((1 << (end - start + 1)) - 1))
42 static TCGv_ptr cpu_env
;
43 static TCGv cpu_R
[32];
53 static TCGv cpu_bp
[4];
54 static TCGv cpu_wp
[4];
56 #include "exec/gen-icount.h"
65 /* This is the state at translation time. */
66 typedef struct DisasContext
{
74 uint8_t r0
, r1
, r2
, csr
;
79 unsigned int delayed_branch
;
80 unsigned int tb_flags
, synced_flags
; /* tb dependent flags. */
84 struct TranslationBlock
*tb
;
85 int singlestep_enabled
;
88 static const char *regnames
[] = {
89 "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7",
90 "r8", "r9", "r10", "r11", "r12", "r13", "r14", "r15",
91 "r16", "r17", "r18", "r19", "r20", "r21", "r22", "r23",
92 "r24", "r25", "r26/gp", "r27/fp", "r28/sp", "r29/ra",
93 "r30/ea", "r31/ba", "bp0", "bp1", "bp2", "bp3", "wp0",
97 static inline int zero_extend(unsigned int val
, int width
)
99 return val
& ((1 << width
) - 1);
102 static inline int sign_extend(unsigned int val
, int width
)
115 static inline void t_gen_raise_exception(DisasContext
*dc
, uint32_t index
)
117 TCGv_i32 tmp
= tcg_const_i32(index
);
119 gen_helper_raise_exception(cpu_env
, tmp
);
120 tcg_temp_free_i32(tmp
);
123 static void gen_goto_tb(DisasContext
*dc
, int n
, target_ulong dest
)
125 TranslationBlock
*tb
;
128 if ((tb
->pc
& TARGET_PAGE_MASK
) == (dest
& TARGET_PAGE_MASK
) &&
129 likely(!dc
->singlestep_enabled
)) {
131 tcg_gen_movi_tl(cpu_pc
, dest
);
132 tcg_gen_exit_tb((tcg_target_long
)tb
+ n
);
134 tcg_gen_movi_tl(cpu_pc
, dest
);
135 if (dc
->singlestep_enabled
) {
136 t_gen_raise_exception(dc
, EXCP_DEBUG
);
142 static void dec_add(DisasContext
*dc
)
144 if (dc
->format
== OP_FMT_RI
) {
145 if (dc
->r0
== R_R0
) {
146 if (dc
->r1
== R_R0
&& dc
->imm16
== 0) {
149 LOG_DIS("mvi r%d, %d\n", dc
->r1
, sign_extend(dc
->imm16
, 16));
152 LOG_DIS("addi r%d, r%d, %d\n", dc
->r1
, dc
->r0
,
153 sign_extend(dc
->imm16
, 16));
156 LOG_DIS("add r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
159 if (dc
->format
== OP_FMT_RI
) {
160 tcg_gen_addi_tl(cpu_R
[dc
->r1
], cpu_R
[dc
->r0
],
161 sign_extend(dc
->imm16
, 16));
163 tcg_gen_add_tl(cpu_R
[dc
->r2
], cpu_R
[dc
->r0
], cpu_R
[dc
->r1
]);
167 static void dec_and(DisasContext
*dc
)
169 if (dc
->format
== OP_FMT_RI
) {
170 LOG_DIS("andi r%d, r%d, %d\n", dc
->r1
, dc
->r0
,
171 zero_extend(dc
->imm16
, 16));
173 LOG_DIS("and r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
176 if (dc
->format
== OP_FMT_RI
) {
177 tcg_gen_andi_tl(cpu_R
[dc
->r1
], cpu_R
[dc
->r0
],
178 zero_extend(dc
->imm16
, 16));
180 if (dc
->r0
== 0 && dc
->r1
== 0 && dc
->r2
== 0) {
181 tcg_gen_movi_tl(cpu_pc
, dc
->pc
+ 4);
182 gen_helper_hlt(cpu_env
);
184 tcg_gen_and_tl(cpu_R
[dc
->r2
], cpu_R
[dc
->r0
], cpu_R
[dc
->r1
]);
189 static void dec_andhi(DisasContext
*dc
)
191 LOG_DIS("andhi r%d, r%d, %d\n", dc
->r2
, dc
->r0
, dc
->imm16
);
193 tcg_gen_andi_tl(cpu_R
[dc
->r1
], cpu_R
[dc
->r0
], (dc
->imm16
<< 16));
196 static void dec_b(DisasContext
*dc
)
198 if (dc
->r0
== R_RA
) {
200 } else if (dc
->r0
== R_EA
) {
202 } else if (dc
->r0
== R_BA
) {
205 LOG_DIS("b r%d\n", dc
->r0
);
208 /* restore IE.IE in case of an eret */
209 if (dc
->r0
== R_EA
) {
210 TCGv t0
= tcg_temp_new();
211 int l1
= gen_new_label();
212 tcg_gen_andi_tl(t0
, cpu_ie
, IE_EIE
);
213 tcg_gen_ori_tl(cpu_ie
, cpu_ie
, IE_IE
);
214 tcg_gen_brcondi_tl(TCG_COND_EQ
, t0
, IE_EIE
, l1
);
215 tcg_gen_andi_tl(cpu_ie
, cpu_ie
, ~IE_IE
);
218 } else if (dc
->r0
== R_BA
) {
219 TCGv t0
= tcg_temp_new();
220 int l1
= gen_new_label();
221 tcg_gen_andi_tl(t0
, cpu_ie
, IE_BIE
);
222 tcg_gen_ori_tl(cpu_ie
, cpu_ie
, IE_IE
);
223 tcg_gen_brcondi_tl(TCG_COND_EQ
, t0
, IE_BIE
, l1
);
224 tcg_gen_andi_tl(cpu_ie
, cpu_ie
, ~IE_IE
);
228 tcg_gen_mov_tl(cpu_pc
, cpu_R
[dc
->r0
]);
230 dc
->is_jmp
= DISAS_JUMP
;
233 static void dec_bi(DisasContext
*dc
)
235 LOG_DIS("bi %d\n", sign_extend(dc
->imm26
<< 2, 26));
237 gen_goto_tb(dc
, 0, dc
->pc
+ (sign_extend(dc
->imm26
<< 2, 26)));
239 dc
->is_jmp
= DISAS_TB_JUMP
;
242 static inline void gen_cond_branch(DisasContext
*dc
, int cond
)
246 l1
= gen_new_label();
247 tcg_gen_brcond_tl(cond
, cpu_R
[dc
->r0
], cpu_R
[dc
->r1
], l1
);
248 gen_goto_tb(dc
, 0, dc
->pc
+ 4);
250 gen_goto_tb(dc
, 1, dc
->pc
+ (sign_extend(dc
->imm16
<< 2, 16)));
251 dc
->is_jmp
= DISAS_TB_JUMP
;
254 static void dec_be(DisasContext
*dc
)
256 LOG_DIS("be r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
257 sign_extend(dc
->imm16
, 16) * 4);
259 gen_cond_branch(dc
, TCG_COND_EQ
);
262 static void dec_bg(DisasContext
*dc
)
264 LOG_DIS("bg r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
265 sign_extend(dc
->imm16
, 16 * 4));
267 gen_cond_branch(dc
, TCG_COND_GT
);
270 static void dec_bge(DisasContext
*dc
)
272 LOG_DIS("bge r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
273 sign_extend(dc
->imm16
, 16) * 4);
275 gen_cond_branch(dc
, TCG_COND_GE
);
278 static void dec_bgeu(DisasContext
*dc
)
280 LOG_DIS("bgeu r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
281 sign_extend(dc
->imm16
, 16) * 4);
283 gen_cond_branch(dc
, TCG_COND_GEU
);
286 static void dec_bgu(DisasContext
*dc
)
288 LOG_DIS("bgu r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
289 sign_extend(dc
->imm16
, 16) * 4);
291 gen_cond_branch(dc
, TCG_COND_GTU
);
294 static void dec_bne(DisasContext
*dc
)
296 LOG_DIS("bne r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
297 sign_extend(dc
->imm16
, 16) * 4);
299 gen_cond_branch(dc
, TCG_COND_NE
);
302 static void dec_call(DisasContext
*dc
)
304 LOG_DIS("call r%d\n", dc
->r0
);
306 tcg_gen_movi_tl(cpu_R
[R_RA
], dc
->pc
+ 4);
307 tcg_gen_mov_tl(cpu_pc
, cpu_R
[dc
->r0
]);
309 dc
->is_jmp
= DISAS_JUMP
;
312 static void dec_calli(DisasContext
*dc
)
314 LOG_DIS("calli %d\n", sign_extend(dc
->imm26
, 26) * 4);
316 tcg_gen_movi_tl(cpu_R
[R_RA
], dc
->pc
+ 4);
317 gen_goto_tb(dc
, 0, dc
->pc
+ (sign_extend(dc
->imm26
<< 2, 26)));
319 dc
->is_jmp
= DISAS_TB_JUMP
;
322 static inline void gen_compare(DisasContext
*dc
, int cond
)
324 int rX
= (dc
->format
== OP_FMT_RR
) ? dc
->r2
: dc
->r1
;
325 int rY
= (dc
->format
== OP_FMT_RR
) ? dc
->r0
: dc
->r0
;
326 int rZ
= (dc
->format
== OP_FMT_RR
) ? dc
->r1
: -1;
329 if (dc
->format
== OP_FMT_RI
) {
333 i
= zero_extend(dc
->imm16
, 16);
336 i
= sign_extend(dc
->imm16
, 16);
340 tcg_gen_setcondi_tl(cond
, cpu_R
[rX
], cpu_R
[rY
], i
);
342 tcg_gen_setcond_tl(cond
, cpu_R
[rX
], cpu_R
[rY
], cpu_R
[rZ
]);
346 static void dec_cmpe(DisasContext
*dc
)
348 if (dc
->format
== OP_FMT_RI
) {
349 LOG_DIS("cmpei r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
350 sign_extend(dc
->imm16
, 16));
352 LOG_DIS("cmpe r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
355 gen_compare(dc
, TCG_COND_EQ
);
358 static void dec_cmpg(DisasContext
*dc
)
360 if (dc
->format
== OP_FMT_RI
) {
361 LOG_DIS("cmpgi r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
362 sign_extend(dc
->imm16
, 16));
364 LOG_DIS("cmpg r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
367 gen_compare(dc
, TCG_COND_GT
);
370 static void dec_cmpge(DisasContext
*dc
)
372 if (dc
->format
== OP_FMT_RI
) {
373 LOG_DIS("cmpgei r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
374 sign_extend(dc
->imm16
, 16));
376 LOG_DIS("cmpge r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
379 gen_compare(dc
, TCG_COND_GE
);
382 static void dec_cmpgeu(DisasContext
*dc
)
384 if (dc
->format
== OP_FMT_RI
) {
385 LOG_DIS("cmpgeui r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
386 zero_extend(dc
->imm16
, 16));
388 LOG_DIS("cmpgeu r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
391 gen_compare(dc
, TCG_COND_GEU
);
394 static void dec_cmpgu(DisasContext
*dc
)
396 if (dc
->format
== OP_FMT_RI
) {
397 LOG_DIS("cmpgui r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
398 zero_extend(dc
->imm16
, 16));
400 LOG_DIS("cmpgu r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
403 gen_compare(dc
, TCG_COND_GTU
);
406 static void dec_cmpne(DisasContext
*dc
)
408 if (dc
->format
== OP_FMT_RI
) {
409 LOG_DIS("cmpnei r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
410 sign_extend(dc
->imm16
, 16));
412 LOG_DIS("cmpne r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
415 gen_compare(dc
, TCG_COND_NE
);
418 static void dec_divu(DisasContext
*dc
)
422 LOG_DIS("divu r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
424 if (!(dc
->env
->features
& LM32_FEATURE_DIVIDE
)) {
425 cpu_abort(dc
->env
, "hardware divider is not available\n");
428 l1
= gen_new_label();
429 tcg_gen_brcondi_tl(TCG_COND_NE
, cpu_R
[dc
->r1
], 0, l1
);
430 tcg_gen_movi_tl(cpu_pc
, dc
->pc
);
431 t_gen_raise_exception(dc
, EXCP_DIVIDE_BY_ZERO
);
433 tcg_gen_divu_tl(cpu_R
[dc
->r2
], cpu_R
[dc
->r0
], cpu_R
[dc
->r1
]);
436 static void dec_lb(DisasContext
*dc
)
440 LOG_DIS("lb r%d, (r%d+%d)\n", dc
->r1
, dc
->r0
, dc
->imm16
);
443 tcg_gen_addi_tl(t0
, cpu_R
[dc
->r0
], sign_extend(dc
->imm16
, 16));
444 tcg_gen_qemu_ld8s(cpu_R
[dc
->r1
], t0
, MEM_INDEX
);
448 static void dec_lbu(DisasContext
*dc
)
452 LOG_DIS("lbu r%d, (r%d+%d)\n", dc
->r1
, dc
->r0
, dc
->imm16
);
455 tcg_gen_addi_tl(t0
, cpu_R
[dc
->r0
], sign_extend(dc
->imm16
, 16));
456 tcg_gen_qemu_ld8u(cpu_R
[dc
->r1
], t0
, MEM_INDEX
);
460 static void dec_lh(DisasContext
*dc
)
464 LOG_DIS("lh r%d, (r%d+%d)\n", dc
->r1
, dc
->r0
, dc
->imm16
);
467 tcg_gen_addi_tl(t0
, cpu_R
[dc
->r0
], sign_extend(dc
->imm16
, 16));
468 tcg_gen_qemu_ld16s(cpu_R
[dc
->r1
], t0
, MEM_INDEX
);
472 static void dec_lhu(DisasContext
*dc
)
476 LOG_DIS("lhu r%d, (r%d+%d)\n", dc
->r1
, dc
->r0
, dc
->imm16
);
479 tcg_gen_addi_tl(t0
, cpu_R
[dc
->r0
], sign_extend(dc
->imm16
, 16));
480 tcg_gen_qemu_ld16u(cpu_R
[dc
->r1
], t0
, MEM_INDEX
);
484 static void dec_lw(DisasContext
*dc
)
488 LOG_DIS("lw r%d, (r%d+%d)\n", dc
->r1
, dc
->r0
, sign_extend(dc
->imm16
, 16));
491 tcg_gen_addi_tl(t0
, cpu_R
[dc
->r0
], sign_extend(dc
->imm16
, 16));
492 tcg_gen_qemu_ld32s(cpu_R
[dc
->r1
], t0
, MEM_INDEX
);
496 static void dec_modu(DisasContext
*dc
)
500 LOG_DIS("modu r%d, r%d, %d\n", dc
->r2
, dc
->r0
, dc
->r1
);
502 if (!(dc
->env
->features
& LM32_FEATURE_DIVIDE
)) {
503 cpu_abort(dc
->env
, "hardware divider is not available\n");
506 l1
= gen_new_label();
507 tcg_gen_brcondi_tl(TCG_COND_NE
, cpu_R
[dc
->r1
], 0, l1
);
508 tcg_gen_movi_tl(cpu_pc
, dc
->pc
);
509 t_gen_raise_exception(dc
, EXCP_DIVIDE_BY_ZERO
);
511 tcg_gen_remu_tl(cpu_R
[dc
->r2
], cpu_R
[dc
->r0
], cpu_R
[dc
->r1
]);
514 static void dec_mul(DisasContext
*dc
)
516 if (dc
->format
== OP_FMT_RI
) {
517 LOG_DIS("muli r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
518 sign_extend(dc
->imm16
, 16));
520 LOG_DIS("mul r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
523 if (!(dc
->env
->features
& LM32_FEATURE_MULTIPLY
)) {
524 cpu_abort(dc
->env
, "hardware multiplier is not available\n");
527 if (dc
->format
== OP_FMT_RI
) {
528 tcg_gen_muli_tl(cpu_R
[dc
->r1
], cpu_R
[dc
->r0
],
529 sign_extend(dc
->imm16
, 16));
531 tcg_gen_mul_tl(cpu_R
[dc
->r2
], cpu_R
[dc
->r0
], cpu_R
[dc
->r1
]);
535 static void dec_nor(DisasContext
*dc
)
537 if (dc
->format
== OP_FMT_RI
) {
538 LOG_DIS("nori r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
539 zero_extend(dc
->imm16
, 16));
541 LOG_DIS("nor r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
544 if (dc
->format
== OP_FMT_RI
) {
545 TCGv t0
= tcg_temp_new();
546 tcg_gen_movi_tl(t0
, zero_extend(dc
->imm16
, 16));
547 tcg_gen_nor_tl(cpu_R
[dc
->r1
], cpu_R
[dc
->r0
], t0
);
550 tcg_gen_nor_tl(cpu_R
[dc
->r2
], cpu_R
[dc
->r0
], cpu_R
[dc
->r1
]);
554 static void dec_or(DisasContext
*dc
)
556 if (dc
->format
== OP_FMT_RI
) {
557 LOG_DIS("ori r%d, r%d, %d\n", dc
->r1
, dc
->r0
,
558 zero_extend(dc
->imm16
, 16));
560 if (dc
->r1
== R_R0
) {
561 LOG_DIS("mv r%d, r%d\n", dc
->r2
, dc
->r0
);
563 LOG_DIS("or r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
567 if (dc
->format
== OP_FMT_RI
) {
568 tcg_gen_ori_tl(cpu_R
[dc
->r1
], cpu_R
[dc
->r0
],
569 zero_extend(dc
->imm16
, 16));
571 tcg_gen_or_tl(cpu_R
[dc
->r2
], cpu_R
[dc
->r0
], cpu_R
[dc
->r1
]);
575 static void dec_orhi(DisasContext
*dc
)
577 if (dc
->r0
== R_R0
) {
578 LOG_DIS("mvhi r%d, %d\n", dc
->r1
, dc
->imm16
);
580 LOG_DIS("orhi r%d, r%d, %d\n", dc
->r1
, dc
->r0
, dc
->imm16
);
583 tcg_gen_ori_tl(cpu_R
[dc
->r1
], cpu_R
[dc
->r0
], (dc
->imm16
<< 16));
586 static void dec_scall(DisasContext
*dc
)
590 } else if (dc
->imm5
== 2) {
593 cpu_abort(dc
->env
, "invalid opcode\n");
597 tcg_gen_movi_tl(cpu_pc
, dc
->pc
);
598 t_gen_raise_exception(dc
, EXCP_SYSTEMCALL
);
600 tcg_gen_movi_tl(cpu_pc
, dc
->pc
);
601 t_gen_raise_exception(dc
, EXCP_BREAKPOINT
);
605 static void dec_rcsr(DisasContext
*dc
)
607 LOG_DIS("rcsr r%d, %d\n", dc
->r2
, dc
->csr
);
611 tcg_gen_mov_tl(cpu_R
[dc
->r2
], cpu_ie
);
614 gen_helper_rcsr_im(cpu_R
[dc
->r2
], cpu_env
);
617 gen_helper_rcsr_ip(cpu_R
[dc
->r2
], cpu_env
);
620 tcg_gen_mov_tl(cpu_R
[dc
->r2
], cpu_cc
);
623 tcg_gen_mov_tl(cpu_R
[dc
->r2
], cpu_cfg
);
626 tcg_gen_mov_tl(cpu_R
[dc
->r2
], cpu_eba
);
629 tcg_gen_mov_tl(cpu_R
[dc
->r2
], cpu_dc
);
632 tcg_gen_mov_tl(cpu_R
[dc
->r2
], cpu_deba
);
635 gen_helper_rcsr_jtx(cpu_R
[dc
->r2
], cpu_env
);
638 gen_helper_rcsr_jrx(cpu_R
[dc
->r2
], cpu_env
);
650 cpu_abort(dc
->env
, "invalid read access csr=%x\n", dc
->csr
);
653 cpu_abort(dc
->env
, "read_csr: unknown csr=%x\n", dc
->csr
);
658 static void dec_sb(DisasContext
*dc
)
662 LOG_DIS("sb (r%d+%d), r%d\n", dc
->r0
, dc
->imm16
, dc
->r1
);
665 tcg_gen_addi_tl(t0
, cpu_R
[dc
->r0
], sign_extend(dc
->imm16
, 16));
666 tcg_gen_qemu_st8(cpu_R
[dc
->r1
], t0
, MEM_INDEX
);
670 static void dec_sextb(DisasContext
*dc
)
672 LOG_DIS("sextb r%d, r%d\n", dc
->r2
, dc
->r0
);
674 if (!(dc
->env
->features
& LM32_FEATURE_SIGN_EXTEND
)) {
675 cpu_abort(dc
->env
, "hardware sign extender is not available\n");
678 tcg_gen_ext8s_tl(cpu_R
[dc
->r2
], cpu_R
[dc
->r0
]);
681 static void dec_sexth(DisasContext
*dc
)
683 LOG_DIS("sexth r%d, r%d\n", dc
->r2
, dc
->r0
);
685 if (!(dc
->env
->features
& LM32_FEATURE_SIGN_EXTEND
)) {
686 cpu_abort(dc
->env
, "hardware sign extender is not available\n");
689 tcg_gen_ext16s_tl(cpu_R
[dc
->r2
], cpu_R
[dc
->r0
]);
692 static void dec_sh(DisasContext
*dc
)
696 LOG_DIS("sh (r%d+%d), r%d\n", dc
->r0
, dc
->imm16
, dc
->r1
);
699 tcg_gen_addi_tl(t0
, cpu_R
[dc
->r0
], sign_extend(dc
->imm16
, 16));
700 tcg_gen_qemu_st16(cpu_R
[dc
->r1
], t0
, MEM_INDEX
);
704 static void dec_sl(DisasContext
*dc
)
706 if (dc
->format
== OP_FMT_RI
) {
707 LOG_DIS("sli r%d, r%d, %d\n", dc
->r1
, dc
->r0
, dc
->imm5
);
709 LOG_DIS("sl r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
712 if (!(dc
->env
->features
& LM32_FEATURE_SHIFT
)) {
713 cpu_abort(dc
->env
, "hardware shifter is not available\n");
716 if (dc
->format
== OP_FMT_RI
) {
717 tcg_gen_shli_tl(cpu_R
[dc
->r1
], cpu_R
[dc
->r0
], dc
->imm5
);
719 TCGv t0
= tcg_temp_new();
720 tcg_gen_andi_tl(t0
, cpu_R
[dc
->r1
], 0x1f);
721 tcg_gen_shl_tl(cpu_R
[dc
->r2
], cpu_R
[dc
->r0
], t0
);
726 static void dec_sr(DisasContext
*dc
)
728 if (dc
->format
== OP_FMT_RI
) {
729 LOG_DIS("sri r%d, r%d, %d\n", dc
->r1
, dc
->r0
, dc
->imm5
);
731 LOG_DIS("sr r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
734 if (!(dc
->env
->features
& LM32_FEATURE_SHIFT
)) {
735 if (dc
->format
== OP_FMT_RI
) {
736 /* TODO: check r1 == 1 during runtime */
739 cpu_abort(dc
->env
, "hardware shifter is not available\n");
744 if (dc
->format
== OP_FMT_RI
) {
745 tcg_gen_sari_tl(cpu_R
[dc
->r1
], cpu_R
[dc
->r0
], dc
->imm5
);
747 TCGv t0
= tcg_temp_new();
748 tcg_gen_andi_tl(t0
, cpu_R
[dc
->r1
], 0x1f);
749 tcg_gen_sar_tl(cpu_R
[dc
->r2
], cpu_R
[dc
->r0
], t0
);
754 static void dec_sru(DisasContext
*dc
)
756 if (dc
->format
== OP_FMT_RI
) {
757 LOG_DIS("srui r%d, r%d, %d\n", dc
->r1
, dc
->r0
, dc
->imm5
);
759 LOG_DIS("sru r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
762 if (!(dc
->env
->features
& LM32_FEATURE_SHIFT
)) {
763 if (dc
->format
== OP_FMT_RI
) {
764 /* TODO: check r1 == 1 during runtime */
767 cpu_abort(dc
->env
, "hardware shifter is not available\n");
772 if (dc
->format
== OP_FMT_RI
) {
773 tcg_gen_shri_tl(cpu_R
[dc
->r1
], cpu_R
[dc
->r0
], dc
->imm5
);
775 TCGv t0
= tcg_temp_new();
776 tcg_gen_andi_tl(t0
, cpu_R
[dc
->r1
], 0x1f);
777 tcg_gen_shr_tl(cpu_R
[dc
->r2
], cpu_R
[dc
->r0
], t0
);
782 static void dec_sub(DisasContext
*dc
)
784 LOG_DIS("sub r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
786 tcg_gen_sub_tl(cpu_R
[dc
->r2
], cpu_R
[dc
->r0
], cpu_R
[dc
->r1
]);
789 static void dec_sw(DisasContext
*dc
)
793 LOG_DIS("sw (r%d+%d), r%d\n", dc
->r0
, sign_extend(dc
->imm16
, 16), dc
->r1
);
796 tcg_gen_addi_tl(t0
, cpu_R
[dc
->r0
], sign_extend(dc
->imm16
, 16));
797 tcg_gen_qemu_st32(cpu_R
[dc
->r1
], t0
, MEM_INDEX
);
801 static void dec_user(DisasContext
*dc
)
805 cpu_abort(dc
->env
, "user insn undefined\n");
808 static void dec_wcsr(DisasContext
*dc
)
812 LOG_DIS("wcsr r%d, %d\n", dc
->r1
, dc
->csr
);
816 tcg_gen_mov_tl(cpu_ie
, cpu_R
[dc
->r1
]);
817 tcg_gen_movi_tl(cpu_pc
, dc
->pc
+ 4);
818 dc
->is_jmp
= DISAS_UPDATE
;
821 /* mark as an io operation because it could cause an interrupt */
825 gen_helper_wcsr_im(cpu_env
, cpu_R
[dc
->r1
]);
826 tcg_gen_movi_tl(cpu_pc
, dc
->pc
+ 4);
830 dc
->is_jmp
= DISAS_UPDATE
;
833 /* mark as an io operation because it could cause an interrupt */
837 gen_helper_wcsr_ip(cpu_env
, cpu_R
[dc
->r1
]);
838 tcg_gen_movi_tl(cpu_pc
, dc
->pc
+ 4);
842 dc
->is_jmp
= DISAS_UPDATE
;
851 tcg_gen_mov_tl(cpu_eba
, cpu_R
[dc
->r1
]);
854 tcg_gen_mov_tl(cpu_deba
, cpu_R
[dc
->r1
]);
857 gen_helper_wcsr_jtx(cpu_env
, cpu_R
[dc
->r1
]);
860 gen_helper_wcsr_jrx(cpu_env
, cpu_R
[dc
->r1
]);
863 tcg_gen_mov_tl(cpu_dc
, cpu_R
[dc
->r1
]);
869 no
= dc
->csr
- CSR_BP0
;
870 if (dc
->env
->num_bps
<= no
) {
871 cpu_abort(dc
->env
, "breakpoint #%i is not available\n", no
);
873 tcg_gen_mov_tl(cpu_bp
[no
], cpu_R
[dc
->r1
]);
879 no
= dc
->csr
- CSR_WP0
;
880 if (dc
->env
->num_wps
<= no
) {
881 cpu_abort(dc
->env
, "watchpoint #%i is not available\n", no
);
883 tcg_gen_mov_tl(cpu_wp
[no
], cpu_R
[dc
->r1
]);
887 cpu_abort(dc
->env
, "invalid write access csr=%x\n", dc
->csr
);
890 cpu_abort(dc
->env
, "write_csr unknown csr=%x\n", dc
->csr
);
895 static void dec_xnor(DisasContext
*dc
)
897 if (dc
->format
== OP_FMT_RI
) {
898 LOG_DIS("xnori r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
899 zero_extend(dc
->imm16
, 16));
901 if (dc
->r1
== R_R0
) {
902 LOG_DIS("not r%d, r%d\n", dc
->r2
, dc
->r0
);
904 LOG_DIS("xnor r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
908 if (dc
->format
== OP_FMT_RI
) {
909 tcg_gen_xori_tl(cpu_R
[dc
->r1
], cpu_R
[dc
->r0
],
910 zero_extend(dc
->imm16
, 16));
911 tcg_gen_not_tl(cpu_R
[dc
->r1
], cpu_R
[dc
->r1
]);
913 tcg_gen_eqv_tl(cpu_R
[dc
->r2
], cpu_R
[dc
->r0
], cpu_R
[dc
->r1
]);
917 static void dec_xor(DisasContext
*dc
)
919 if (dc
->format
== OP_FMT_RI
) {
920 LOG_DIS("xori r%d, r%d, %d\n", dc
->r0
, dc
->r1
,
921 zero_extend(dc
->imm16
, 16));
923 LOG_DIS("xor r%d, r%d, r%d\n", dc
->r2
, dc
->r0
, dc
->r1
);
926 if (dc
->format
== OP_FMT_RI
) {
927 tcg_gen_xori_tl(cpu_R
[dc
->r1
], cpu_R
[dc
->r0
],
928 zero_extend(dc
->imm16
, 16));
930 tcg_gen_xor_tl(cpu_R
[dc
->r2
], cpu_R
[dc
->r0
], cpu_R
[dc
->r1
]);
934 static void dec_ill(DisasContext
*dc
)
936 cpu_abort(dc
->env
, "unknown opcode 0x%02x\n", dc
->opcode
);
939 typedef void (*DecoderInfo
)(DisasContext
*dc
);
940 static const DecoderInfo decinfo
[] = {
941 dec_sru
, dec_nor
, dec_mul
, dec_sh
, dec_lb
, dec_sr
, dec_xor
, dec_lh
,
942 dec_and
, dec_xnor
, dec_lw
, dec_lhu
, dec_sb
, dec_add
, dec_or
, dec_sl
,
943 dec_lbu
, dec_be
, dec_bg
, dec_bge
, dec_bgeu
, dec_bgu
, dec_sw
, dec_bne
,
944 dec_andhi
, dec_cmpe
, dec_cmpg
, dec_cmpge
, dec_cmpgeu
, dec_cmpgu
, dec_orhi
,
946 dec_sru
, dec_nor
, dec_mul
, dec_divu
, dec_rcsr
, dec_sr
, dec_xor
, dec_ill
,
947 dec_and
, dec_xnor
, dec_ill
, dec_scall
, dec_sextb
, dec_add
, dec_or
, dec_sl
,
948 dec_b
, dec_modu
, dec_sub
, dec_user
, dec_wcsr
, dec_ill
, dec_call
, dec_sexth
,
949 dec_bi
, dec_cmpe
, dec_cmpg
, dec_cmpge
, dec_cmpgeu
, dec_cmpgu
, dec_calli
,
953 static inline void decode(DisasContext
*dc
, uint32_t ir
)
955 if (unlikely(qemu_loglevel_mask(CPU_LOG_TB_OP
| CPU_LOG_TB_OP_OPT
))) {
956 tcg_gen_debug_insn_start(dc
->pc
);
960 LOG_DIS("%8.8x\t", dc
->ir
);
962 /* try guessing 'empty' instruction memory, although it may be a valid
963 * instruction sequence (eg. srui r0, r0, 0) */
967 LOG_DIS("nr_nops=%d\t", dc
->nr_nops
);
969 if (dc
->nr_nops
> 4) {
970 cpu_abort(dc
->env
, "fetching nop sequence\n");
974 dc
->opcode
= EXTRACT_FIELD(ir
, 26, 31);
976 dc
->imm5
= EXTRACT_FIELD(ir
, 0, 4);
977 dc
->imm16
= EXTRACT_FIELD(ir
, 0, 15);
978 dc
->imm26
= EXTRACT_FIELD(ir
, 0, 25);
980 dc
->csr
= EXTRACT_FIELD(ir
, 21, 25);
981 dc
->r0
= EXTRACT_FIELD(ir
, 21, 25);
982 dc
->r1
= EXTRACT_FIELD(ir
, 16, 20);
983 dc
->r2
= EXTRACT_FIELD(ir
, 11, 15);
985 /* bit 31 seems to indicate insn type. */
986 if (ir
& (1 << 31)) {
987 dc
->format
= OP_FMT_RR
;
989 dc
->format
= OP_FMT_RI
;
992 assert(ARRAY_SIZE(decinfo
) == 64);
993 assert(dc
->opcode
< 64);
995 decinfo
[dc
->opcode
](dc
);
998 static void check_breakpoint(CPULM32State
*env
, DisasContext
*dc
)
1002 if (unlikely(!QTAILQ_EMPTY(&env
->breakpoints
))) {
1003 QTAILQ_FOREACH(bp
, &env
->breakpoints
, entry
) {
1004 if (bp
->pc
== dc
->pc
) {
1005 tcg_gen_movi_tl(cpu_pc
, dc
->pc
);
1006 t_gen_raise_exception(dc
, EXCP_DEBUG
);
1007 dc
->is_jmp
= DISAS_UPDATE
;
1013 /* generate intermediate code for basic block 'tb'. */
1014 static void gen_intermediate_code_internal(CPULM32State
*env
,
1015 TranslationBlock
*tb
, int search_pc
)
1017 struct DisasContext ctx
, *dc
= &ctx
;
1018 uint16_t *gen_opc_end
;
1021 uint32_t next_page_start
;
1029 gen_opc_end
= tcg_ctx
.gen_opc_buf
+ OPC_MAX_SIZE
;
1031 dc
->is_jmp
= DISAS_NEXT
;
1033 dc
->singlestep_enabled
= env
->singlestep_enabled
;
1037 cpu_abort(env
, "LM32: unaligned PC=%x\n", pc_start
);
1040 next_page_start
= (pc_start
& TARGET_PAGE_MASK
) + TARGET_PAGE_SIZE
;
1043 max_insns
= tb
->cflags
& CF_COUNT_MASK
;
1044 if (max_insns
== 0) {
1045 max_insns
= CF_COUNT_MASK
;
1050 check_breakpoint(env
, dc
);
1053 j
= tcg_ctx
.gen_opc_ptr
- tcg_ctx
.gen_opc_buf
;
1057 tcg_ctx
.gen_opc_instr_start
[lj
++] = 0;
1060 tcg_ctx
.gen_opc_pc
[lj
] = dc
->pc
;
1061 tcg_ctx
.gen_opc_instr_start
[lj
] = 1;
1062 tcg_ctx
.gen_opc_icount
[lj
] = num_insns
;
1066 LOG_DIS("%8.8x:\t", dc
->pc
);
1068 if (num_insns
+ 1 == max_insns
&& (tb
->cflags
& CF_LAST_IO
)) {
1072 decode(dc
, cpu_ldl_code(env
, dc
->pc
));
1076 } while (!dc
->is_jmp
1077 && tcg_ctx
.gen_opc_ptr
< gen_opc_end
1078 && !env
->singlestep_enabled
1080 && (dc
->pc
< next_page_start
)
1081 && num_insns
< max_insns
);
1083 if (tb
->cflags
& CF_LAST_IO
) {
1087 if (unlikely(env
->singlestep_enabled
)) {
1088 if (dc
->is_jmp
== DISAS_NEXT
) {
1089 tcg_gen_movi_tl(cpu_pc
, dc
->pc
);
1091 t_gen_raise_exception(dc
, EXCP_DEBUG
);
1093 switch (dc
->is_jmp
) {
1095 gen_goto_tb(dc
, 1, dc
->pc
);
1100 /* indicate that the hash table must be used
1101 to find the next TB */
1105 /* nothing more to generate */
1110 gen_tb_end(tb
, num_insns
);
1111 *tcg_ctx
.gen_opc_ptr
= INDEX_op_end
;
1113 j
= tcg_ctx
.gen_opc_ptr
- tcg_ctx
.gen_opc_buf
;
1116 tcg_ctx
.gen_opc_instr_start
[lj
++] = 0;
1119 tb
->size
= dc
->pc
- pc_start
;
1120 tb
->icount
= num_insns
;
1124 if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM
)) {
1126 log_target_disas(env
, pc_start
, dc
->pc
- pc_start
, 0);
1127 qemu_log("\nisize=%d osize=%td\n",
1128 dc
->pc
- pc_start
, tcg_ctx
.gen_opc_ptr
-
1129 tcg_ctx
.gen_opc_buf
);
1134 void gen_intermediate_code(CPULM32State
*env
, struct TranslationBlock
*tb
)
1136 gen_intermediate_code_internal(env
, tb
, 0);
1139 void gen_intermediate_code_pc(CPULM32State
*env
, struct TranslationBlock
*tb
)
1141 gen_intermediate_code_internal(env
, tb
, 1);
1144 void cpu_dump_state(CPULM32State
*env
, FILE *f
, fprintf_function cpu_fprintf
,
1153 cpu_fprintf(f
, "IN: PC=%x %s\n",
1154 env
->pc
, lookup_symbol(env
->pc
));
1156 cpu_fprintf(f
, "ie=%8.8x (IE=%x EIE=%x BIE=%x) im=%8.8x ip=%8.8x\n",
1158 (env
->ie
& IE_IE
) ? 1 : 0,
1159 (env
->ie
& IE_EIE
) ? 1 : 0,
1160 (env
->ie
& IE_BIE
) ? 1 : 0,
1161 lm32_pic_get_im(env
->pic_state
),
1162 lm32_pic_get_ip(env
->pic_state
));
1163 cpu_fprintf(f
, "eba=%8.8x deba=%8.8x\n",
1167 for (i
= 0; i
< 32; i
++) {
1168 cpu_fprintf(f
, "r%2.2d=%8.8x ", i
, env
->regs
[i
]);
1169 if ((i
+ 1) % 4 == 0) {
1170 cpu_fprintf(f
, "\n");
1173 cpu_fprintf(f
, "\n\n");
1176 void restore_state_to_opc(CPULM32State
*env
, TranslationBlock
*tb
, int pc_pos
)
1178 env
->pc
= tcg_ctx
.gen_opc_pc
[pc_pos
];
1181 void lm32_translate_init(void)
1185 cpu_env
= tcg_global_reg_new_ptr(TCG_AREG0
, "env");
1187 for (i
= 0; i
< ARRAY_SIZE(cpu_R
); i
++) {
1188 cpu_R
[i
] = tcg_global_mem_new(TCG_AREG0
,
1189 offsetof(CPULM32State
, regs
[i
]),
1193 for (i
= 0; i
< ARRAY_SIZE(cpu_bp
); i
++) {
1194 cpu_bp
[i
] = tcg_global_mem_new(TCG_AREG0
,
1195 offsetof(CPULM32State
, bp
[i
]),
1199 for (i
= 0; i
< ARRAY_SIZE(cpu_wp
); i
++) {
1200 cpu_wp
[i
] = tcg_global_mem_new(TCG_AREG0
,
1201 offsetof(CPULM32State
, wp
[i
]),
1205 cpu_pc
= tcg_global_mem_new(TCG_AREG0
,
1206 offsetof(CPULM32State
, pc
),
1208 cpu_ie
= tcg_global_mem_new(TCG_AREG0
,
1209 offsetof(CPULM32State
, ie
),
1211 cpu_icc
= tcg_global_mem_new(TCG_AREG0
,
1212 offsetof(CPULM32State
, icc
),
1214 cpu_dcc
= tcg_global_mem_new(TCG_AREG0
,
1215 offsetof(CPULM32State
, dcc
),
1217 cpu_cc
= tcg_global_mem_new(TCG_AREG0
,
1218 offsetof(CPULM32State
, cc
),
1220 cpu_cfg
= tcg_global_mem_new(TCG_AREG0
,
1221 offsetof(CPULM32State
, cfg
),
1223 cpu_eba
= tcg_global_mem_new(TCG_AREG0
,
1224 offsetof(CPULM32State
, eba
),
1226 cpu_dc
= tcg_global_mem_new(TCG_AREG0
,
1227 offsetof(CPULM32State
, dc
),
1229 cpu_deba
= tcg_global_mem_new(TCG_AREG0
,
1230 offsetof(CPULM32State
, deba
),