2 * Xilinx MicroBlaze emulation for qemu: main translation routines.
4 * Copyright (c) 2009 Edgar E. Iglesias.
5 * Copyright (c) 2009-2012 PetaLogix Qld Pty Ltd.
7 * This library is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU Lesser General Public
9 * License as published by the Free Software Foundation; either
10 * version 2 of the License, or (at your option) any later version.
12 * This library is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * Lesser General Public License for more details.
17 * You should have received a copy of the GNU Lesser General Public
18 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
22 #include "disas/disas.h"
25 #include "microblaze-decode.h"
33 #if DISAS_MB && !SIM_COMPAT
34 # define LOG_DIS(...) qemu_log_mask(CPU_LOG_TB_IN_ASM, ## __VA_ARGS__)
36 # define LOG_DIS(...) do { } while (0)
41 #define EXTRACT_FIELD(src, start, end) \
42 (((src) >> start) & ((1 << (end - start + 1)) - 1))
44 static TCGv env_debug
;
45 static TCGv_ptr cpu_env
;
46 static TCGv cpu_R
[32];
47 static TCGv cpu_SR
[18];
49 static TCGv env_btaken
;
50 static TCGv env_btarget
;
51 static TCGv env_iflags
;
53 #include "exec/gen-icount.h"
55 /* This is the state at translation time. */
56 typedef struct DisasContext
{
67 unsigned int cpustate_changed
;
68 unsigned int delayed_branch
;
69 unsigned int tb_flags
, synced_flags
; /* tb dependent flags. */
70 unsigned int clear_imm
;
75 #define JMP_DIRECT_CC 2
76 #define JMP_INDIRECT 3
80 int abort_at_next_insn
;
82 struct TranslationBlock
*tb
;
83 int singlestep_enabled
;
86 static const char *regnames
[] =
88 "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7",
89 "r8", "r9", "r10", "r11", "r12", "r13", "r14", "r15",
90 "r16", "r17", "r18", "r19", "r20", "r21", "r22", "r23",
91 "r24", "r25", "r26", "r27", "r28", "r29", "r30", "r31",
94 static const char *special_regnames
[] =
96 "rpc", "rmsr", "sr2", "sr3", "sr4", "sr5", "sr6", "sr7",
97 "sr8", "sr9", "sr10", "sr11", "sr12", "sr13", "sr14", "sr15",
98 "sr16", "sr17", "sr18"
101 /* Sign extend at translation time. */
102 static inline int sign_extend(unsigned int val
, unsigned int width
)
114 static inline void t_sync_flags(DisasContext
*dc
)
116 /* Synch the tb dependent flags between translator and runtime. */
117 if (dc
->tb_flags
!= dc
->synced_flags
) {
118 tcg_gen_movi_tl(env_iflags
, dc
->tb_flags
);
119 dc
->synced_flags
= dc
->tb_flags
;
123 static inline void t_gen_raise_exception(DisasContext
*dc
, uint32_t index
)
125 TCGv_i32 tmp
= tcg_const_i32(index
);
128 tcg_gen_movi_tl(cpu_SR
[SR_PC
], dc
->pc
);
129 gen_helper_raise_exception(cpu_env
, tmp
);
130 tcg_temp_free_i32(tmp
);
131 dc
->is_jmp
= DISAS_UPDATE
;
134 static void gen_goto_tb(DisasContext
*dc
, int n
, target_ulong dest
)
136 TranslationBlock
*tb
;
138 if ((tb
->pc
& TARGET_PAGE_MASK
) == (dest
& TARGET_PAGE_MASK
)) {
140 tcg_gen_movi_tl(cpu_SR
[SR_PC
], dest
);
141 tcg_gen_exit_tb((tcg_target_long
)tb
+ n
);
143 tcg_gen_movi_tl(cpu_SR
[SR_PC
], dest
);
148 static void read_carry(DisasContext
*dc
, TCGv d
)
150 tcg_gen_shri_tl(d
, cpu_SR
[SR_MSR
], 31);
153 static void write_carry(DisasContext
*dc
, TCGv v
)
155 TCGv t0
= tcg_temp_new();
156 tcg_gen_shli_tl(t0
, v
, 31);
157 tcg_gen_sari_tl(t0
, t0
, 31);
158 tcg_gen_andi_tl(t0
, t0
, (MSR_C
| MSR_CC
));
159 tcg_gen_andi_tl(cpu_SR
[SR_MSR
], cpu_SR
[SR_MSR
],
161 tcg_gen_or_tl(cpu_SR
[SR_MSR
], cpu_SR
[SR_MSR
], t0
);
165 static void write_carryi(DisasContext
*dc
, int carry
)
167 TCGv t0
= tcg_temp_new();
168 tcg_gen_movi_tl(t0
, carry
? 1 : 0);
173 /* True if ALU operand b is a small immediate that may deserve
175 static inline int dec_alu_op_b_is_small_imm(DisasContext
*dc
)
177 /* Immediate insn without the imm prefix ? */
178 return dc
->type_b
&& !(dc
->tb_flags
& IMM_FLAG
);
181 static inline TCGv
*dec_alu_op_b(DisasContext
*dc
)
184 if (dc
->tb_flags
& IMM_FLAG
)
185 tcg_gen_ori_tl(env_imm
, env_imm
, dc
->imm
);
187 tcg_gen_movi_tl(env_imm
, (int32_t)((int16_t)dc
->imm
));
190 return &cpu_R
[dc
->rb
];
193 static void dec_add(DisasContext
*dc
)
201 LOG_DIS("add%s%s%s r%d r%d r%d\n",
202 dc
->type_b
? "i" : "", k
? "k" : "", c
? "c" : "",
203 dc
->rd
, dc
->ra
, dc
->rb
);
205 /* Take care of the easy cases first. */
207 /* k - keep carry, no need to update MSR. */
208 /* If rd == r0, it's a nop. */
210 tcg_gen_add_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], *(dec_alu_op_b(dc
)));
213 /* c - Add carry into the result. */
217 tcg_gen_add_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->rd
], cf
);
224 /* From now on, we can assume k is zero. So we need to update MSR. */
230 tcg_gen_movi_tl(cf
, 0);
234 TCGv ncf
= tcg_temp_new();
235 gen_helper_carry(ncf
, cpu_R
[dc
->ra
], *(dec_alu_op_b(dc
)), cf
);
236 tcg_gen_add_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], *(dec_alu_op_b(dc
)));
237 tcg_gen_add_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->rd
], cf
);
238 write_carry(dc
, ncf
);
241 gen_helper_carry(cf
, cpu_R
[dc
->ra
], *(dec_alu_op_b(dc
)), cf
);
247 static void dec_sub(DisasContext
*dc
)
249 unsigned int u
, cmp
, k
, c
;
255 cmp
= (dc
->imm
& 1) && (!dc
->type_b
) && k
;
258 LOG_DIS("cmp%s r%d, r%d ir=%x\n", u
? "u" : "", dc
->rd
, dc
->ra
, dc
->ir
);
261 gen_helper_cmpu(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], cpu_R
[dc
->rb
]);
263 gen_helper_cmp(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], cpu_R
[dc
->rb
]);
268 LOG_DIS("sub%s%s r%d, r%d r%d\n",
269 k
? "k" : "", c
? "c" : "", dc
->rd
, dc
->ra
, dc
->rb
);
271 /* Take care of the easy cases first. */
273 /* k - keep carry, no need to update MSR. */
274 /* If rd == r0, it's a nop. */
276 tcg_gen_sub_tl(cpu_R
[dc
->rd
], *(dec_alu_op_b(dc
)), cpu_R
[dc
->ra
]);
279 /* c - Add carry into the result. */
283 tcg_gen_add_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->rd
], cf
);
290 /* From now on, we can assume k is zero. So we need to update MSR. */
291 /* Extract carry. And complement a into na. */
297 tcg_gen_movi_tl(cf
, 1);
300 /* d = b + ~a + c. carry defaults to 1. */
301 tcg_gen_not_tl(na
, cpu_R
[dc
->ra
]);
304 TCGv ncf
= tcg_temp_new();
305 gen_helper_carry(ncf
, na
, *(dec_alu_op_b(dc
)), cf
);
306 tcg_gen_add_tl(cpu_R
[dc
->rd
], na
, *(dec_alu_op_b(dc
)));
307 tcg_gen_add_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->rd
], cf
);
308 write_carry(dc
, ncf
);
311 gen_helper_carry(cf
, na
, *(dec_alu_op_b(dc
)), cf
);
318 static void dec_pattern(DisasContext
*dc
)
323 if ((dc
->tb_flags
& MSR_EE_FLAG
)
324 && (dc
->env
->pvr
.regs
[2] & PVR2_ILL_OPCODE_EXC_MASK
)
325 && !((dc
->env
->pvr
.regs
[2] & PVR2_USE_PCMP_INSTR
))) {
326 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_ILLEGAL_OP
);
327 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
330 mode
= dc
->opcode
& 3;
334 LOG_DIS("pcmpbf r%d r%d r%d\n", dc
->rd
, dc
->ra
, dc
->rb
);
336 gen_helper_pcmpbf(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], cpu_R
[dc
->rb
]);
339 LOG_DIS("pcmpeq r%d r%d r%d\n", dc
->rd
, dc
->ra
, dc
->rb
);
341 TCGv t0
= tcg_temp_local_new();
342 l1
= gen_new_label();
343 tcg_gen_movi_tl(t0
, 1);
344 tcg_gen_brcond_tl(TCG_COND_EQ
,
345 cpu_R
[dc
->ra
], cpu_R
[dc
->rb
], l1
);
346 tcg_gen_movi_tl(t0
, 0);
348 tcg_gen_mov_tl(cpu_R
[dc
->rd
], t0
);
353 LOG_DIS("pcmpne r%d r%d r%d\n", dc
->rd
, dc
->ra
, dc
->rb
);
354 l1
= gen_new_label();
356 TCGv t0
= tcg_temp_local_new();
357 tcg_gen_movi_tl(t0
, 1);
358 tcg_gen_brcond_tl(TCG_COND_NE
,
359 cpu_R
[dc
->ra
], cpu_R
[dc
->rb
], l1
);
360 tcg_gen_movi_tl(t0
, 0);
362 tcg_gen_mov_tl(cpu_R
[dc
->rd
], t0
);
368 "unsupported pattern insn opcode=%x\n", dc
->opcode
);
373 static void dec_and(DisasContext
*dc
)
377 if (!dc
->type_b
&& (dc
->imm
& (1 << 10))) {
382 not = dc
->opcode
& (1 << 1);
383 LOG_DIS("and%s\n", not ? "n" : "");
389 TCGv t
= tcg_temp_new();
390 tcg_gen_not_tl(t
, *(dec_alu_op_b(dc
)));
391 tcg_gen_and_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], t
);
394 tcg_gen_and_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], *(dec_alu_op_b(dc
)));
397 static void dec_or(DisasContext
*dc
)
399 if (!dc
->type_b
&& (dc
->imm
& (1 << 10))) {
404 LOG_DIS("or r%d r%d r%d imm=%x\n", dc
->rd
, dc
->ra
, dc
->rb
, dc
->imm
);
406 tcg_gen_or_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], *(dec_alu_op_b(dc
)));
409 static void dec_xor(DisasContext
*dc
)
411 if (!dc
->type_b
&& (dc
->imm
& (1 << 10))) {
416 LOG_DIS("xor r%d\n", dc
->rd
);
418 tcg_gen_xor_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], *(dec_alu_op_b(dc
)));
421 static inline void msr_read(DisasContext
*dc
, TCGv d
)
423 tcg_gen_mov_tl(d
, cpu_SR
[SR_MSR
]);
426 static inline void msr_write(DisasContext
*dc
, TCGv v
)
431 dc
->cpustate_changed
= 1;
432 /* PVR bit is not writable. */
433 tcg_gen_andi_tl(t
, v
, ~MSR_PVR
);
434 tcg_gen_andi_tl(cpu_SR
[SR_MSR
], cpu_SR
[SR_MSR
], MSR_PVR
);
435 tcg_gen_or_tl(cpu_SR
[SR_MSR
], cpu_SR
[SR_MSR
], v
);
439 static void dec_msr(DisasContext
*dc
)
442 unsigned int sr
, to
, rn
;
443 int mem_index
= cpu_mmu_index(dc
->env
);
445 sr
= dc
->imm
& ((1 << 14) - 1);
446 to
= dc
->imm
& (1 << 14);
449 dc
->cpustate_changed
= 1;
451 /* msrclr and msrset. */
452 if (!(dc
->imm
& (1 << 15))) {
453 unsigned int clr
= dc
->ir
& (1 << 16);
455 LOG_DIS("msr%s r%d imm=%x\n", clr
? "clr" : "set",
458 if (!(dc
->env
->pvr
.regs
[2] & PVR2_USE_MSR_INSTR
)) {
463 if ((dc
->tb_flags
& MSR_EE_FLAG
)
464 && mem_index
== MMU_USER_IDX
&& (dc
->imm
!= 4 && dc
->imm
!= 0)) {
465 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_PRIVINSN
);
466 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
471 msr_read(dc
, cpu_R
[dc
->rd
]);
476 tcg_gen_mov_tl(t1
, *(dec_alu_op_b(dc
)));
479 tcg_gen_not_tl(t1
, t1
);
480 tcg_gen_and_tl(t0
, t0
, t1
);
482 tcg_gen_or_tl(t0
, t0
, t1
);
486 tcg_gen_movi_tl(cpu_SR
[SR_PC
], dc
->pc
+ 4);
487 dc
->is_jmp
= DISAS_UPDATE
;
492 if ((dc
->tb_flags
& MSR_EE_FLAG
)
493 && mem_index
== MMU_USER_IDX
) {
494 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_PRIVINSN
);
495 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
500 #if !defined(CONFIG_USER_ONLY)
501 /* Catch read/writes to the mmu block. */
502 if ((sr
& ~0xff) == 0x1000) {
504 LOG_DIS("m%ss sr%d r%d imm=%x\n", to
? "t" : "f", sr
, dc
->ra
, dc
->imm
);
506 gen_helper_mmu_write(cpu_env
, tcg_const_tl(sr
), cpu_R
[dc
->ra
]);
508 gen_helper_mmu_read(cpu_R
[dc
->rd
], cpu_env
, tcg_const_tl(sr
));
514 LOG_DIS("m%ss sr%x r%d imm=%x\n", to
? "t" : "f", sr
, dc
->ra
, dc
->imm
);
519 msr_write(dc
, cpu_R
[dc
->ra
]);
522 tcg_gen_mov_tl(cpu_SR
[SR_EAR
], cpu_R
[dc
->ra
]);
525 tcg_gen_mov_tl(cpu_SR
[SR_ESR
], cpu_R
[dc
->ra
]);
528 tcg_gen_andi_tl(cpu_SR
[SR_FSR
], cpu_R
[dc
->ra
], 31);
531 tcg_gen_st_tl(cpu_R
[dc
->ra
], cpu_env
, offsetof(CPUMBState
, slr
));
534 tcg_gen_st_tl(cpu_R
[dc
->ra
], cpu_env
, offsetof(CPUMBState
, shr
));
537 cpu_abort(dc
->env
, "unknown mts reg %x\n", sr
);
541 LOG_DIS("m%ss r%d sr%x imm=%x\n", to
? "t" : "f", dc
->rd
, sr
, dc
->imm
);
545 tcg_gen_movi_tl(cpu_R
[dc
->rd
], dc
->pc
);
548 msr_read(dc
, cpu_R
[dc
->rd
]);
551 tcg_gen_mov_tl(cpu_R
[dc
->rd
], cpu_SR
[SR_EAR
]);
554 tcg_gen_mov_tl(cpu_R
[dc
->rd
], cpu_SR
[SR_ESR
]);
557 tcg_gen_mov_tl(cpu_R
[dc
->rd
], cpu_SR
[SR_FSR
]);
560 tcg_gen_mov_tl(cpu_R
[dc
->rd
], cpu_SR
[SR_BTR
]);
563 tcg_gen_ld_tl(cpu_R
[dc
->rd
], cpu_env
, offsetof(CPUMBState
, slr
));
566 tcg_gen_ld_tl(cpu_R
[dc
->rd
], cpu_env
, offsetof(CPUMBState
, shr
));
582 tcg_gen_ld_tl(cpu_R
[dc
->rd
],
583 cpu_env
, offsetof(CPUMBState
, pvr
.regs
[rn
]));
586 cpu_abort(dc
->env
, "unknown mfs reg %x\n", sr
);
592 tcg_gen_movi_tl(cpu_R
[0], 0);
596 /* 64-bit signed mul, lower result in d and upper in d2. */
597 static void t_gen_muls(TCGv d
, TCGv d2
, TCGv a
, TCGv b
)
601 t0
= tcg_temp_new_i64();
602 t1
= tcg_temp_new_i64();
604 tcg_gen_ext_i32_i64(t0
, a
);
605 tcg_gen_ext_i32_i64(t1
, b
);
606 tcg_gen_mul_i64(t0
, t0
, t1
);
608 tcg_gen_trunc_i64_i32(d
, t0
);
609 tcg_gen_shri_i64(t0
, t0
, 32);
610 tcg_gen_trunc_i64_i32(d2
, t0
);
612 tcg_temp_free_i64(t0
);
613 tcg_temp_free_i64(t1
);
616 /* 64-bit unsigned muls, lower result in d and upper in d2. */
617 static void t_gen_mulu(TCGv d
, TCGv d2
, TCGv a
, TCGv b
)
621 t0
= tcg_temp_new_i64();
622 t1
= tcg_temp_new_i64();
624 tcg_gen_extu_i32_i64(t0
, a
);
625 tcg_gen_extu_i32_i64(t1
, b
);
626 tcg_gen_mul_i64(t0
, t0
, t1
);
628 tcg_gen_trunc_i64_i32(d
, t0
);
629 tcg_gen_shri_i64(t0
, t0
, 32);
630 tcg_gen_trunc_i64_i32(d2
, t0
);
632 tcg_temp_free_i64(t0
);
633 tcg_temp_free_i64(t1
);
636 /* Multiplier unit. */
637 static void dec_mul(DisasContext
*dc
)
640 unsigned int subcode
;
642 if ((dc
->tb_flags
& MSR_EE_FLAG
)
643 && (dc
->env
->pvr
.regs
[2] & PVR2_ILL_OPCODE_EXC_MASK
)
644 && !(dc
->env
->pvr
.regs
[0] & PVR0_USE_HW_MUL_MASK
)) {
645 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_ILLEGAL_OP
);
646 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
650 subcode
= dc
->imm
& 3;
651 d
[0] = tcg_temp_new();
652 d
[1] = tcg_temp_new();
655 LOG_DIS("muli r%d r%d %x\n", dc
->rd
, dc
->ra
, dc
->imm
);
656 t_gen_mulu(cpu_R
[dc
->rd
], d
[1], cpu_R
[dc
->ra
], *(dec_alu_op_b(dc
)));
660 /* mulh, mulhsu and mulhu are not available if C_USE_HW_MUL is < 2. */
661 if (subcode
>= 1 && subcode
<= 3
662 && !((dc
->env
->pvr
.regs
[2] & PVR2_USE_MUL64_MASK
))) {
668 LOG_DIS("mul r%d r%d r%d\n", dc
->rd
, dc
->ra
, dc
->rb
);
669 t_gen_mulu(cpu_R
[dc
->rd
], d
[1], cpu_R
[dc
->ra
], cpu_R
[dc
->rb
]);
672 LOG_DIS("mulh r%d r%d r%d\n", dc
->rd
, dc
->ra
, dc
->rb
);
673 t_gen_muls(d
[0], cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], cpu_R
[dc
->rb
]);
676 LOG_DIS("mulhsu r%d r%d r%d\n", dc
->rd
, dc
->ra
, dc
->rb
);
677 t_gen_muls(d
[0], cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], cpu_R
[dc
->rb
]);
680 LOG_DIS("mulhu r%d r%d r%d\n", dc
->rd
, dc
->ra
, dc
->rb
);
681 t_gen_mulu(d
[0], cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], cpu_R
[dc
->rb
]);
684 cpu_abort(dc
->env
, "unknown MUL insn %x\n", subcode
);
693 static void dec_div(DisasContext
*dc
)
700 if ((dc
->env
->pvr
.regs
[2] & PVR2_ILL_OPCODE_EXC_MASK
)
701 && !((dc
->env
->pvr
.regs
[0] & PVR0_USE_DIV_MASK
))) {
702 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_ILLEGAL_OP
);
703 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
707 gen_helper_divu(cpu_R
[dc
->rd
], cpu_env
, *(dec_alu_op_b(dc
)),
710 gen_helper_divs(cpu_R
[dc
->rd
], cpu_env
, *(dec_alu_op_b(dc
)),
713 tcg_gen_movi_tl(cpu_R
[dc
->rd
], 0);
716 static void dec_barrel(DisasContext
*dc
)
721 if ((dc
->tb_flags
& MSR_EE_FLAG
)
722 && (dc
->env
->pvr
.regs
[2] & PVR2_ILL_OPCODE_EXC_MASK
)
723 && !(dc
->env
->pvr
.regs
[0] & PVR0_USE_BARREL_MASK
)) {
724 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_ILLEGAL_OP
);
725 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
729 s
= dc
->imm
& (1 << 10);
730 t
= dc
->imm
& (1 << 9);
732 LOG_DIS("bs%s%s r%d r%d r%d\n",
733 s
? "l" : "r", t
? "a" : "l", dc
->rd
, dc
->ra
, dc
->rb
);
737 tcg_gen_mov_tl(t0
, *(dec_alu_op_b(dc
)));
738 tcg_gen_andi_tl(t0
, t0
, 31);
741 tcg_gen_shl_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], t0
);
744 tcg_gen_sar_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], t0
);
746 tcg_gen_shr_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], t0
);
750 static void dec_bit(DisasContext
*dc
)
754 int mem_index
= cpu_mmu_index(dc
->env
);
756 op
= dc
->ir
& ((1 << 9) - 1);
762 LOG_DIS("src r%d r%d\n", dc
->rd
, dc
->ra
);
763 tcg_gen_andi_tl(t0
, cpu_R
[dc
->ra
], 1);
767 tcg_gen_shli_tl(t1
, t1
, 31);
769 tcg_gen_shri_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], 1);
770 tcg_gen_or_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->rd
], t1
);
783 LOG_DIS("srl r%d r%d\n", dc
->rd
, dc
->ra
);
786 tcg_gen_andi_tl(t0
, cpu_R
[dc
->ra
], 1);
791 tcg_gen_shri_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], 1);
793 tcg_gen_sari_tl(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], 1);
797 LOG_DIS("ext8s r%d r%d\n", dc
->rd
, dc
->ra
);
798 tcg_gen_ext8s_i32(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
]);
801 LOG_DIS("ext16s r%d r%d\n", dc
->rd
, dc
->ra
);
802 tcg_gen_ext16s_i32(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
]);
809 LOG_DIS("wdc r%d\n", dc
->ra
);
810 if ((dc
->tb_flags
& MSR_EE_FLAG
)
811 && mem_index
== MMU_USER_IDX
) {
812 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_PRIVINSN
);
813 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
819 LOG_DIS("wic r%d\n", dc
->ra
);
820 if ((dc
->tb_flags
& MSR_EE_FLAG
)
821 && mem_index
== MMU_USER_IDX
) {
822 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_PRIVINSN
);
823 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
828 if ((dc
->tb_flags
& MSR_EE_FLAG
)
829 && (dc
->env
->pvr
.regs
[2] & PVR2_ILL_OPCODE_EXC_MASK
)
830 && !((dc
->env
->pvr
.regs
[2] & PVR2_USE_PCMP_INSTR
))) {
831 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_ILLEGAL_OP
);
832 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
834 if (dc
->env
->pvr
.regs
[2] & PVR2_USE_PCMP_INSTR
) {
835 gen_helper_clz(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
]);
840 LOG_DIS("swapb r%d r%d\n", dc
->rd
, dc
->ra
);
841 tcg_gen_bswap32_i32(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
]);
845 LOG_DIS("swaph r%d r%d\n", dc
->rd
, dc
->ra
);
846 tcg_gen_rotri_i32(cpu_R
[dc
->rd
], cpu_R
[dc
->ra
], 16);
849 cpu_abort(dc
->env
, "unknown bit oc=%x op=%x rd=%d ra=%d rb=%d\n",
850 dc
->pc
, op
, dc
->rd
, dc
->ra
, dc
->rb
);
855 static inline void sync_jmpstate(DisasContext
*dc
)
857 if (dc
->jmp
== JMP_DIRECT
|| dc
->jmp
== JMP_DIRECT_CC
) {
858 if (dc
->jmp
== JMP_DIRECT
) {
859 tcg_gen_movi_tl(env_btaken
, 1);
861 dc
->jmp
= JMP_INDIRECT
;
862 tcg_gen_movi_tl(env_btarget
, dc
->jmp_pc
);
866 static void dec_imm(DisasContext
*dc
)
868 LOG_DIS("imm %x\n", dc
->imm
<< 16);
869 tcg_gen_movi_tl(env_imm
, (dc
->imm
<< 16));
870 dc
->tb_flags
|= IMM_FLAG
;
874 static inline void gen_load(DisasContext
*dc
, TCGv dst
, TCGv addr
,
877 int mem_index
= cpu_mmu_index(dc
->env
);
880 tcg_gen_qemu_ld8u(dst
, addr
, mem_index
);
881 } else if (size
== 2) {
882 tcg_gen_qemu_ld16u(dst
, addr
, mem_index
);
883 } else if (size
== 4) {
884 tcg_gen_qemu_ld32u(dst
, addr
, mem_index
);
886 cpu_abort(dc
->env
, "Incorrect load size %d\n", size
);
889 static inline TCGv
*compute_ldst_addr(DisasContext
*dc
, TCGv
*t
)
891 unsigned int extimm
= dc
->tb_flags
& IMM_FLAG
;
892 /* Should be set to one if r1 is used by loadstores. */
895 /* All load/stores use ra. */
900 /* Treat the common cases first. */
902 /* If any of the regs is r0, return a ptr to the other. */
904 return &cpu_R
[dc
->rb
];
905 } else if (dc
->rb
== 0) {
906 return &cpu_R
[dc
->ra
];
914 tcg_gen_add_tl(*t
, cpu_R
[dc
->ra
], cpu_R
[dc
->rb
]);
917 gen_helper_stackprot(cpu_env
, *t
);
924 return &cpu_R
[dc
->ra
];
927 tcg_gen_movi_tl(*t
, (int32_t)((int16_t)dc
->imm
));
928 tcg_gen_add_tl(*t
, cpu_R
[dc
->ra
], *t
);
931 tcg_gen_add_tl(*t
, cpu_R
[dc
->ra
], *(dec_alu_op_b(dc
)));
935 gen_helper_stackprot(cpu_env
, *t
);
940 static inline void dec_byteswap(DisasContext
*dc
, TCGv dst
, TCGv src
, int size
)
943 tcg_gen_bswap32_tl(dst
, src
);
944 } else if (size
== 2) {
945 TCGv t
= tcg_temp_new();
947 /* bswap16 assumes the high bits are zero. */
948 tcg_gen_andi_tl(t
, src
, 0xffff);
949 tcg_gen_bswap16_tl(dst
, t
);
953 cpu_abort(dc->env, "Invalid ldst byteswap size %d\n", size);
958 static void dec_load(DisasContext
*dc
)
961 unsigned int size
, rev
= 0, ex
= 0;
963 size
= 1 << (dc
->opcode
& 3);
966 rev
= (dc
->ir
>> 9) & 1;
967 ex
= (dc
->ir
>> 10) & 1;
970 if (size
> 4 && (dc
->tb_flags
& MSR_EE_FLAG
)
971 && (dc
->env
->pvr
.regs
[2] & PVR2_ILL_OPCODE_EXC_MASK
)) {
972 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_ILLEGAL_OP
);
973 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
977 LOG_DIS("l%d%s%s%s\n", size
, dc
->type_b
? "i" : "", rev
? "r" : "",
981 addr
= compute_ldst_addr(dc
, &t
);
984 * When doing reverse accesses we need to do two things.
986 * 1. Reverse the address wrt endianness.
987 * 2. Byteswap the data lanes on the way back into the CPU core.
989 if (rev
&& size
!= 4) {
990 /* Endian reverse the address. t is addr. */
998 TCGv low
= tcg_temp_new();
1000 /* Force addr into the temp. */
1003 tcg_gen_mov_tl(t
, *addr
);
1007 tcg_gen_andi_tl(low
, t
, 3);
1008 tcg_gen_sub_tl(low
, tcg_const_tl(3), low
);
1009 tcg_gen_andi_tl(t
, t
, ~3);
1010 tcg_gen_or_tl(t
, t
, low
);
1011 tcg_gen_mov_tl(env_imm
, t
);
1019 /* Force addr into the temp. */
1022 tcg_gen_xori_tl(t
, *addr
, 2);
1025 tcg_gen_xori_tl(t
, t
, 2);
1029 cpu_abort(dc
->env
, "Invalid reverse size\n");
1034 /* lwx does not throw unaligned access errors, so force alignment */
1036 /* Force addr into the temp. */
1039 tcg_gen_mov_tl(t
, *addr
);
1042 tcg_gen_andi_tl(t
, t
, ~3);
1045 /* If we get a fault on a dslot, the jmpstate better be in sync. */
1048 /* Verify alignment if needed. */
1049 if ((dc
->env
->pvr
.regs
[2] & PVR2_UNALIGNED_EXC_MASK
) && size
> 1) {
1050 TCGv v
= tcg_temp_new();
1053 * Microblaze gives MMU faults priority over faults due to
1054 * unaligned addresses. That's why we speculatively do the load
1055 * into v. If the load succeeds, we verify alignment of the
1056 * address and if that succeeds we write into the destination reg.
1058 gen_load(dc
, v
, *addr
, size
);
1060 tcg_gen_movi_tl(cpu_SR
[SR_PC
], dc
->pc
);
1061 gen_helper_memalign(cpu_env
, *addr
, tcg_const_tl(dc
->rd
),
1062 tcg_const_tl(0), tcg_const_tl(size
- 1));
1065 dec_byteswap(dc
, cpu_R
[dc
->rd
], v
, size
);
1067 tcg_gen_mov_tl(cpu_R
[dc
->rd
], v
);
1073 gen_load(dc
, cpu_R
[dc
->rd
], *addr
, size
);
1075 dec_byteswap(dc
, cpu_R
[dc
->rd
], cpu_R
[dc
->rd
], size
);
1078 /* We are loading into r0, no need to reverse. */
1079 gen_load(dc
, env_imm
, *addr
, size
);
1084 /* no support for for AXI exclusive so always clear C */
1085 write_carryi(dc
, 0);
1086 tcg_gen_st_tl(*addr
, cpu_env
, offsetof(CPUMBState
, res_addr
));
1093 static void gen_store(DisasContext
*dc
, TCGv addr
, TCGv val
,
1096 int mem_index
= cpu_mmu_index(dc
->env
);
1099 tcg_gen_qemu_st8(val
, addr
, mem_index
);
1100 else if (size
== 2) {
1101 tcg_gen_qemu_st16(val
, addr
, mem_index
);
1102 } else if (size
== 4) {
1103 tcg_gen_qemu_st32(val
, addr
, mem_index
);
1105 cpu_abort(dc
->env
, "Incorrect store size %d\n", size
);
1108 static void dec_store(DisasContext
*dc
)
1110 TCGv t
, *addr
, swx_addr
, r_check
;
1112 unsigned int size
, rev
= 0, ex
= 0;
1114 size
= 1 << (dc
->opcode
& 3);
1116 rev
= (dc
->ir
>> 9) & 1;
1117 ex
= (dc
->ir
>> 10) & 1;
1120 if (size
> 4 && (dc
->tb_flags
& MSR_EE_FLAG
)
1121 && (dc
->env
->pvr
.regs
[2] & PVR2_ILL_OPCODE_EXC_MASK
)) {
1122 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_ILLEGAL_OP
);
1123 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
1127 LOG_DIS("s%d%s%s%s\n", size
, dc
->type_b
? "i" : "", rev
? "r" : "",
1130 /* If we get a fault on a dslot, the jmpstate better be in sync. */
1132 addr
= compute_ldst_addr(dc
, &t
);
1134 r_check
= tcg_temp_new();
1135 swx_addr
= tcg_temp_local_new();
1138 /* Force addr into the swx_addr. */
1139 tcg_gen_mov_tl(swx_addr
, *addr
);
1141 /* swx does not throw unaligned access errors, so force alignment */
1142 tcg_gen_andi_tl(swx_addr
, swx_addr
, ~3);
1144 tcg_gen_ld_tl(r_check
, cpu_env
, offsetof(CPUMBState
, res_addr
));
1145 write_carryi(dc
, 1);
1146 swx_skip
= gen_new_label();
1147 tcg_gen_brcond_tl(TCG_COND_NE
, r_check
, swx_addr
, swx_skip
);
1148 write_carryi(dc
, 0);
1151 if (rev
&& size
!= 4) {
1152 /* Endian reverse the address. t is addr. */
1160 TCGv low
= tcg_temp_new();
1162 /* Force addr into the temp. */
1165 tcg_gen_mov_tl(t
, *addr
);
1169 tcg_gen_andi_tl(low
, t
, 3);
1170 tcg_gen_sub_tl(low
, tcg_const_tl(3), low
);
1171 tcg_gen_andi_tl(t
, t
, ~3);
1172 tcg_gen_or_tl(t
, t
, low
);
1173 tcg_gen_mov_tl(env_imm
, t
);
1181 /* Force addr into the temp. */
1184 tcg_gen_xori_tl(t
, *addr
, 2);
1187 tcg_gen_xori_tl(t
, t
, 2);
1191 cpu_abort(dc
->env
, "Invalid reverse size\n");
1196 TCGv bs_data
= tcg_temp_new();
1197 dec_byteswap(dc
, bs_data
, cpu_R
[dc
->rd
], size
);
1198 gen_store(dc
, *addr
, bs_data
, size
);
1199 tcg_temp_free(bs_data
);
1201 gen_store(dc
, *addr
, cpu_R
[dc
->rd
], size
);
1205 TCGv bs_data
= tcg_temp_new();
1206 dec_byteswap(dc
, bs_data
, cpu_R
[dc
->rd
], size
);
1207 gen_store(dc
, *addr
, bs_data
, size
);
1208 tcg_temp_free(bs_data
);
1210 gen_store(dc
, *addr
, cpu_R
[dc
->rd
], size
);
1214 /* Verify alignment if needed. */
1215 if ((dc
->env
->pvr
.regs
[2] & PVR2_UNALIGNED_EXC_MASK
) && size
> 1) {
1216 tcg_gen_movi_tl(cpu_SR
[SR_PC
], dc
->pc
);
1217 /* FIXME: if the alignment is wrong, we should restore the value
1218 * in memory. One possible way to achieve this is to probe
1219 * the MMU prior to the memaccess, thay way we could put
1220 * the alignment checks in between the probe and the mem
1223 gen_helper_memalign(cpu_env
, *addr
, tcg_const_tl(dc
->rd
),
1224 tcg_const_tl(1), tcg_const_tl(size
- 1));
1228 gen_set_label(swx_skip
);
1230 tcg_temp_free(r_check
);
1231 tcg_temp_free(swx_addr
);
1237 static inline void eval_cc(DisasContext
*dc
, unsigned int cc
,
1238 TCGv d
, TCGv a
, TCGv b
)
1242 tcg_gen_setcond_tl(TCG_COND_EQ
, d
, a
, b
);
1245 tcg_gen_setcond_tl(TCG_COND_NE
, d
, a
, b
);
1248 tcg_gen_setcond_tl(TCG_COND_LT
, d
, a
, b
);
1251 tcg_gen_setcond_tl(TCG_COND_LE
, d
, a
, b
);
1254 tcg_gen_setcond_tl(TCG_COND_GE
, d
, a
, b
);
1257 tcg_gen_setcond_tl(TCG_COND_GT
, d
, a
, b
);
1260 cpu_abort(dc
->env
, "Unknown condition code %x.\n", cc
);
1265 static void eval_cond_jmp(DisasContext
*dc
, TCGv pc_true
, TCGv pc_false
)
1269 l1
= gen_new_label();
1270 /* Conditional jmp. */
1271 tcg_gen_mov_tl(cpu_SR
[SR_PC
], pc_false
);
1272 tcg_gen_brcondi_tl(TCG_COND_EQ
, env_btaken
, 0, l1
);
1273 tcg_gen_mov_tl(cpu_SR
[SR_PC
], pc_true
);
1277 static void dec_bcc(DisasContext
*dc
)
1282 cc
= EXTRACT_FIELD(dc
->ir
, 21, 23);
1283 dslot
= dc
->ir
& (1 << 25);
1284 LOG_DIS("bcc%s r%d %x\n", dslot
? "d" : "", dc
->ra
, dc
->imm
);
1286 dc
->delayed_branch
= 1;
1288 dc
->delayed_branch
= 2;
1289 dc
->tb_flags
|= D_FLAG
;
1290 tcg_gen_st_tl(tcg_const_tl(dc
->type_b
&& (dc
->tb_flags
& IMM_FLAG
)),
1291 cpu_env
, offsetof(CPUMBState
, bimm
));
1294 if (dec_alu_op_b_is_small_imm(dc
)) {
1295 int32_t offset
= (int32_t)((int16_t)dc
->imm
); /* sign-extend. */
1297 tcg_gen_movi_tl(env_btarget
, dc
->pc
+ offset
);
1298 dc
->jmp
= JMP_DIRECT_CC
;
1299 dc
->jmp_pc
= dc
->pc
+ offset
;
1301 dc
->jmp
= JMP_INDIRECT
;
1302 tcg_gen_movi_tl(env_btarget
, dc
->pc
);
1303 tcg_gen_add_tl(env_btarget
, env_btarget
, *(dec_alu_op_b(dc
)));
1305 eval_cc(dc
, cc
, env_btaken
, cpu_R
[dc
->ra
], tcg_const_tl(0));
1308 static void dec_br(DisasContext
*dc
)
1310 unsigned int dslot
, link
, abs
, mbar
;
1311 int mem_index
= cpu_mmu_index(dc
->env
);
1313 dslot
= dc
->ir
& (1 << 20);
1314 abs
= dc
->ir
& (1 << 19);
1315 link
= dc
->ir
& (1 << 18);
1317 /* Memory barrier. */
1318 mbar
= (dc
->ir
>> 16) & 31;
1319 if (mbar
== 2 && dc
->imm
== 4) {
1320 /* mbar IMM & 16 decodes to sleep. */
1322 TCGv_i32 tmp_hlt
= tcg_const_i32(EXCP_HLT
);
1323 TCGv_i32 tmp_1
= tcg_const_i32(1);
1328 tcg_gen_st_i32(tmp_1
, cpu_env
,
1329 -offsetof(MicroBlazeCPU
, env
)
1330 +offsetof(CPUState
, halted
));
1331 tcg_gen_movi_tl(cpu_SR
[SR_PC
], dc
->pc
+ 4);
1332 gen_helper_raise_exception(cpu_env
, tmp_hlt
);
1333 tcg_temp_free_i32(tmp_hlt
);
1334 tcg_temp_free_i32(tmp_1
);
1337 LOG_DIS("mbar %d\n", dc
->rd
);
1339 dc
->cpustate_changed
= 1;
1343 LOG_DIS("br%s%s%s%s imm=%x\n",
1344 abs
? "a" : "", link
? "l" : "",
1345 dc
->type_b
? "i" : "", dslot
? "d" : "",
1348 dc
->delayed_branch
= 1;
1350 dc
->delayed_branch
= 2;
1351 dc
->tb_flags
|= D_FLAG
;
1352 tcg_gen_st_tl(tcg_const_tl(dc
->type_b
&& (dc
->tb_flags
& IMM_FLAG
)),
1353 cpu_env
, offsetof(CPUMBState
, bimm
));
1356 tcg_gen_movi_tl(cpu_R
[dc
->rd
], dc
->pc
);
1358 dc
->jmp
= JMP_INDIRECT
;
1360 tcg_gen_movi_tl(env_btaken
, 1);
1361 tcg_gen_mov_tl(env_btarget
, *(dec_alu_op_b(dc
)));
1362 if (link
&& !dslot
) {
1363 if (!(dc
->tb_flags
& IMM_FLAG
) && (dc
->imm
== 8 || dc
->imm
== 0x18))
1364 t_gen_raise_exception(dc
, EXCP_BREAK
);
1366 if ((dc
->tb_flags
& MSR_EE_FLAG
) && mem_index
== MMU_USER_IDX
) {
1367 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_PRIVINSN
);
1368 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
1372 t_gen_raise_exception(dc
, EXCP_DEBUG
);
1376 if (dec_alu_op_b_is_small_imm(dc
)) {
1377 dc
->jmp
= JMP_DIRECT
;
1378 dc
->jmp_pc
= dc
->pc
+ (int32_t)((int16_t)dc
->imm
);
1380 tcg_gen_movi_tl(env_btaken
, 1);
1381 tcg_gen_movi_tl(env_btarget
, dc
->pc
);
1382 tcg_gen_add_tl(env_btarget
, env_btarget
, *(dec_alu_op_b(dc
)));
1387 static inline void do_rti(DisasContext
*dc
)
1390 t0
= tcg_temp_new();
1391 t1
= tcg_temp_new();
1392 tcg_gen_shri_tl(t0
, cpu_SR
[SR_MSR
], 1);
1393 tcg_gen_ori_tl(t1
, cpu_SR
[SR_MSR
], MSR_IE
);
1394 tcg_gen_andi_tl(t0
, t0
, (MSR_VM
| MSR_UM
));
1396 tcg_gen_andi_tl(t1
, t1
, ~(MSR_VM
| MSR_UM
));
1397 tcg_gen_or_tl(t1
, t1
, t0
);
1401 dc
->tb_flags
&= ~DRTI_FLAG
;
1404 static inline void do_rtb(DisasContext
*dc
)
1407 t0
= tcg_temp_new();
1408 t1
= tcg_temp_new();
1409 tcg_gen_andi_tl(t1
, cpu_SR
[SR_MSR
], ~MSR_BIP
);
1410 tcg_gen_shri_tl(t0
, t1
, 1);
1411 tcg_gen_andi_tl(t0
, t0
, (MSR_VM
| MSR_UM
));
1413 tcg_gen_andi_tl(t1
, t1
, ~(MSR_VM
| MSR_UM
));
1414 tcg_gen_or_tl(t1
, t1
, t0
);
1418 dc
->tb_flags
&= ~DRTB_FLAG
;
1421 static inline void do_rte(DisasContext
*dc
)
1424 t0
= tcg_temp_new();
1425 t1
= tcg_temp_new();
1427 tcg_gen_ori_tl(t1
, cpu_SR
[SR_MSR
], MSR_EE
);
1428 tcg_gen_andi_tl(t1
, t1
, ~MSR_EIP
);
1429 tcg_gen_shri_tl(t0
, t1
, 1);
1430 tcg_gen_andi_tl(t0
, t0
, (MSR_VM
| MSR_UM
));
1432 tcg_gen_andi_tl(t1
, t1
, ~(MSR_VM
| MSR_UM
));
1433 tcg_gen_or_tl(t1
, t1
, t0
);
1437 dc
->tb_flags
&= ~DRTE_FLAG
;
1440 static void dec_rts(DisasContext
*dc
)
1442 unsigned int b_bit
, i_bit
, e_bit
;
1443 int mem_index
= cpu_mmu_index(dc
->env
);
1445 i_bit
= dc
->ir
& (1 << 21);
1446 b_bit
= dc
->ir
& (1 << 22);
1447 e_bit
= dc
->ir
& (1 << 23);
1449 dc
->delayed_branch
= 2;
1450 dc
->tb_flags
|= D_FLAG
;
1451 tcg_gen_st_tl(tcg_const_tl(dc
->type_b
&& (dc
->tb_flags
& IMM_FLAG
)),
1452 cpu_env
, offsetof(CPUMBState
, bimm
));
1455 LOG_DIS("rtid ir=%x\n", dc
->ir
);
1456 if ((dc
->tb_flags
& MSR_EE_FLAG
)
1457 && mem_index
== MMU_USER_IDX
) {
1458 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_PRIVINSN
);
1459 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
1461 dc
->tb_flags
|= DRTI_FLAG
;
1463 LOG_DIS("rtbd ir=%x\n", dc
->ir
);
1464 if ((dc
->tb_flags
& MSR_EE_FLAG
)
1465 && mem_index
== MMU_USER_IDX
) {
1466 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_PRIVINSN
);
1467 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
1469 dc
->tb_flags
|= DRTB_FLAG
;
1471 LOG_DIS("rted ir=%x\n", dc
->ir
);
1472 if ((dc
->tb_flags
& MSR_EE_FLAG
)
1473 && mem_index
== MMU_USER_IDX
) {
1474 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_PRIVINSN
);
1475 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
1477 dc
->tb_flags
|= DRTE_FLAG
;
1479 LOG_DIS("rts ir=%x\n", dc
->ir
);
1481 dc
->jmp
= JMP_INDIRECT
;
1482 tcg_gen_movi_tl(env_btaken
, 1);
1483 tcg_gen_add_tl(env_btarget
, cpu_R
[dc
->ra
], *(dec_alu_op_b(dc
)));
1486 static int dec_check_fpuv2(DisasContext
*dc
)
1490 r
= dc
->env
->pvr
.regs
[2] & PVR2_USE_FPU2_MASK
;
1492 if (!r
&& (dc
->tb_flags
& MSR_EE_FLAG
)) {
1493 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_FPU
);
1494 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
1499 static void dec_fpu(DisasContext
*dc
)
1501 unsigned int fpu_insn
;
1503 if ((dc
->tb_flags
& MSR_EE_FLAG
)
1504 && (dc
->env
->pvr
.regs
[2] & PVR2_ILL_OPCODE_EXC_MASK
)
1505 && !((dc
->env
->pvr
.regs
[2] & PVR2_USE_FPU_MASK
))) {
1506 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_ILLEGAL_OP
);
1507 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
1511 fpu_insn
= (dc
->ir
>> 7) & 7;
1515 gen_helper_fadd(cpu_R
[dc
->rd
], cpu_env
, cpu_R
[dc
->ra
],
1520 gen_helper_frsub(cpu_R
[dc
->rd
], cpu_env
, cpu_R
[dc
->ra
],
1525 gen_helper_fmul(cpu_R
[dc
->rd
], cpu_env
, cpu_R
[dc
->ra
],
1530 gen_helper_fdiv(cpu_R
[dc
->rd
], cpu_env
, cpu_R
[dc
->ra
],
1535 switch ((dc
->ir
>> 4) & 7) {
1537 gen_helper_fcmp_un(cpu_R
[dc
->rd
], cpu_env
,
1538 cpu_R
[dc
->ra
], cpu_R
[dc
->rb
]);
1541 gen_helper_fcmp_lt(cpu_R
[dc
->rd
], cpu_env
,
1542 cpu_R
[dc
->ra
], cpu_R
[dc
->rb
]);
1545 gen_helper_fcmp_eq(cpu_R
[dc
->rd
], cpu_env
,
1546 cpu_R
[dc
->ra
], cpu_R
[dc
->rb
]);
1549 gen_helper_fcmp_le(cpu_R
[dc
->rd
], cpu_env
,
1550 cpu_R
[dc
->ra
], cpu_R
[dc
->rb
]);
1553 gen_helper_fcmp_gt(cpu_R
[dc
->rd
], cpu_env
,
1554 cpu_R
[dc
->ra
], cpu_R
[dc
->rb
]);
1557 gen_helper_fcmp_ne(cpu_R
[dc
->rd
], cpu_env
,
1558 cpu_R
[dc
->ra
], cpu_R
[dc
->rb
]);
1561 gen_helper_fcmp_ge(cpu_R
[dc
->rd
], cpu_env
,
1562 cpu_R
[dc
->ra
], cpu_R
[dc
->rb
]);
1565 qemu_log_mask(LOG_UNIMP
,
1566 "unimplemented fcmp fpu_insn=%x pc=%x"
1568 fpu_insn
, dc
->pc
, dc
->opcode
);
1569 dc
->abort_at_next_insn
= 1;
1575 if (!dec_check_fpuv2(dc
)) {
1578 gen_helper_flt(cpu_R
[dc
->rd
], cpu_env
, cpu_R
[dc
->ra
]);
1582 if (!dec_check_fpuv2(dc
)) {
1585 gen_helper_fint(cpu_R
[dc
->rd
], cpu_env
, cpu_R
[dc
->ra
]);
1589 if (!dec_check_fpuv2(dc
)) {
1592 gen_helper_fsqrt(cpu_R
[dc
->rd
], cpu_env
, cpu_R
[dc
->ra
]);
1596 qemu_log_mask(LOG_UNIMP
, "unimplemented FPU insn fpu_insn=%x pc=%x"
1598 fpu_insn
, dc
->pc
, dc
->opcode
);
1599 dc
->abort_at_next_insn
= 1;
1604 static void dec_null(DisasContext
*dc
)
1606 if ((dc
->tb_flags
& MSR_EE_FLAG
)
1607 && (dc
->env
->pvr
.regs
[2] & PVR2_ILL_OPCODE_EXC_MASK
)) {
1608 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_ILLEGAL_OP
);
1609 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
1612 qemu_log ("unknown insn pc=%x opc=%x\n", dc
->pc
, dc
->opcode
);
1613 dc
->abort_at_next_insn
= 1;
1616 /* Insns connected to FSL or AXI stream attached devices. */
1617 static void dec_stream(DisasContext
*dc
)
1619 int mem_index
= cpu_mmu_index(dc
->env
);
1620 TCGv_i32 t_id
, t_ctrl
;
1623 LOG_DIS("%s%s imm=%x\n", dc
->rd
? "get" : "put",
1624 dc
->type_b
? "" : "d", dc
->imm
);
1626 if ((dc
->tb_flags
& MSR_EE_FLAG
) && (mem_index
== MMU_USER_IDX
)) {
1627 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_PRIVINSN
);
1628 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
1632 t_id
= tcg_temp_new();
1634 tcg_gen_movi_tl(t_id
, dc
->imm
& 0xf);
1635 ctrl
= dc
->imm
>> 10;
1637 tcg_gen_andi_tl(t_id
, cpu_R
[dc
->rb
], 0xf);
1638 ctrl
= dc
->imm
>> 5;
1641 t_ctrl
= tcg_const_tl(ctrl
);
1644 gen_helper_put(t_id
, t_ctrl
, cpu_R
[dc
->ra
]);
1646 gen_helper_get(cpu_R
[dc
->rd
], t_id
, t_ctrl
);
1648 tcg_temp_free(t_id
);
1649 tcg_temp_free(t_ctrl
);
1652 static struct decoder_info
{
1657 void (*dec
)(DisasContext
*dc
);
1665 {DEC_BARREL
, dec_barrel
},
1667 {DEC_ST
, dec_store
},
1676 {DEC_STREAM
, dec_stream
},
1680 static inline void decode(DisasContext
*dc
, uint32_t ir
)
1684 if (unlikely(qemu_loglevel_mask(CPU_LOG_TB_OP
| CPU_LOG_TB_OP_OPT
))) {
1685 tcg_gen_debug_insn_start(dc
->pc
);
1689 LOG_DIS("%8.8x\t", dc
->ir
);
1694 if ((dc
->tb_flags
& MSR_EE_FLAG
)
1695 && (dc
->env
->pvr
.regs
[2] & PVR2_ILL_OPCODE_EXC_MASK
)
1696 && (dc
->env
->pvr
.regs
[2] & PVR2_OPCODE_0x0_ILL_MASK
)) {
1697 tcg_gen_movi_tl(cpu_SR
[SR_ESR
], ESR_EC_ILLEGAL_OP
);
1698 t_gen_raise_exception(dc
, EXCP_HW_EXCP
);
1702 LOG_DIS("nr_nops=%d\t", dc
->nr_nops
);
1704 if (dc
->nr_nops
> 4)
1705 cpu_abort(dc
->env
, "fetching nop sequence\n");
1707 /* bit 2 seems to indicate insn type. */
1708 dc
->type_b
= ir
& (1 << 29);
1710 dc
->opcode
= EXTRACT_FIELD(ir
, 26, 31);
1711 dc
->rd
= EXTRACT_FIELD(ir
, 21, 25);
1712 dc
->ra
= EXTRACT_FIELD(ir
, 16, 20);
1713 dc
->rb
= EXTRACT_FIELD(ir
, 11, 15);
1714 dc
->imm
= EXTRACT_FIELD(ir
, 0, 15);
1716 /* Large switch for all insns. */
1717 for (i
= 0; i
< ARRAY_SIZE(decinfo
); i
++) {
1718 if ((dc
->opcode
& decinfo
[i
].mask
) == decinfo
[i
].bits
) {
1725 static void check_breakpoint(CPUMBState
*env
, DisasContext
*dc
)
1729 if (unlikely(!QTAILQ_EMPTY(&env
->breakpoints
))) {
1730 QTAILQ_FOREACH(bp
, &env
->breakpoints
, entry
) {
1731 if (bp
->pc
== dc
->pc
) {
1732 t_gen_raise_exception(dc
, EXCP_DEBUG
);
1733 dc
->is_jmp
= DISAS_UPDATE
;
1739 /* generate intermediate code for basic block 'tb'. */
1741 gen_intermediate_code_internal(MicroBlazeCPU
*cpu
, TranslationBlock
*tb
,
1744 CPUMBState
*env
= &cpu
->env
;
1745 uint16_t *gen_opc_end
;
1748 struct DisasContext ctx
;
1749 struct DisasContext
*dc
= &ctx
;
1750 uint32_t next_page_start
, org_flags
;
1758 org_flags
= dc
->synced_flags
= dc
->tb_flags
= tb
->flags
;
1760 gen_opc_end
= tcg_ctx
.gen_opc_buf
+ OPC_MAX_SIZE
;
1762 dc
->is_jmp
= DISAS_NEXT
;
1764 dc
->delayed_branch
= !!(dc
->tb_flags
& D_FLAG
);
1765 if (dc
->delayed_branch
) {
1766 dc
->jmp
= JMP_INDIRECT
;
1769 dc
->singlestep_enabled
= env
->singlestep_enabled
;
1770 dc
->cpustate_changed
= 0;
1771 dc
->abort_at_next_insn
= 0;
1775 cpu_abort(env
, "Microblaze: unaligned PC=%x\n", pc_start
);
1777 if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM
)) {
1779 qemu_log("--------------\n");
1780 log_cpu_state(CPU(cpu
), 0);
1784 next_page_start
= (pc_start
& TARGET_PAGE_MASK
) + TARGET_PAGE_SIZE
;
1787 max_insns
= tb
->cflags
& CF_COUNT_MASK
;
1789 max_insns
= CF_COUNT_MASK
;
1795 if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM
)) {
1796 tcg_gen_movi_tl(cpu_SR
[SR_PC
], dc
->pc
);
1800 check_breakpoint(env
, dc
);
1803 j
= tcg_ctx
.gen_opc_ptr
- tcg_ctx
.gen_opc_buf
;
1807 tcg_ctx
.gen_opc_instr_start
[lj
++] = 0;
1809 tcg_ctx
.gen_opc_pc
[lj
] = dc
->pc
;
1810 tcg_ctx
.gen_opc_instr_start
[lj
] = 1;
1811 tcg_ctx
.gen_opc_icount
[lj
] = num_insns
;
1815 LOG_DIS("%8.8x:\t", dc
->pc
);
1817 if (num_insns
+ 1 == max_insns
&& (tb
->cflags
& CF_LAST_IO
))
1821 decode(dc
, cpu_ldl_code(env
, dc
->pc
));
1823 dc
->tb_flags
&= ~IMM_FLAG
;
1827 if (dc
->delayed_branch
) {
1828 dc
->delayed_branch
--;
1829 if (!dc
->delayed_branch
) {
1830 if (dc
->tb_flags
& DRTI_FLAG
)
1832 if (dc
->tb_flags
& DRTB_FLAG
)
1834 if (dc
->tb_flags
& DRTE_FLAG
)
1836 /* Clear the delay slot flag. */
1837 dc
->tb_flags
&= ~D_FLAG
;
1838 /* If it is a direct jump, try direct chaining. */
1839 if (dc
->jmp
== JMP_INDIRECT
) {
1840 eval_cond_jmp(dc
, env_btarget
, tcg_const_tl(dc
->pc
));
1841 dc
->is_jmp
= DISAS_JUMP
;
1842 } else if (dc
->jmp
== JMP_DIRECT
) {
1844 gen_goto_tb(dc
, 0, dc
->jmp_pc
);
1845 dc
->is_jmp
= DISAS_TB_JUMP
;
1846 } else if (dc
->jmp
== JMP_DIRECT_CC
) {
1850 l1
= gen_new_label();
1851 /* Conditional jmp. */
1852 tcg_gen_brcondi_tl(TCG_COND_NE
, env_btaken
, 0, l1
);
1853 gen_goto_tb(dc
, 1, dc
->pc
);
1855 gen_goto_tb(dc
, 0, dc
->jmp_pc
);
1857 dc
->is_jmp
= DISAS_TB_JUMP
;
1862 if (env
->singlestep_enabled
)
1864 } while (!dc
->is_jmp
&& !dc
->cpustate_changed
1865 && tcg_ctx
.gen_opc_ptr
< gen_opc_end
1867 && (dc
->pc
< next_page_start
)
1868 && num_insns
< max_insns
);
1871 if (dc
->jmp
== JMP_DIRECT
|| dc
->jmp
== JMP_DIRECT_CC
) {
1872 if (dc
->tb_flags
& D_FLAG
) {
1873 dc
->is_jmp
= DISAS_UPDATE
;
1874 tcg_gen_movi_tl(cpu_SR
[SR_PC
], npc
);
1880 if (tb
->cflags
& CF_LAST_IO
)
1882 /* Force an update if the per-tb cpu state has changed. */
1883 if (dc
->is_jmp
== DISAS_NEXT
1884 && (dc
->cpustate_changed
|| org_flags
!= dc
->tb_flags
)) {
1885 dc
->is_jmp
= DISAS_UPDATE
;
1886 tcg_gen_movi_tl(cpu_SR
[SR_PC
], npc
);
1890 if (unlikely(env
->singlestep_enabled
)) {
1891 TCGv_i32 tmp
= tcg_const_i32(EXCP_DEBUG
);
1893 if (dc
->is_jmp
!= DISAS_JUMP
) {
1894 tcg_gen_movi_tl(cpu_SR
[SR_PC
], npc
);
1896 gen_helper_raise_exception(cpu_env
, tmp
);
1897 tcg_temp_free_i32(tmp
);
1899 switch(dc
->is_jmp
) {
1901 gen_goto_tb(dc
, 1, npc
);
1906 /* indicate that the hash table must be used
1907 to find the next TB */
1911 /* nothing more to generate */
1915 gen_tb_end(tb
, num_insns
);
1916 *tcg_ctx
.gen_opc_ptr
= INDEX_op_end
;
1918 j
= tcg_ctx
.gen_opc_ptr
- tcg_ctx
.gen_opc_buf
;
1921 tcg_ctx
.gen_opc_instr_start
[lj
++] = 0;
1923 tb
->size
= dc
->pc
- pc_start
;
1924 tb
->icount
= num_insns
;
1929 if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM
)) {
1932 log_target_disas(env
, pc_start
, dc
->pc
- pc_start
, 0);
1934 qemu_log("\nisize=%d osize=%td\n",
1935 dc
->pc
- pc_start
, tcg_ctx
.gen_opc_ptr
-
1936 tcg_ctx
.gen_opc_buf
);
1940 assert(!dc
->abort_at_next_insn
);
1943 void gen_intermediate_code (CPUMBState
*env
, struct TranslationBlock
*tb
)
1945 gen_intermediate_code_internal(mb_env_get_cpu(env
), tb
, false);
1948 void gen_intermediate_code_pc (CPUMBState
*env
, struct TranslationBlock
*tb
)
1950 gen_intermediate_code_internal(mb_env_get_cpu(env
), tb
, true);
1953 void mb_cpu_dump_state(CPUState
*cs
, FILE *f
, fprintf_function cpu_fprintf
,
1956 MicroBlazeCPU
*cpu
= MICROBLAZE_CPU(cs
);
1957 CPUMBState
*env
= &cpu
->env
;
1963 cpu_fprintf(f
, "IN: PC=%x %s\n",
1964 env
->sregs
[SR_PC
], lookup_symbol(env
->sregs
[SR_PC
]));
1965 cpu_fprintf(f
, "rmsr=%x resr=%x rear=%x debug=%x imm=%x iflags=%x fsr=%x\n",
1966 env
->sregs
[SR_MSR
], env
->sregs
[SR_ESR
], env
->sregs
[SR_EAR
],
1967 env
->debug
, env
->imm
, env
->iflags
, env
->sregs
[SR_FSR
]);
1968 cpu_fprintf(f
, "btaken=%d btarget=%x mode=%s(saved=%s) eip=%d ie=%d\n",
1969 env
->btaken
, env
->btarget
,
1970 (env
->sregs
[SR_MSR
] & MSR_UM
) ? "user" : "kernel",
1971 (env
->sregs
[SR_MSR
] & MSR_UMS
) ? "user" : "kernel",
1972 (env
->sregs
[SR_MSR
] & MSR_EIP
),
1973 (env
->sregs
[SR_MSR
] & MSR_IE
));
1975 for (i
= 0; i
< 32; i
++) {
1976 cpu_fprintf(f
, "r%2.2d=%8.8x ", i
, env
->regs
[i
]);
1977 if ((i
+ 1) % 4 == 0)
1978 cpu_fprintf(f
, "\n");
1980 cpu_fprintf(f
, "\n\n");
1983 MicroBlazeCPU
*cpu_mb_init(const char *cpu_model
)
1987 cpu
= MICROBLAZE_CPU(object_new(TYPE_MICROBLAZE_CPU
));
1989 object_property_set_bool(OBJECT(cpu
), true, "realized", NULL
);
1994 void mb_tcg_init(void)
1998 cpu_env
= tcg_global_reg_new_ptr(TCG_AREG0
, "env");
2000 env_debug
= tcg_global_mem_new(TCG_AREG0
,
2001 offsetof(CPUMBState
, debug
),
2003 env_iflags
= tcg_global_mem_new(TCG_AREG0
,
2004 offsetof(CPUMBState
, iflags
),
2006 env_imm
= tcg_global_mem_new(TCG_AREG0
,
2007 offsetof(CPUMBState
, imm
),
2009 env_btarget
= tcg_global_mem_new(TCG_AREG0
,
2010 offsetof(CPUMBState
, btarget
),
2012 env_btaken
= tcg_global_mem_new(TCG_AREG0
,
2013 offsetof(CPUMBState
, btaken
),
2015 for (i
= 0; i
< ARRAY_SIZE(cpu_R
); i
++) {
2016 cpu_R
[i
] = tcg_global_mem_new(TCG_AREG0
,
2017 offsetof(CPUMBState
, regs
[i
]),
2020 for (i
= 0; i
< ARRAY_SIZE(cpu_SR
); i
++) {
2021 cpu_SR
[i
] = tcg_global_mem_new(TCG_AREG0
,
2022 offsetof(CPUMBState
, sregs
[i
]),
2023 special_regnames
[i
]);
2025 #define GEN_HELPER 2
2029 void restore_state_to_opc(CPUMBState
*env
, TranslationBlock
*tb
, int pc_pos
)
2031 env
->sregs
[SR_PC
] = tcg_ctx
.gen_opc_pc
[pc_pos
];