1fcf5ef2aSThomas Huth /* 2fcf5ef2aSThomas Huth * Xilinx MicroBlaze emulation for qemu: main translation routines. 3fcf5ef2aSThomas Huth * 4fcf5ef2aSThomas Huth * Copyright (c) 2009 Edgar E. Iglesias. 5fcf5ef2aSThomas Huth * Copyright (c) 2009-2012 PetaLogix Qld Pty Ltd. 6fcf5ef2aSThomas Huth * 7fcf5ef2aSThomas Huth * This library is free software; you can redistribute it and/or 8fcf5ef2aSThomas Huth * modify it under the terms of the GNU Lesser General Public 9fcf5ef2aSThomas Huth * License as published by the Free Software Foundation; either 10fcf5ef2aSThomas Huth * version 2 of the License, or (at your option) any later version. 11fcf5ef2aSThomas Huth * 12fcf5ef2aSThomas Huth * This library is distributed in the hope that it will be useful, 13fcf5ef2aSThomas Huth * but WITHOUT ANY WARRANTY; without even the implied warranty of 14fcf5ef2aSThomas Huth * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 15fcf5ef2aSThomas Huth * Lesser General Public License for more details. 16fcf5ef2aSThomas Huth * 17fcf5ef2aSThomas Huth * You should have received a copy of the GNU Lesser General Public 18fcf5ef2aSThomas Huth * License along with this library; if not, see <http://www.gnu.org/licenses/>. 19fcf5ef2aSThomas Huth */ 20fcf5ef2aSThomas Huth 21fcf5ef2aSThomas Huth #include "qemu/osdep.h" 22fcf5ef2aSThomas Huth #include "cpu.h" 23fcf5ef2aSThomas Huth #include "disas/disas.h" 24fcf5ef2aSThomas Huth #include "exec/exec-all.h" 25fcf5ef2aSThomas Huth #include "tcg-op.h" 26fcf5ef2aSThomas Huth #include "exec/helper-proto.h" 27fcf5ef2aSThomas Huth #include "microblaze-decode.h" 28fcf5ef2aSThomas Huth #include "exec/cpu_ldst.h" 29fcf5ef2aSThomas Huth #include "exec/helper-gen.h" 3077fc6f5eSLluís Vilanova #include "exec/translator.h" 3190c84c56SMarkus Armbruster #include "qemu/qemu-print.h" 32fcf5ef2aSThomas Huth 33fcf5ef2aSThomas Huth #include "trace-tcg.h" 34fcf5ef2aSThomas Huth #include "exec/log.h" 35fcf5ef2aSThomas Huth 36fcf5ef2aSThomas Huth 37fcf5ef2aSThomas Huth #define SIM_COMPAT 0 38fcf5ef2aSThomas Huth #define DISAS_GNU 1 39fcf5ef2aSThomas Huth #define DISAS_MB 1 40fcf5ef2aSThomas Huth #if DISAS_MB && !SIM_COMPAT 41fcf5ef2aSThomas Huth # define LOG_DIS(...) qemu_log_mask(CPU_LOG_TB_IN_ASM, ## __VA_ARGS__) 42fcf5ef2aSThomas Huth #else 43fcf5ef2aSThomas Huth # define LOG_DIS(...) do { } while (0) 44fcf5ef2aSThomas Huth #endif 45fcf5ef2aSThomas Huth 46fcf5ef2aSThomas Huth #define D(x) 47fcf5ef2aSThomas Huth 48fcf5ef2aSThomas Huth #define EXTRACT_FIELD(src, start, end) \ 49fcf5ef2aSThomas Huth (((src) >> start) & ((1 << (end - start + 1)) - 1)) 50fcf5ef2aSThomas Huth 5177fc6f5eSLluís Vilanova /* is_jmp field values */ 5277fc6f5eSLluís Vilanova #define DISAS_JUMP DISAS_TARGET_0 /* only pc was modified dynamically */ 5377fc6f5eSLluís Vilanova #define DISAS_UPDATE DISAS_TARGET_1 /* cpu state was modified dynamically */ 5477fc6f5eSLluís Vilanova #define DISAS_TB_JUMP DISAS_TARGET_2 /* only pc was modified statically */ 5577fc6f5eSLluís Vilanova 56cfeea807SEdgar E. Iglesias static TCGv_i32 env_debug; 57cfeea807SEdgar E. Iglesias static TCGv_i32 cpu_R[32]; 580a22f8cfSEdgar E. Iglesias static TCGv_i64 cpu_SR[14]; 59cfeea807SEdgar E. Iglesias static TCGv_i32 env_imm; 60cfeea807SEdgar E. Iglesias static TCGv_i32 env_btaken; 6143d318b2SEdgar E. Iglesias static TCGv_i64 env_btarget; 62cfeea807SEdgar E. Iglesias static TCGv_i32 env_iflags; 63403322eaSEdgar E. Iglesias static TCGv env_res_addr; 64cfeea807SEdgar E. Iglesias static TCGv_i32 env_res_val; 65fcf5ef2aSThomas Huth 66fcf5ef2aSThomas Huth #include "exec/gen-icount.h" 67fcf5ef2aSThomas Huth 68fcf5ef2aSThomas Huth /* This is the state at translation time. */ 69fcf5ef2aSThomas Huth typedef struct DisasContext { 70fcf5ef2aSThomas Huth MicroBlazeCPU *cpu; 71cfeea807SEdgar E. Iglesias uint32_t pc; 72fcf5ef2aSThomas Huth 73fcf5ef2aSThomas Huth /* Decoder. */ 74fcf5ef2aSThomas Huth int type_b; 75fcf5ef2aSThomas Huth uint32_t ir; 76fcf5ef2aSThomas Huth uint8_t opcode; 77fcf5ef2aSThomas Huth uint8_t rd, ra, rb; 78fcf5ef2aSThomas Huth uint16_t imm; 79fcf5ef2aSThomas Huth 80fcf5ef2aSThomas Huth unsigned int cpustate_changed; 81fcf5ef2aSThomas Huth unsigned int delayed_branch; 82fcf5ef2aSThomas Huth unsigned int tb_flags, synced_flags; /* tb dependent flags. */ 83fcf5ef2aSThomas Huth unsigned int clear_imm; 84fcf5ef2aSThomas Huth int is_jmp; 85fcf5ef2aSThomas Huth 86fcf5ef2aSThomas Huth #define JMP_NOJMP 0 87fcf5ef2aSThomas Huth #define JMP_DIRECT 1 88fcf5ef2aSThomas Huth #define JMP_DIRECT_CC 2 89fcf5ef2aSThomas Huth #define JMP_INDIRECT 3 90fcf5ef2aSThomas Huth unsigned int jmp; 91fcf5ef2aSThomas Huth uint32_t jmp_pc; 92fcf5ef2aSThomas Huth 93fcf5ef2aSThomas Huth int abort_at_next_insn; 94fcf5ef2aSThomas Huth struct TranslationBlock *tb; 95fcf5ef2aSThomas Huth int singlestep_enabled; 96fcf5ef2aSThomas Huth } DisasContext; 97fcf5ef2aSThomas Huth 98fcf5ef2aSThomas Huth static const char *regnames[] = 99fcf5ef2aSThomas Huth { 100fcf5ef2aSThomas Huth "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7", 101fcf5ef2aSThomas Huth "r8", "r9", "r10", "r11", "r12", "r13", "r14", "r15", 102fcf5ef2aSThomas Huth "r16", "r17", "r18", "r19", "r20", "r21", "r22", "r23", 103fcf5ef2aSThomas Huth "r24", "r25", "r26", "r27", "r28", "r29", "r30", "r31", 104fcf5ef2aSThomas Huth }; 105fcf5ef2aSThomas Huth 106fcf5ef2aSThomas Huth static const char *special_regnames[] = 107fcf5ef2aSThomas Huth { 1080031eef2SEdgar E. Iglesias "rpc", "rmsr", "sr2", "rear", "sr4", "resr", "sr6", "rfsr", 1090031eef2SEdgar E. Iglesias "sr8", "sr9", "sr10", "rbtr", "sr12", "redr" 110fcf5ef2aSThomas Huth }; 111fcf5ef2aSThomas Huth 112fcf5ef2aSThomas Huth static inline void t_sync_flags(DisasContext *dc) 113fcf5ef2aSThomas Huth { 114fcf5ef2aSThomas Huth /* Synch the tb dependent flags between translator and runtime. */ 115fcf5ef2aSThomas Huth if (dc->tb_flags != dc->synced_flags) { 116cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_iflags, dc->tb_flags); 117fcf5ef2aSThomas Huth dc->synced_flags = dc->tb_flags; 118fcf5ef2aSThomas Huth } 119fcf5ef2aSThomas Huth } 120fcf5ef2aSThomas Huth 121fcf5ef2aSThomas Huth static inline void t_gen_raise_exception(DisasContext *dc, uint32_t index) 122fcf5ef2aSThomas Huth { 123fcf5ef2aSThomas Huth TCGv_i32 tmp = tcg_const_i32(index); 124fcf5ef2aSThomas Huth 125fcf5ef2aSThomas Huth t_sync_flags(dc); 1260a22f8cfSEdgar E. Iglesias tcg_gen_movi_i64(cpu_SR[SR_PC], dc->pc); 127fcf5ef2aSThomas Huth gen_helper_raise_exception(cpu_env, tmp); 128fcf5ef2aSThomas Huth tcg_temp_free_i32(tmp); 129fcf5ef2aSThomas Huth dc->is_jmp = DISAS_UPDATE; 130fcf5ef2aSThomas Huth } 131fcf5ef2aSThomas Huth 132fcf5ef2aSThomas Huth static inline bool use_goto_tb(DisasContext *dc, target_ulong dest) 133fcf5ef2aSThomas Huth { 134fcf5ef2aSThomas Huth #ifndef CONFIG_USER_ONLY 135fcf5ef2aSThomas Huth return (dc->tb->pc & TARGET_PAGE_MASK) == (dest & TARGET_PAGE_MASK); 136fcf5ef2aSThomas Huth #else 137fcf5ef2aSThomas Huth return true; 138fcf5ef2aSThomas Huth #endif 139fcf5ef2aSThomas Huth } 140fcf5ef2aSThomas Huth 141fcf5ef2aSThomas Huth static void gen_goto_tb(DisasContext *dc, int n, target_ulong dest) 142fcf5ef2aSThomas Huth { 143fcf5ef2aSThomas Huth if (use_goto_tb(dc, dest)) { 144fcf5ef2aSThomas Huth tcg_gen_goto_tb(n); 1450a22f8cfSEdgar E. Iglesias tcg_gen_movi_i64(cpu_SR[SR_PC], dest); 14607ea28b4SRichard Henderson tcg_gen_exit_tb(dc->tb, n); 147fcf5ef2aSThomas Huth } else { 1480a22f8cfSEdgar E. Iglesias tcg_gen_movi_i64(cpu_SR[SR_PC], dest); 14907ea28b4SRichard Henderson tcg_gen_exit_tb(NULL, 0); 150fcf5ef2aSThomas Huth } 151fcf5ef2aSThomas Huth } 152fcf5ef2aSThomas Huth 153cfeea807SEdgar E. Iglesias static void read_carry(DisasContext *dc, TCGv_i32 d) 154fcf5ef2aSThomas Huth { 1550a22f8cfSEdgar E. Iglesias tcg_gen_extrl_i64_i32(d, cpu_SR[SR_MSR]); 1560a22f8cfSEdgar E. Iglesias tcg_gen_shri_i32(d, d, 31); 157fcf5ef2aSThomas Huth } 158fcf5ef2aSThomas Huth 159fcf5ef2aSThomas Huth /* 160fcf5ef2aSThomas Huth * write_carry sets the carry bits in MSR based on bit 0 of v. 161fcf5ef2aSThomas Huth * v[31:1] are ignored. 162fcf5ef2aSThomas Huth */ 163cfeea807SEdgar E. Iglesias static void write_carry(DisasContext *dc, TCGv_i32 v) 164fcf5ef2aSThomas Huth { 1650a22f8cfSEdgar E. Iglesias TCGv_i64 t0 = tcg_temp_new_i64(); 1660a22f8cfSEdgar E. Iglesias tcg_gen_extu_i32_i64(t0, v); 1670a22f8cfSEdgar E. Iglesias /* Deposit bit 0 into MSR_C and the alias MSR_CC. */ 1680a22f8cfSEdgar E. Iglesias tcg_gen_deposit_i64(cpu_SR[SR_MSR], cpu_SR[SR_MSR], t0, 2, 1); 1690a22f8cfSEdgar E. Iglesias tcg_gen_deposit_i64(cpu_SR[SR_MSR], cpu_SR[SR_MSR], t0, 31, 1); 1700a22f8cfSEdgar E. Iglesias tcg_temp_free_i64(t0); 171fcf5ef2aSThomas Huth } 172fcf5ef2aSThomas Huth 173fcf5ef2aSThomas Huth static void write_carryi(DisasContext *dc, bool carry) 174fcf5ef2aSThomas Huth { 175cfeea807SEdgar E. Iglesias TCGv_i32 t0 = tcg_temp_new_i32(); 176cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(t0, carry); 177fcf5ef2aSThomas Huth write_carry(dc, t0); 178cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t0); 179fcf5ef2aSThomas Huth } 180fcf5ef2aSThomas Huth 181bdfc1e88SEdgar E. Iglesias /* 1829ba8cd45SEdgar E. Iglesias * Returns true if the insn an illegal operation. 1839ba8cd45SEdgar E. Iglesias * If exceptions are enabled, an exception is raised. 1849ba8cd45SEdgar E. Iglesias */ 1859ba8cd45SEdgar E. Iglesias static bool trap_illegal(DisasContext *dc, bool cond) 1869ba8cd45SEdgar E. Iglesias { 1879ba8cd45SEdgar E. Iglesias if (cond && (dc->tb_flags & MSR_EE_FLAG) 1889ba8cd45SEdgar E. Iglesias && (dc->cpu->env.pvr.regs[2] & PVR2_ILL_OPCODE_EXC_MASK)) { 1890a22f8cfSEdgar E. Iglesias tcg_gen_movi_i64(cpu_SR[SR_ESR], ESR_EC_ILLEGAL_OP); 1909ba8cd45SEdgar E. Iglesias t_gen_raise_exception(dc, EXCP_HW_EXCP); 1919ba8cd45SEdgar E. Iglesias } 1929ba8cd45SEdgar E. Iglesias return cond; 1939ba8cd45SEdgar E. Iglesias } 1949ba8cd45SEdgar E. Iglesias 1959ba8cd45SEdgar E. Iglesias /* 196bdfc1e88SEdgar E. Iglesias * Returns true if the insn is illegal in userspace. 197bdfc1e88SEdgar E. Iglesias * If exceptions are enabled, an exception is raised. 198bdfc1e88SEdgar E. Iglesias */ 199bdfc1e88SEdgar E. Iglesias static bool trap_userspace(DisasContext *dc, bool cond) 200bdfc1e88SEdgar E. Iglesias { 201bdfc1e88SEdgar E. Iglesias int mem_index = cpu_mmu_index(&dc->cpu->env, false); 202bdfc1e88SEdgar E. Iglesias bool cond_user = cond && mem_index == MMU_USER_IDX; 203bdfc1e88SEdgar E. Iglesias 204bdfc1e88SEdgar E. Iglesias if (cond_user && (dc->tb_flags & MSR_EE_FLAG)) { 2050a22f8cfSEdgar E. Iglesias tcg_gen_movi_i64(cpu_SR[SR_ESR], ESR_EC_PRIVINSN); 206bdfc1e88SEdgar E. Iglesias t_gen_raise_exception(dc, EXCP_HW_EXCP); 207bdfc1e88SEdgar E. Iglesias } 208bdfc1e88SEdgar E. Iglesias return cond_user; 209bdfc1e88SEdgar E. Iglesias } 210bdfc1e88SEdgar E. Iglesias 211fcf5ef2aSThomas Huth /* True if ALU operand b is a small immediate that may deserve 212fcf5ef2aSThomas Huth faster treatment. */ 213fcf5ef2aSThomas Huth static inline int dec_alu_op_b_is_small_imm(DisasContext *dc) 214fcf5ef2aSThomas Huth { 215fcf5ef2aSThomas Huth /* Immediate insn without the imm prefix ? */ 216fcf5ef2aSThomas Huth return dc->type_b && !(dc->tb_flags & IMM_FLAG); 217fcf5ef2aSThomas Huth } 218fcf5ef2aSThomas Huth 219cfeea807SEdgar E. Iglesias static inline TCGv_i32 *dec_alu_op_b(DisasContext *dc) 220fcf5ef2aSThomas Huth { 221fcf5ef2aSThomas Huth if (dc->type_b) { 222fcf5ef2aSThomas Huth if (dc->tb_flags & IMM_FLAG) 223cfeea807SEdgar E. Iglesias tcg_gen_ori_i32(env_imm, env_imm, dc->imm); 224fcf5ef2aSThomas Huth else 225cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_imm, (int32_t)((int16_t)dc->imm)); 226fcf5ef2aSThomas Huth return &env_imm; 227fcf5ef2aSThomas Huth } else 228fcf5ef2aSThomas Huth return &cpu_R[dc->rb]; 229fcf5ef2aSThomas Huth } 230fcf5ef2aSThomas Huth 231fcf5ef2aSThomas Huth static void dec_add(DisasContext *dc) 232fcf5ef2aSThomas Huth { 233fcf5ef2aSThomas Huth unsigned int k, c; 234cfeea807SEdgar E. Iglesias TCGv_i32 cf; 235fcf5ef2aSThomas Huth 236fcf5ef2aSThomas Huth k = dc->opcode & 4; 237fcf5ef2aSThomas Huth c = dc->opcode & 2; 238fcf5ef2aSThomas Huth 239fcf5ef2aSThomas Huth LOG_DIS("add%s%s%s r%d r%d r%d\n", 240fcf5ef2aSThomas Huth dc->type_b ? "i" : "", k ? "k" : "", c ? "c" : "", 241fcf5ef2aSThomas Huth dc->rd, dc->ra, dc->rb); 242fcf5ef2aSThomas Huth 243fcf5ef2aSThomas Huth /* Take care of the easy cases first. */ 244fcf5ef2aSThomas Huth if (k) { 245fcf5ef2aSThomas Huth /* k - keep carry, no need to update MSR. */ 246fcf5ef2aSThomas Huth /* If rd == r0, it's a nop. */ 247fcf5ef2aSThomas Huth if (dc->rd) { 248cfeea807SEdgar E. Iglesias tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc))); 249fcf5ef2aSThomas Huth 250fcf5ef2aSThomas Huth if (c) { 251fcf5ef2aSThomas Huth /* c - Add carry into the result. */ 252cfeea807SEdgar E. Iglesias cf = tcg_temp_new_i32(); 253fcf5ef2aSThomas Huth 254fcf5ef2aSThomas Huth read_carry(dc, cf); 255cfeea807SEdgar E. Iglesias tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->rd], cf); 256cfeea807SEdgar E. Iglesias tcg_temp_free_i32(cf); 257fcf5ef2aSThomas Huth } 258fcf5ef2aSThomas Huth } 259fcf5ef2aSThomas Huth return; 260fcf5ef2aSThomas Huth } 261fcf5ef2aSThomas Huth 262fcf5ef2aSThomas Huth /* From now on, we can assume k is zero. So we need to update MSR. */ 263fcf5ef2aSThomas Huth /* Extract carry. */ 264cfeea807SEdgar E. Iglesias cf = tcg_temp_new_i32(); 265fcf5ef2aSThomas Huth if (c) { 266fcf5ef2aSThomas Huth read_carry(dc, cf); 267fcf5ef2aSThomas Huth } else { 268cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cf, 0); 269fcf5ef2aSThomas Huth } 270fcf5ef2aSThomas Huth 271fcf5ef2aSThomas Huth if (dc->rd) { 272cfeea807SEdgar E. Iglesias TCGv_i32 ncf = tcg_temp_new_i32(); 273fcf5ef2aSThomas Huth gen_helper_carry(ncf, cpu_R[dc->ra], *(dec_alu_op_b(dc)), cf); 274cfeea807SEdgar E. Iglesias tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc))); 275cfeea807SEdgar E. Iglesias tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->rd], cf); 276fcf5ef2aSThomas Huth write_carry(dc, ncf); 277cfeea807SEdgar E. Iglesias tcg_temp_free_i32(ncf); 278fcf5ef2aSThomas Huth } else { 279fcf5ef2aSThomas Huth gen_helper_carry(cf, cpu_R[dc->ra], *(dec_alu_op_b(dc)), cf); 280fcf5ef2aSThomas Huth write_carry(dc, cf); 281fcf5ef2aSThomas Huth } 282cfeea807SEdgar E. Iglesias tcg_temp_free_i32(cf); 283fcf5ef2aSThomas Huth } 284fcf5ef2aSThomas Huth 285fcf5ef2aSThomas Huth static void dec_sub(DisasContext *dc) 286fcf5ef2aSThomas Huth { 287fcf5ef2aSThomas Huth unsigned int u, cmp, k, c; 288cfeea807SEdgar E. Iglesias TCGv_i32 cf, na; 289fcf5ef2aSThomas Huth 290fcf5ef2aSThomas Huth u = dc->imm & 2; 291fcf5ef2aSThomas Huth k = dc->opcode & 4; 292fcf5ef2aSThomas Huth c = dc->opcode & 2; 293fcf5ef2aSThomas Huth cmp = (dc->imm & 1) && (!dc->type_b) && k; 294fcf5ef2aSThomas Huth 295fcf5ef2aSThomas Huth if (cmp) { 296fcf5ef2aSThomas Huth LOG_DIS("cmp%s r%d, r%d ir=%x\n", u ? "u" : "", dc->rd, dc->ra, dc->ir); 297fcf5ef2aSThomas Huth if (dc->rd) { 298fcf5ef2aSThomas Huth if (u) 299fcf5ef2aSThomas Huth gen_helper_cmpu(cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]); 300fcf5ef2aSThomas Huth else 301fcf5ef2aSThomas Huth gen_helper_cmp(cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]); 302fcf5ef2aSThomas Huth } 303fcf5ef2aSThomas Huth return; 304fcf5ef2aSThomas Huth } 305fcf5ef2aSThomas Huth 306fcf5ef2aSThomas Huth LOG_DIS("sub%s%s r%d, r%d r%d\n", 307fcf5ef2aSThomas Huth k ? "k" : "", c ? "c" : "", dc->rd, dc->ra, dc->rb); 308fcf5ef2aSThomas Huth 309fcf5ef2aSThomas Huth /* Take care of the easy cases first. */ 310fcf5ef2aSThomas Huth if (k) { 311fcf5ef2aSThomas Huth /* k - keep carry, no need to update MSR. */ 312fcf5ef2aSThomas Huth /* If rd == r0, it's a nop. */ 313fcf5ef2aSThomas Huth if (dc->rd) { 314cfeea807SEdgar E. Iglesias tcg_gen_sub_i32(cpu_R[dc->rd], *(dec_alu_op_b(dc)), cpu_R[dc->ra]); 315fcf5ef2aSThomas Huth 316fcf5ef2aSThomas Huth if (c) { 317fcf5ef2aSThomas Huth /* c - Add carry into the result. */ 318cfeea807SEdgar E. Iglesias cf = tcg_temp_new_i32(); 319fcf5ef2aSThomas Huth 320fcf5ef2aSThomas Huth read_carry(dc, cf); 321cfeea807SEdgar E. Iglesias tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->rd], cf); 322cfeea807SEdgar E. Iglesias tcg_temp_free_i32(cf); 323fcf5ef2aSThomas Huth } 324fcf5ef2aSThomas Huth } 325fcf5ef2aSThomas Huth return; 326fcf5ef2aSThomas Huth } 327fcf5ef2aSThomas Huth 328fcf5ef2aSThomas Huth /* From now on, we can assume k is zero. So we need to update MSR. */ 329fcf5ef2aSThomas Huth /* Extract carry. And complement a into na. */ 330cfeea807SEdgar E. Iglesias cf = tcg_temp_new_i32(); 331cfeea807SEdgar E. Iglesias na = tcg_temp_new_i32(); 332fcf5ef2aSThomas Huth if (c) { 333fcf5ef2aSThomas Huth read_carry(dc, cf); 334fcf5ef2aSThomas Huth } else { 335cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cf, 1); 336fcf5ef2aSThomas Huth } 337fcf5ef2aSThomas Huth 338fcf5ef2aSThomas Huth /* d = b + ~a + c. carry defaults to 1. */ 339cfeea807SEdgar E. Iglesias tcg_gen_not_i32(na, cpu_R[dc->ra]); 340fcf5ef2aSThomas Huth 341fcf5ef2aSThomas Huth if (dc->rd) { 342cfeea807SEdgar E. Iglesias TCGv_i32 ncf = tcg_temp_new_i32(); 343fcf5ef2aSThomas Huth gen_helper_carry(ncf, na, *(dec_alu_op_b(dc)), cf); 344cfeea807SEdgar E. Iglesias tcg_gen_add_i32(cpu_R[dc->rd], na, *(dec_alu_op_b(dc))); 345cfeea807SEdgar E. Iglesias tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->rd], cf); 346fcf5ef2aSThomas Huth write_carry(dc, ncf); 347cfeea807SEdgar E. Iglesias tcg_temp_free_i32(ncf); 348fcf5ef2aSThomas Huth } else { 349fcf5ef2aSThomas Huth gen_helper_carry(cf, na, *(dec_alu_op_b(dc)), cf); 350fcf5ef2aSThomas Huth write_carry(dc, cf); 351fcf5ef2aSThomas Huth } 352cfeea807SEdgar E. Iglesias tcg_temp_free_i32(cf); 353cfeea807SEdgar E. Iglesias tcg_temp_free_i32(na); 354fcf5ef2aSThomas Huth } 355fcf5ef2aSThomas Huth 356fcf5ef2aSThomas Huth static void dec_pattern(DisasContext *dc) 357fcf5ef2aSThomas Huth { 358fcf5ef2aSThomas Huth unsigned int mode; 359fcf5ef2aSThomas Huth 3609ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, !dc->cpu->cfg.use_pcmp_instr)) { 3619ba8cd45SEdgar E. Iglesias return; 362fcf5ef2aSThomas Huth } 363fcf5ef2aSThomas Huth 364fcf5ef2aSThomas Huth mode = dc->opcode & 3; 365fcf5ef2aSThomas Huth switch (mode) { 366fcf5ef2aSThomas Huth case 0: 367fcf5ef2aSThomas Huth /* pcmpbf. */ 368fcf5ef2aSThomas Huth LOG_DIS("pcmpbf r%d r%d r%d\n", dc->rd, dc->ra, dc->rb); 369fcf5ef2aSThomas Huth if (dc->rd) 370fcf5ef2aSThomas Huth gen_helper_pcmpbf(cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]); 371fcf5ef2aSThomas Huth break; 372fcf5ef2aSThomas Huth case 2: 373fcf5ef2aSThomas Huth LOG_DIS("pcmpeq r%d r%d r%d\n", dc->rd, dc->ra, dc->rb); 374fcf5ef2aSThomas Huth if (dc->rd) { 375cfeea807SEdgar E. Iglesias tcg_gen_setcond_i32(TCG_COND_EQ, cpu_R[dc->rd], 376fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 377fcf5ef2aSThomas Huth } 378fcf5ef2aSThomas Huth break; 379fcf5ef2aSThomas Huth case 3: 380fcf5ef2aSThomas Huth LOG_DIS("pcmpne r%d r%d r%d\n", dc->rd, dc->ra, dc->rb); 381fcf5ef2aSThomas Huth if (dc->rd) { 382cfeea807SEdgar E. Iglesias tcg_gen_setcond_i32(TCG_COND_NE, cpu_R[dc->rd], 383fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 384fcf5ef2aSThomas Huth } 385fcf5ef2aSThomas Huth break; 386fcf5ef2aSThomas Huth default: 387fcf5ef2aSThomas Huth cpu_abort(CPU(dc->cpu), 388fcf5ef2aSThomas Huth "unsupported pattern insn opcode=%x\n", dc->opcode); 389fcf5ef2aSThomas Huth break; 390fcf5ef2aSThomas Huth } 391fcf5ef2aSThomas Huth } 392fcf5ef2aSThomas Huth 393fcf5ef2aSThomas Huth static void dec_and(DisasContext *dc) 394fcf5ef2aSThomas Huth { 395fcf5ef2aSThomas Huth unsigned int not; 396fcf5ef2aSThomas Huth 397fcf5ef2aSThomas Huth if (!dc->type_b && (dc->imm & (1 << 10))) { 398fcf5ef2aSThomas Huth dec_pattern(dc); 399fcf5ef2aSThomas Huth return; 400fcf5ef2aSThomas Huth } 401fcf5ef2aSThomas Huth 402fcf5ef2aSThomas Huth not = dc->opcode & (1 << 1); 403fcf5ef2aSThomas Huth LOG_DIS("and%s\n", not ? "n" : ""); 404fcf5ef2aSThomas Huth 405fcf5ef2aSThomas Huth if (!dc->rd) 406fcf5ef2aSThomas Huth return; 407fcf5ef2aSThomas Huth 408fcf5ef2aSThomas Huth if (not) { 409cfeea807SEdgar E. Iglesias tcg_gen_andc_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc))); 410fcf5ef2aSThomas Huth } else 411cfeea807SEdgar E. Iglesias tcg_gen_and_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc))); 412fcf5ef2aSThomas Huth } 413fcf5ef2aSThomas Huth 414fcf5ef2aSThomas Huth static void dec_or(DisasContext *dc) 415fcf5ef2aSThomas Huth { 416fcf5ef2aSThomas Huth if (!dc->type_b && (dc->imm & (1 << 10))) { 417fcf5ef2aSThomas Huth dec_pattern(dc); 418fcf5ef2aSThomas Huth return; 419fcf5ef2aSThomas Huth } 420fcf5ef2aSThomas Huth 421fcf5ef2aSThomas Huth LOG_DIS("or r%d r%d r%d imm=%x\n", dc->rd, dc->ra, dc->rb, dc->imm); 422fcf5ef2aSThomas Huth if (dc->rd) 423cfeea807SEdgar E. Iglesias tcg_gen_or_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc))); 424fcf5ef2aSThomas Huth } 425fcf5ef2aSThomas Huth 426fcf5ef2aSThomas Huth static void dec_xor(DisasContext *dc) 427fcf5ef2aSThomas Huth { 428fcf5ef2aSThomas Huth if (!dc->type_b && (dc->imm & (1 << 10))) { 429fcf5ef2aSThomas Huth dec_pattern(dc); 430fcf5ef2aSThomas Huth return; 431fcf5ef2aSThomas Huth } 432fcf5ef2aSThomas Huth 433fcf5ef2aSThomas Huth LOG_DIS("xor r%d\n", dc->rd); 434fcf5ef2aSThomas Huth if (dc->rd) 435cfeea807SEdgar E. Iglesias tcg_gen_xor_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc))); 436fcf5ef2aSThomas Huth } 437fcf5ef2aSThomas Huth 438cfeea807SEdgar E. Iglesias static inline void msr_read(DisasContext *dc, TCGv_i32 d) 439fcf5ef2aSThomas Huth { 4400a22f8cfSEdgar E. Iglesias tcg_gen_extrl_i64_i32(d, cpu_SR[SR_MSR]); 441fcf5ef2aSThomas Huth } 442fcf5ef2aSThomas Huth 443cfeea807SEdgar E. Iglesias static inline void msr_write(DisasContext *dc, TCGv_i32 v) 444fcf5ef2aSThomas Huth { 4450a22f8cfSEdgar E. Iglesias TCGv_i64 t; 446fcf5ef2aSThomas Huth 4470a22f8cfSEdgar E. Iglesias t = tcg_temp_new_i64(); 448fcf5ef2aSThomas Huth dc->cpustate_changed = 1; 449fcf5ef2aSThomas Huth /* PVR bit is not writable. */ 4500a22f8cfSEdgar E. Iglesias tcg_gen_extu_i32_i64(t, v); 4510a22f8cfSEdgar E. Iglesias tcg_gen_andi_i64(t, t, ~MSR_PVR); 4520a22f8cfSEdgar E. Iglesias tcg_gen_andi_i64(cpu_SR[SR_MSR], cpu_SR[SR_MSR], MSR_PVR); 4530a22f8cfSEdgar E. Iglesias tcg_gen_or_i64(cpu_SR[SR_MSR], cpu_SR[SR_MSR], t); 4540a22f8cfSEdgar E. Iglesias tcg_temp_free_i64(t); 455fcf5ef2aSThomas Huth } 456fcf5ef2aSThomas Huth 457fcf5ef2aSThomas Huth static void dec_msr(DisasContext *dc) 458fcf5ef2aSThomas Huth { 459fcf5ef2aSThomas Huth CPUState *cs = CPU(dc->cpu); 460cfeea807SEdgar E. Iglesias TCGv_i32 t0, t1; 4612023e9a3SEdgar E. Iglesias unsigned int sr, rn; 462f0f7e7f7SEdgar E. Iglesias bool to, clrset, extended = false; 463fcf5ef2aSThomas Huth 4642023e9a3SEdgar E. Iglesias sr = extract32(dc->imm, 0, 14); 4652023e9a3SEdgar E. Iglesias to = extract32(dc->imm, 14, 1); 4662023e9a3SEdgar E. Iglesias clrset = extract32(dc->imm, 15, 1) == 0; 467fcf5ef2aSThomas Huth dc->type_b = 1; 4682023e9a3SEdgar E. Iglesias if (to) { 469fcf5ef2aSThomas Huth dc->cpustate_changed = 1; 470f0f7e7f7SEdgar E. Iglesias } 471f0f7e7f7SEdgar E. Iglesias 472f0f7e7f7SEdgar E. Iglesias /* Extended MSRs are only available if addr_size > 32. */ 473f0f7e7f7SEdgar E. Iglesias if (dc->cpu->cfg.addr_size > 32) { 474f0f7e7f7SEdgar E. Iglesias /* The E-bit is encoded differently for To/From MSR. */ 475f0f7e7f7SEdgar E. Iglesias static const unsigned int e_bit[] = { 19, 24 }; 476f0f7e7f7SEdgar E. Iglesias 477f0f7e7f7SEdgar E. Iglesias extended = extract32(dc->imm, e_bit[to], 1); 4782023e9a3SEdgar E. Iglesias } 479fcf5ef2aSThomas Huth 480fcf5ef2aSThomas Huth /* msrclr and msrset. */ 4812023e9a3SEdgar E. Iglesias if (clrset) { 4822023e9a3SEdgar E. Iglesias bool clr = extract32(dc->ir, 16, 1); 483fcf5ef2aSThomas Huth 484fcf5ef2aSThomas Huth LOG_DIS("msr%s r%d imm=%x\n", clr ? "clr" : "set", 485fcf5ef2aSThomas Huth dc->rd, dc->imm); 486fcf5ef2aSThomas Huth 48756837509SEdgar E. Iglesias if (!dc->cpu->cfg.use_msr_instr) { 488fcf5ef2aSThomas Huth /* nop??? */ 489fcf5ef2aSThomas Huth return; 490fcf5ef2aSThomas Huth } 491fcf5ef2aSThomas Huth 492bdfc1e88SEdgar E. Iglesias if (trap_userspace(dc, dc->imm != 4 && dc->imm != 0)) { 493fcf5ef2aSThomas Huth return; 494fcf5ef2aSThomas Huth } 495fcf5ef2aSThomas Huth 496fcf5ef2aSThomas Huth if (dc->rd) 497fcf5ef2aSThomas Huth msr_read(dc, cpu_R[dc->rd]); 498fcf5ef2aSThomas Huth 499cfeea807SEdgar E. Iglesias t0 = tcg_temp_new_i32(); 500cfeea807SEdgar E. Iglesias t1 = tcg_temp_new_i32(); 501fcf5ef2aSThomas Huth msr_read(dc, t0); 502cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(t1, *(dec_alu_op_b(dc))); 503fcf5ef2aSThomas Huth 504fcf5ef2aSThomas Huth if (clr) { 505cfeea807SEdgar E. Iglesias tcg_gen_not_i32(t1, t1); 506cfeea807SEdgar E. Iglesias tcg_gen_and_i32(t0, t0, t1); 507fcf5ef2aSThomas Huth } else 508cfeea807SEdgar E. Iglesias tcg_gen_or_i32(t0, t0, t1); 509fcf5ef2aSThomas Huth msr_write(dc, t0); 510cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t0); 511cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t1); 5120a22f8cfSEdgar E. Iglesias tcg_gen_movi_i64(cpu_SR[SR_PC], dc->pc + 4); 513fcf5ef2aSThomas Huth dc->is_jmp = DISAS_UPDATE; 514fcf5ef2aSThomas Huth return; 515fcf5ef2aSThomas Huth } 516fcf5ef2aSThomas Huth 517bdfc1e88SEdgar E. Iglesias if (trap_userspace(dc, to)) { 518fcf5ef2aSThomas Huth return; 519fcf5ef2aSThomas Huth } 520fcf5ef2aSThomas Huth 521fcf5ef2aSThomas Huth #if !defined(CONFIG_USER_ONLY) 522fcf5ef2aSThomas Huth /* Catch read/writes to the mmu block. */ 523fcf5ef2aSThomas Huth if ((sr & ~0xff) == 0x1000) { 524f0f7e7f7SEdgar E. Iglesias TCGv_i32 tmp_ext = tcg_const_i32(extended); 52505a9a651SEdgar E. Iglesias TCGv_i32 tmp_sr; 52605a9a651SEdgar E. Iglesias 527fcf5ef2aSThomas Huth sr &= 7; 52805a9a651SEdgar E. Iglesias tmp_sr = tcg_const_i32(sr); 529fcf5ef2aSThomas Huth LOG_DIS("m%ss sr%d r%d imm=%x\n", to ? "t" : "f", sr, dc->ra, dc->imm); 53005a9a651SEdgar E. Iglesias if (to) { 531f0f7e7f7SEdgar E. Iglesias gen_helper_mmu_write(cpu_env, tmp_ext, tmp_sr, cpu_R[dc->ra]); 53205a9a651SEdgar E. Iglesias } else { 533f0f7e7f7SEdgar E. Iglesias gen_helper_mmu_read(cpu_R[dc->rd], cpu_env, tmp_ext, tmp_sr); 53405a9a651SEdgar E. Iglesias } 53505a9a651SEdgar E. Iglesias tcg_temp_free_i32(tmp_sr); 536f0f7e7f7SEdgar E. Iglesias tcg_temp_free_i32(tmp_ext); 537fcf5ef2aSThomas Huth return; 538fcf5ef2aSThomas Huth } 539fcf5ef2aSThomas Huth #endif 540fcf5ef2aSThomas Huth 541fcf5ef2aSThomas Huth if (to) { 542fcf5ef2aSThomas Huth LOG_DIS("m%ss sr%x r%d imm=%x\n", to ? "t" : "f", sr, dc->ra, dc->imm); 543fcf5ef2aSThomas Huth switch (sr) { 544fcf5ef2aSThomas Huth case 0: 545fcf5ef2aSThomas Huth break; 546fcf5ef2aSThomas Huth case 1: 547fcf5ef2aSThomas Huth msr_write(dc, cpu_R[dc->ra]); 548fcf5ef2aSThomas Huth break; 549351527b7SEdgar E. Iglesias case SR_EAR: 550351527b7SEdgar E. Iglesias case SR_ESR: 551ab6dd380SEdgar E. Iglesias case SR_FSR: 5520a22f8cfSEdgar E. Iglesias tcg_gen_extu_i32_i64(cpu_SR[sr], cpu_R[dc->ra]); 553fcf5ef2aSThomas Huth break; 554fcf5ef2aSThomas Huth case 0x800: 555cfeea807SEdgar E. Iglesias tcg_gen_st_i32(cpu_R[dc->ra], 556cfeea807SEdgar E. Iglesias cpu_env, offsetof(CPUMBState, slr)); 557fcf5ef2aSThomas Huth break; 558fcf5ef2aSThomas Huth case 0x802: 559cfeea807SEdgar E. Iglesias tcg_gen_st_i32(cpu_R[dc->ra], 560cfeea807SEdgar E. Iglesias cpu_env, offsetof(CPUMBState, shr)); 561fcf5ef2aSThomas Huth break; 562fcf5ef2aSThomas Huth default: 563fcf5ef2aSThomas Huth cpu_abort(CPU(dc->cpu), "unknown mts reg %x\n", sr); 564fcf5ef2aSThomas Huth break; 565fcf5ef2aSThomas Huth } 566fcf5ef2aSThomas Huth } else { 567fcf5ef2aSThomas Huth LOG_DIS("m%ss r%d sr%x imm=%x\n", to ? "t" : "f", dc->rd, sr, dc->imm); 568fcf5ef2aSThomas Huth 569fcf5ef2aSThomas Huth switch (sr) { 570fcf5ef2aSThomas Huth case 0: 571cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_R[dc->rd], dc->pc); 572fcf5ef2aSThomas Huth break; 573fcf5ef2aSThomas Huth case 1: 574fcf5ef2aSThomas Huth msr_read(dc, cpu_R[dc->rd]); 575fcf5ef2aSThomas Huth break; 576351527b7SEdgar E. Iglesias case SR_EAR: 577a1b48e3aSEdgar E. Iglesias if (extended) { 578a1b48e3aSEdgar E. Iglesias tcg_gen_extrh_i64_i32(cpu_R[dc->rd], cpu_SR[sr]); 579a1b48e3aSEdgar E. Iglesias break; 580a1b48e3aSEdgar E. Iglesias } 581351527b7SEdgar E. Iglesias case SR_ESR: 582351527b7SEdgar E. Iglesias case SR_FSR: 583351527b7SEdgar E. Iglesias case SR_BTR: 5840a22f8cfSEdgar E. Iglesias tcg_gen_extrl_i64_i32(cpu_R[dc->rd], cpu_SR[sr]); 585fcf5ef2aSThomas Huth break; 586fcf5ef2aSThomas Huth case 0x800: 587cfeea807SEdgar E. Iglesias tcg_gen_ld_i32(cpu_R[dc->rd], 588cfeea807SEdgar E. Iglesias cpu_env, offsetof(CPUMBState, slr)); 589fcf5ef2aSThomas Huth break; 590fcf5ef2aSThomas Huth case 0x802: 591cfeea807SEdgar E. Iglesias tcg_gen_ld_i32(cpu_R[dc->rd], 592cfeea807SEdgar E. Iglesias cpu_env, offsetof(CPUMBState, shr)); 593fcf5ef2aSThomas Huth break; 594351527b7SEdgar E. Iglesias case 0x2000 ... 0x200c: 595fcf5ef2aSThomas Huth rn = sr & 0xf; 596cfeea807SEdgar E. Iglesias tcg_gen_ld_i32(cpu_R[dc->rd], 597fcf5ef2aSThomas Huth cpu_env, offsetof(CPUMBState, pvr.regs[rn])); 598fcf5ef2aSThomas Huth break; 599fcf5ef2aSThomas Huth default: 600fcf5ef2aSThomas Huth cpu_abort(cs, "unknown mfs reg %x\n", sr); 601fcf5ef2aSThomas Huth break; 602fcf5ef2aSThomas Huth } 603fcf5ef2aSThomas Huth } 604fcf5ef2aSThomas Huth 605fcf5ef2aSThomas Huth if (dc->rd == 0) { 606cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_R[0], 0); 607fcf5ef2aSThomas Huth } 608fcf5ef2aSThomas Huth } 609fcf5ef2aSThomas Huth 610fcf5ef2aSThomas Huth /* Multiplier unit. */ 611fcf5ef2aSThomas Huth static void dec_mul(DisasContext *dc) 612fcf5ef2aSThomas Huth { 613cfeea807SEdgar E. Iglesias TCGv_i32 tmp; 614fcf5ef2aSThomas Huth unsigned int subcode; 615fcf5ef2aSThomas Huth 6169ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, !dc->cpu->cfg.use_hw_mul)) { 617fcf5ef2aSThomas Huth return; 618fcf5ef2aSThomas Huth } 619fcf5ef2aSThomas Huth 620fcf5ef2aSThomas Huth subcode = dc->imm & 3; 621fcf5ef2aSThomas Huth 622fcf5ef2aSThomas Huth if (dc->type_b) { 623fcf5ef2aSThomas Huth LOG_DIS("muli r%d r%d %x\n", dc->rd, dc->ra, dc->imm); 624cfeea807SEdgar E. Iglesias tcg_gen_mul_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc))); 625fcf5ef2aSThomas Huth return; 626fcf5ef2aSThomas Huth } 627fcf5ef2aSThomas Huth 628fcf5ef2aSThomas Huth /* mulh, mulhsu and mulhu are not available if C_USE_HW_MUL is < 2. */ 6299b964318SEdgar E. Iglesias if (subcode >= 1 && subcode <= 3 && dc->cpu->cfg.use_hw_mul < 2) { 630fcf5ef2aSThomas Huth /* nop??? */ 631fcf5ef2aSThomas Huth } 632fcf5ef2aSThomas Huth 633cfeea807SEdgar E. Iglesias tmp = tcg_temp_new_i32(); 634fcf5ef2aSThomas Huth switch (subcode) { 635fcf5ef2aSThomas Huth case 0: 636fcf5ef2aSThomas Huth LOG_DIS("mul r%d r%d r%d\n", dc->rd, dc->ra, dc->rb); 637cfeea807SEdgar E. Iglesias tcg_gen_mul_i32(cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]); 638fcf5ef2aSThomas Huth break; 639fcf5ef2aSThomas Huth case 1: 640fcf5ef2aSThomas Huth LOG_DIS("mulh r%d r%d r%d\n", dc->rd, dc->ra, dc->rb); 641cfeea807SEdgar E. Iglesias tcg_gen_muls2_i32(tmp, cpu_R[dc->rd], 642cfeea807SEdgar E. Iglesias cpu_R[dc->ra], cpu_R[dc->rb]); 643fcf5ef2aSThomas Huth break; 644fcf5ef2aSThomas Huth case 2: 645fcf5ef2aSThomas Huth LOG_DIS("mulhsu r%d r%d r%d\n", dc->rd, dc->ra, dc->rb); 646cfeea807SEdgar E. Iglesias tcg_gen_mulsu2_i32(tmp, cpu_R[dc->rd], 647cfeea807SEdgar E. Iglesias cpu_R[dc->ra], cpu_R[dc->rb]); 648fcf5ef2aSThomas Huth break; 649fcf5ef2aSThomas Huth case 3: 650fcf5ef2aSThomas Huth LOG_DIS("mulhu r%d r%d r%d\n", dc->rd, dc->ra, dc->rb); 651cfeea807SEdgar E. Iglesias tcg_gen_mulu2_i32(tmp, cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]); 652fcf5ef2aSThomas Huth break; 653fcf5ef2aSThomas Huth default: 654fcf5ef2aSThomas Huth cpu_abort(CPU(dc->cpu), "unknown MUL insn %x\n", subcode); 655fcf5ef2aSThomas Huth break; 656fcf5ef2aSThomas Huth } 657cfeea807SEdgar E. Iglesias tcg_temp_free_i32(tmp); 658fcf5ef2aSThomas Huth } 659fcf5ef2aSThomas Huth 660fcf5ef2aSThomas Huth /* Div unit. */ 661fcf5ef2aSThomas Huth static void dec_div(DisasContext *dc) 662fcf5ef2aSThomas Huth { 663fcf5ef2aSThomas Huth unsigned int u; 664fcf5ef2aSThomas Huth 665fcf5ef2aSThomas Huth u = dc->imm & 2; 666fcf5ef2aSThomas Huth LOG_DIS("div\n"); 667fcf5ef2aSThomas Huth 6689ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, !dc->cpu->cfg.use_div)) { 6699ba8cd45SEdgar E. Iglesias return; 670fcf5ef2aSThomas Huth } 671fcf5ef2aSThomas Huth 672fcf5ef2aSThomas Huth if (u) 673fcf5ef2aSThomas Huth gen_helper_divu(cpu_R[dc->rd], cpu_env, *(dec_alu_op_b(dc)), 674fcf5ef2aSThomas Huth cpu_R[dc->ra]); 675fcf5ef2aSThomas Huth else 676fcf5ef2aSThomas Huth gen_helper_divs(cpu_R[dc->rd], cpu_env, *(dec_alu_op_b(dc)), 677fcf5ef2aSThomas Huth cpu_R[dc->ra]); 678fcf5ef2aSThomas Huth if (!dc->rd) 679cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_R[dc->rd], 0); 680fcf5ef2aSThomas Huth } 681fcf5ef2aSThomas Huth 682fcf5ef2aSThomas Huth static void dec_barrel(DisasContext *dc) 683fcf5ef2aSThomas Huth { 684cfeea807SEdgar E. Iglesias TCGv_i32 t0; 685faa48d74SEdgar E. Iglesias unsigned int imm_w, imm_s; 686d09b2585SEdgar E. Iglesias bool s, t, e = false, i = false; 687fcf5ef2aSThomas Huth 6889ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, !dc->cpu->cfg.use_barrel)) { 689fcf5ef2aSThomas Huth return; 690fcf5ef2aSThomas Huth } 691fcf5ef2aSThomas Huth 692faa48d74SEdgar E. Iglesias if (dc->type_b) { 693faa48d74SEdgar E. Iglesias /* Insert and extract are only available in immediate mode. */ 694d09b2585SEdgar E. Iglesias i = extract32(dc->imm, 15, 1); 695faa48d74SEdgar E. Iglesias e = extract32(dc->imm, 14, 1); 696faa48d74SEdgar E. Iglesias } 697e3e84983SEdgar E. Iglesias s = extract32(dc->imm, 10, 1); 698e3e84983SEdgar E. Iglesias t = extract32(dc->imm, 9, 1); 699faa48d74SEdgar E. Iglesias imm_w = extract32(dc->imm, 6, 5); 700faa48d74SEdgar E. Iglesias imm_s = extract32(dc->imm, 0, 5); 701fcf5ef2aSThomas Huth 702faa48d74SEdgar E. Iglesias LOG_DIS("bs%s%s%s r%d r%d r%d\n", 703faa48d74SEdgar E. Iglesias e ? "e" : "", 704fcf5ef2aSThomas Huth s ? "l" : "r", t ? "a" : "l", dc->rd, dc->ra, dc->rb); 705fcf5ef2aSThomas Huth 706faa48d74SEdgar E. Iglesias if (e) { 707faa48d74SEdgar E. Iglesias if (imm_w + imm_s > 32 || imm_w == 0) { 708faa48d74SEdgar E. Iglesias /* These inputs have an undefined behavior. */ 709faa48d74SEdgar E. Iglesias qemu_log_mask(LOG_GUEST_ERROR, "bsefi: Bad input w=%d s=%d\n", 710faa48d74SEdgar E. Iglesias imm_w, imm_s); 711faa48d74SEdgar E. Iglesias } else { 712faa48d74SEdgar E. Iglesias tcg_gen_extract_i32(cpu_R[dc->rd], cpu_R[dc->ra], imm_s, imm_w); 713faa48d74SEdgar E. Iglesias } 714d09b2585SEdgar E. Iglesias } else if (i) { 715d09b2585SEdgar E. Iglesias int width = imm_w - imm_s + 1; 716d09b2585SEdgar E. Iglesias 717d09b2585SEdgar E. Iglesias if (imm_w < imm_s) { 718d09b2585SEdgar E. Iglesias /* These inputs have an undefined behavior. */ 719d09b2585SEdgar E. Iglesias qemu_log_mask(LOG_GUEST_ERROR, "bsifi: Bad input w=%d s=%d\n", 720d09b2585SEdgar E. Iglesias imm_w, imm_s); 721d09b2585SEdgar E. Iglesias } else { 722d09b2585SEdgar E. Iglesias tcg_gen_deposit_i32(cpu_R[dc->rd], cpu_R[dc->rd], cpu_R[dc->ra], 723d09b2585SEdgar E. Iglesias imm_s, width); 724d09b2585SEdgar E. Iglesias } 725faa48d74SEdgar E. Iglesias } else { 726cfeea807SEdgar E. Iglesias t0 = tcg_temp_new_i32(); 727fcf5ef2aSThomas Huth 728cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(t0, *(dec_alu_op_b(dc))); 729cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t0, t0, 31); 730fcf5ef2aSThomas Huth 7312acf6d53SEdgar E. Iglesias if (s) { 732cfeea807SEdgar E. Iglesias tcg_gen_shl_i32(cpu_R[dc->rd], cpu_R[dc->ra], t0); 7332acf6d53SEdgar E. Iglesias } else { 7342acf6d53SEdgar E. Iglesias if (t) { 735cfeea807SEdgar E. Iglesias tcg_gen_sar_i32(cpu_R[dc->rd], cpu_R[dc->ra], t0); 7362acf6d53SEdgar E. Iglesias } else { 737cfeea807SEdgar E. Iglesias tcg_gen_shr_i32(cpu_R[dc->rd], cpu_R[dc->ra], t0); 738fcf5ef2aSThomas Huth } 739fcf5ef2aSThomas Huth } 740cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t0); 7412acf6d53SEdgar E. Iglesias } 742faa48d74SEdgar E. Iglesias } 743fcf5ef2aSThomas Huth 744fcf5ef2aSThomas Huth static void dec_bit(DisasContext *dc) 745fcf5ef2aSThomas Huth { 746fcf5ef2aSThomas Huth CPUState *cs = CPU(dc->cpu); 747cfeea807SEdgar E. Iglesias TCGv_i32 t0; 748fcf5ef2aSThomas Huth unsigned int op; 749fcf5ef2aSThomas Huth 750fcf5ef2aSThomas Huth op = dc->ir & ((1 << 9) - 1); 751fcf5ef2aSThomas Huth switch (op) { 752fcf5ef2aSThomas Huth case 0x21: 753fcf5ef2aSThomas Huth /* src. */ 754cfeea807SEdgar E. Iglesias t0 = tcg_temp_new_i32(); 755fcf5ef2aSThomas Huth 756fcf5ef2aSThomas Huth LOG_DIS("src r%d r%d\n", dc->rd, dc->ra); 7570a22f8cfSEdgar E. Iglesias tcg_gen_extrl_i64_i32(t0, cpu_SR[SR_MSR]); 7580a22f8cfSEdgar E. Iglesias tcg_gen_andi_i32(t0, t0, MSR_CC); 759fcf5ef2aSThomas Huth write_carry(dc, cpu_R[dc->ra]); 760fcf5ef2aSThomas Huth if (dc->rd) { 761cfeea807SEdgar E. Iglesias tcg_gen_shri_i32(cpu_R[dc->rd], cpu_R[dc->ra], 1); 762cfeea807SEdgar E. Iglesias tcg_gen_or_i32(cpu_R[dc->rd], cpu_R[dc->rd], t0); 763fcf5ef2aSThomas Huth } 764cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t0); 765fcf5ef2aSThomas Huth break; 766fcf5ef2aSThomas Huth 767fcf5ef2aSThomas Huth case 0x1: 768fcf5ef2aSThomas Huth case 0x41: 769fcf5ef2aSThomas Huth /* srl. */ 770fcf5ef2aSThomas Huth LOG_DIS("srl r%d r%d\n", dc->rd, dc->ra); 771fcf5ef2aSThomas Huth 772fcf5ef2aSThomas Huth /* Update carry. Note that write carry only looks at the LSB. */ 773fcf5ef2aSThomas Huth write_carry(dc, cpu_R[dc->ra]); 774fcf5ef2aSThomas Huth if (dc->rd) { 775fcf5ef2aSThomas Huth if (op == 0x41) 776cfeea807SEdgar E. Iglesias tcg_gen_shri_i32(cpu_R[dc->rd], cpu_R[dc->ra], 1); 777fcf5ef2aSThomas Huth else 778cfeea807SEdgar E. Iglesias tcg_gen_sari_i32(cpu_R[dc->rd], cpu_R[dc->ra], 1); 779fcf5ef2aSThomas Huth } 780fcf5ef2aSThomas Huth break; 781fcf5ef2aSThomas Huth case 0x60: 782fcf5ef2aSThomas Huth LOG_DIS("ext8s r%d r%d\n", dc->rd, dc->ra); 783fcf5ef2aSThomas Huth tcg_gen_ext8s_i32(cpu_R[dc->rd], cpu_R[dc->ra]); 784fcf5ef2aSThomas Huth break; 785fcf5ef2aSThomas Huth case 0x61: 786fcf5ef2aSThomas Huth LOG_DIS("ext16s r%d r%d\n", dc->rd, dc->ra); 787fcf5ef2aSThomas Huth tcg_gen_ext16s_i32(cpu_R[dc->rd], cpu_R[dc->ra]); 788fcf5ef2aSThomas Huth break; 789fcf5ef2aSThomas Huth case 0x64: 790fcf5ef2aSThomas Huth case 0x66: 791fcf5ef2aSThomas Huth case 0x74: 792fcf5ef2aSThomas Huth case 0x76: 793fcf5ef2aSThomas Huth /* wdc. */ 794fcf5ef2aSThomas Huth LOG_DIS("wdc r%d\n", dc->ra); 795bdfc1e88SEdgar E. Iglesias trap_userspace(dc, true); 796fcf5ef2aSThomas Huth break; 797fcf5ef2aSThomas Huth case 0x68: 798fcf5ef2aSThomas Huth /* wic. */ 799fcf5ef2aSThomas Huth LOG_DIS("wic r%d\n", dc->ra); 800bdfc1e88SEdgar E. Iglesias trap_userspace(dc, true); 801fcf5ef2aSThomas Huth break; 802fcf5ef2aSThomas Huth case 0xe0: 8039ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, !dc->cpu->cfg.use_pcmp_instr)) { 8049ba8cd45SEdgar E. Iglesias return; 805fcf5ef2aSThomas Huth } 8068fc5239eSEdgar E. Iglesias if (dc->cpu->cfg.use_pcmp_instr) { 8075318420cSRichard Henderson tcg_gen_clzi_i32(cpu_R[dc->rd], cpu_R[dc->ra], 32); 808fcf5ef2aSThomas Huth } 809fcf5ef2aSThomas Huth break; 810fcf5ef2aSThomas Huth case 0x1e0: 811fcf5ef2aSThomas Huth /* swapb */ 812fcf5ef2aSThomas Huth LOG_DIS("swapb r%d r%d\n", dc->rd, dc->ra); 813fcf5ef2aSThomas Huth tcg_gen_bswap32_i32(cpu_R[dc->rd], cpu_R[dc->ra]); 814fcf5ef2aSThomas Huth break; 815fcf5ef2aSThomas Huth case 0x1e2: 816fcf5ef2aSThomas Huth /*swaph */ 817fcf5ef2aSThomas Huth LOG_DIS("swaph r%d r%d\n", dc->rd, dc->ra); 818fcf5ef2aSThomas Huth tcg_gen_rotri_i32(cpu_R[dc->rd], cpu_R[dc->ra], 16); 819fcf5ef2aSThomas Huth break; 820fcf5ef2aSThomas Huth default: 821fcf5ef2aSThomas Huth cpu_abort(cs, "unknown bit oc=%x op=%x rd=%d ra=%d rb=%d\n", 822fcf5ef2aSThomas Huth dc->pc, op, dc->rd, dc->ra, dc->rb); 823fcf5ef2aSThomas Huth break; 824fcf5ef2aSThomas Huth } 825fcf5ef2aSThomas Huth } 826fcf5ef2aSThomas Huth 827fcf5ef2aSThomas Huth static inline void sync_jmpstate(DisasContext *dc) 828fcf5ef2aSThomas Huth { 829fcf5ef2aSThomas Huth if (dc->jmp == JMP_DIRECT || dc->jmp == JMP_DIRECT_CC) { 830fcf5ef2aSThomas Huth if (dc->jmp == JMP_DIRECT) { 831cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_btaken, 1); 832fcf5ef2aSThomas Huth } 833fcf5ef2aSThomas Huth dc->jmp = JMP_INDIRECT; 83443d318b2SEdgar E. Iglesias tcg_gen_movi_i64(env_btarget, dc->jmp_pc); 835fcf5ef2aSThomas Huth } 836fcf5ef2aSThomas Huth } 837fcf5ef2aSThomas Huth 838fcf5ef2aSThomas Huth static void dec_imm(DisasContext *dc) 839fcf5ef2aSThomas Huth { 840fcf5ef2aSThomas Huth LOG_DIS("imm %x\n", dc->imm << 16); 841cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_imm, (dc->imm << 16)); 842fcf5ef2aSThomas Huth dc->tb_flags |= IMM_FLAG; 843fcf5ef2aSThomas Huth dc->clear_imm = 0; 844fcf5ef2aSThomas Huth } 845fcf5ef2aSThomas Huth 846d248e1beSEdgar E. Iglesias static inline void compute_ldst_addr(DisasContext *dc, bool ea, TCGv t) 847fcf5ef2aSThomas Huth { 8480e9033c8SEdgar E. Iglesias bool extimm = dc->tb_flags & IMM_FLAG; 8490e9033c8SEdgar E. Iglesias /* Should be set to true if r1 is used by loadstores. */ 8500e9033c8SEdgar E. Iglesias bool stackprot = false; 851403322eaSEdgar E. Iglesias TCGv_i32 t32; 852fcf5ef2aSThomas Huth 853fcf5ef2aSThomas Huth /* All load/stores use ra. */ 854fcf5ef2aSThomas Huth if (dc->ra == 1 && dc->cpu->cfg.stackprot) { 8550e9033c8SEdgar E. Iglesias stackprot = true; 856fcf5ef2aSThomas Huth } 857fcf5ef2aSThomas Huth 858fcf5ef2aSThomas Huth /* Treat the common cases first. */ 859fcf5ef2aSThomas Huth if (!dc->type_b) { 860d248e1beSEdgar E. Iglesias if (ea) { 861d248e1beSEdgar E. Iglesias int addr_size = dc->cpu->cfg.addr_size; 862d248e1beSEdgar E. Iglesias 863d248e1beSEdgar E. Iglesias if (addr_size == 32) { 864d248e1beSEdgar E. Iglesias tcg_gen_extu_i32_tl(t, cpu_R[dc->rb]); 865d248e1beSEdgar E. Iglesias return; 866d248e1beSEdgar E. Iglesias } 867d248e1beSEdgar E. Iglesias 868d248e1beSEdgar E. Iglesias tcg_gen_concat_i32_i64(t, cpu_R[dc->rb], cpu_R[dc->ra]); 869d248e1beSEdgar E. Iglesias if (addr_size < 64) { 870d248e1beSEdgar E. Iglesias /* Mask off out of range bits. */ 871d248e1beSEdgar E. Iglesias tcg_gen_andi_i64(t, t, MAKE_64BIT_MASK(0, addr_size)); 872d248e1beSEdgar E. Iglesias } 873d248e1beSEdgar E. Iglesias return; 874d248e1beSEdgar E. Iglesias } 875d248e1beSEdgar E. Iglesias 8760dc4af5cSEdgar E. Iglesias /* If any of the regs is r0, set t to the value of the other reg. */ 877fcf5ef2aSThomas Huth if (dc->ra == 0) { 878403322eaSEdgar E. Iglesias tcg_gen_extu_i32_tl(t, cpu_R[dc->rb]); 8790dc4af5cSEdgar E. Iglesias return; 880fcf5ef2aSThomas Huth } else if (dc->rb == 0) { 881403322eaSEdgar E. Iglesias tcg_gen_extu_i32_tl(t, cpu_R[dc->ra]); 8820dc4af5cSEdgar E. Iglesias return; 883fcf5ef2aSThomas Huth } 884fcf5ef2aSThomas Huth 885fcf5ef2aSThomas Huth if (dc->rb == 1 && dc->cpu->cfg.stackprot) { 8860e9033c8SEdgar E. Iglesias stackprot = true; 887fcf5ef2aSThomas Huth } 888fcf5ef2aSThomas Huth 889403322eaSEdgar E. Iglesias t32 = tcg_temp_new_i32(); 890403322eaSEdgar E. Iglesias tcg_gen_add_i32(t32, cpu_R[dc->ra], cpu_R[dc->rb]); 891403322eaSEdgar E. Iglesias tcg_gen_extu_i32_tl(t, t32); 892403322eaSEdgar E. Iglesias tcg_temp_free_i32(t32); 893fcf5ef2aSThomas Huth 894fcf5ef2aSThomas Huth if (stackprot) { 8950a87e691SEdgar E. Iglesias gen_helper_stackprot(cpu_env, t); 896fcf5ef2aSThomas Huth } 8970dc4af5cSEdgar E. Iglesias return; 898fcf5ef2aSThomas Huth } 899fcf5ef2aSThomas Huth /* Immediate. */ 900403322eaSEdgar E. Iglesias t32 = tcg_temp_new_i32(); 901fcf5ef2aSThomas Huth if (!extimm) { 902f7a66e3aSEdgar E. Iglesias tcg_gen_addi_i32(t32, cpu_R[dc->ra], (int16_t)dc->imm); 903403322eaSEdgar E. Iglesias } else { 904403322eaSEdgar E. Iglesias tcg_gen_add_i32(t32, cpu_R[dc->ra], *(dec_alu_op_b(dc))); 905403322eaSEdgar E. Iglesias } 906403322eaSEdgar E. Iglesias tcg_gen_extu_i32_tl(t, t32); 907403322eaSEdgar E. Iglesias tcg_temp_free_i32(t32); 908fcf5ef2aSThomas Huth 909fcf5ef2aSThomas Huth if (stackprot) { 9100a87e691SEdgar E. Iglesias gen_helper_stackprot(cpu_env, t); 911fcf5ef2aSThomas Huth } 9120dc4af5cSEdgar E. Iglesias return; 913fcf5ef2aSThomas Huth } 914fcf5ef2aSThomas Huth 915fcf5ef2aSThomas Huth static void dec_load(DisasContext *dc) 916fcf5ef2aSThomas Huth { 917403322eaSEdgar E. Iglesias TCGv_i32 v; 918403322eaSEdgar E. Iglesias TCGv addr; 9198534063aSEdgar E. Iglesias unsigned int size; 920d248e1beSEdgar E. Iglesias bool rev = false, ex = false, ea = false; 921d248e1beSEdgar E. Iglesias int mem_index = cpu_mmu_index(&dc->cpu->env, false); 92214776ab5STony Nguyen MemOp mop; 923fcf5ef2aSThomas Huth 924fcf5ef2aSThomas Huth mop = dc->opcode & 3; 925fcf5ef2aSThomas Huth size = 1 << mop; 926fcf5ef2aSThomas Huth if (!dc->type_b) { 927d248e1beSEdgar E. Iglesias ea = extract32(dc->ir, 7, 1); 9288534063aSEdgar E. Iglesias rev = extract32(dc->ir, 9, 1); 9298534063aSEdgar E. Iglesias ex = extract32(dc->ir, 10, 1); 930fcf5ef2aSThomas Huth } 931fcf5ef2aSThomas Huth mop |= MO_TE; 932fcf5ef2aSThomas Huth if (rev) { 933fcf5ef2aSThomas Huth mop ^= MO_BSWAP; 934fcf5ef2aSThomas Huth } 935fcf5ef2aSThomas Huth 9369ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, size > 4)) { 937fcf5ef2aSThomas Huth return; 938fcf5ef2aSThomas Huth } 939fcf5ef2aSThomas Huth 940d248e1beSEdgar E. Iglesias if (trap_userspace(dc, ea)) { 941d248e1beSEdgar E. Iglesias return; 942d248e1beSEdgar E. Iglesias } 943d248e1beSEdgar E. Iglesias 944d248e1beSEdgar E. Iglesias LOG_DIS("l%d%s%s%s%s\n", size, dc->type_b ? "i" : "", rev ? "r" : "", 945d248e1beSEdgar E. Iglesias ex ? "x" : "", 946d248e1beSEdgar E. Iglesias ea ? "ea" : ""); 947fcf5ef2aSThomas Huth 948fcf5ef2aSThomas Huth t_sync_flags(dc); 949403322eaSEdgar E. Iglesias addr = tcg_temp_new(); 950d248e1beSEdgar E. Iglesias compute_ldst_addr(dc, ea, addr); 951d248e1beSEdgar E. Iglesias /* Extended addressing bypasses the MMU. */ 952d248e1beSEdgar E. Iglesias mem_index = ea ? MMU_NOMMU_IDX : mem_index; 953fcf5ef2aSThomas Huth 954fcf5ef2aSThomas Huth /* 955fcf5ef2aSThomas Huth * When doing reverse accesses we need to do two things. 956fcf5ef2aSThomas Huth * 957fcf5ef2aSThomas Huth * 1. Reverse the address wrt endianness. 958fcf5ef2aSThomas Huth * 2. Byteswap the data lanes on the way back into the CPU core. 959fcf5ef2aSThomas Huth */ 960fcf5ef2aSThomas Huth if (rev && size != 4) { 961fcf5ef2aSThomas Huth /* Endian reverse the address. t is addr. */ 962fcf5ef2aSThomas Huth switch (size) { 963fcf5ef2aSThomas Huth case 1: 964fcf5ef2aSThomas Huth { 965a6338015SEdgar E. Iglesias tcg_gen_xori_tl(addr, addr, 3); 966fcf5ef2aSThomas Huth break; 967fcf5ef2aSThomas Huth } 968fcf5ef2aSThomas Huth 969fcf5ef2aSThomas Huth case 2: 970fcf5ef2aSThomas Huth /* 00 -> 10 971fcf5ef2aSThomas Huth 10 -> 00. */ 972403322eaSEdgar E. Iglesias tcg_gen_xori_tl(addr, addr, 2); 973fcf5ef2aSThomas Huth break; 974fcf5ef2aSThomas Huth default: 975fcf5ef2aSThomas Huth cpu_abort(CPU(dc->cpu), "Invalid reverse size\n"); 976fcf5ef2aSThomas Huth break; 977fcf5ef2aSThomas Huth } 978fcf5ef2aSThomas Huth } 979fcf5ef2aSThomas Huth 980fcf5ef2aSThomas Huth /* lwx does not throw unaligned access errors, so force alignment */ 981fcf5ef2aSThomas Huth if (ex) { 982403322eaSEdgar E. Iglesias tcg_gen_andi_tl(addr, addr, ~3); 983fcf5ef2aSThomas Huth } 984fcf5ef2aSThomas Huth 985fcf5ef2aSThomas Huth /* If we get a fault on a dslot, the jmpstate better be in sync. */ 986fcf5ef2aSThomas Huth sync_jmpstate(dc); 987fcf5ef2aSThomas Huth 988fcf5ef2aSThomas Huth /* Verify alignment if needed. */ 989fcf5ef2aSThomas Huth /* 990fcf5ef2aSThomas Huth * Microblaze gives MMU faults priority over faults due to 991fcf5ef2aSThomas Huth * unaligned addresses. That's why we speculatively do the load 992fcf5ef2aSThomas Huth * into v. If the load succeeds, we verify alignment of the 993fcf5ef2aSThomas Huth * address and if that succeeds we write into the destination reg. 994fcf5ef2aSThomas Huth */ 995cfeea807SEdgar E. Iglesias v = tcg_temp_new_i32(); 996d248e1beSEdgar E. Iglesias tcg_gen_qemu_ld_i32(v, addr, mem_index, mop); 997fcf5ef2aSThomas Huth 998fcf5ef2aSThomas Huth if ((dc->cpu->env.pvr.regs[2] & PVR2_UNALIGNED_EXC_MASK) && size > 1) { 999a6338015SEdgar E. Iglesias TCGv_i32 t0 = tcg_const_i32(0); 1000a6338015SEdgar E. Iglesias TCGv_i32 treg = tcg_const_i32(dc->rd); 1001a6338015SEdgar E. Iglesias TCGv_i32 tsize = tcg_const_i32(size - 1); 1002a6338015SEdgar E. Iglesias 10030a22f8cfSEdgar E. Iglesias tcg_gen_movi_i64(cpu_SR[SR_PC], dc->pc); 1004a6338015SEdgar E. Iglesias gen_helper_memalign(cpu_env, addr, treg, t0, tsize); 1005a6338015SEdgar E. Iglesias 1006a6338015SEdgar E. Iglesias tcg_temp_free_i32(t0); 1007a6338015SEdgar E. Iglesias tcg_temp_free_i32(treg); 1008a6338015SEdgar E. Iglesias tcg_temp_free_i32(tsize); 1009fcf5ef2aSThomas Huth } 1010fcf5ef2aSThomas Huth 1011fcf5ef2aSThomas Huth if (ex) { 1012403322eaSEdgar E. Iglesias tcg_gen_mov_tl(env_res_addr, addr); 1013cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(env_res_val, v); 1014fcf5ef2aSThomas Huth } 1015fcf5ef2aSThomas Huth if (dc->rd) { 1016cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(cpu_R[dc->rd], v); 1017fcf5ef2aSThomas Huth } 1018cfeea807SEdgar E. Iglesias tcg_temp_free_i32(v); 1019fcf5ef2aSThomas Huth 1020fcf5ef2aSThomas Huth if (ex) { /* lwx */ 1021fcf5ef2aSThomas Huth /* no support for AXI exclusive so always clear C */ 1022fcf5ef2aSThomas Huth write_carryi(dc, 0); 1023fcf5ef2aSThomas Huth } 1024fcf5ef2aSThomas Huth 1025403322eaSEdgar E. Iglesias tcg_temp_free(addr); 1026fcf5ef2aSThomas Huth } 1027fcf5ef2aSThomas Huth 1028fcf5ef2aSThomas Huth static void dec_store(DisasContext *dc) 1029fcf5ef2aSThomas Huth { 1030403322eaSEdgar E. Iglesias TCGv addr; 1031fcf5ef2aSThomas Huth TCGLabel *swx_skip = NULL; 1032b51b3d43SEdgar E. Iglesias unsigned int size; 1033d248e1beSEdgar E. Iglesias bool rev = false, ex = false, ea = false; 1034d248e1beSEdgar E. Iglesias int mem_index = cpu_mmu_index(&dc->cpu->env, false); 103514776ab5STony Nguyen MemOp mop; 1036fcf5ef2aSThomas Huth 1037fcf5ef2aSThomas Huth mop = dc->opcode & 3; 1038fcf5ef2aSThomas Huth size = 1 << mop; 1039fcf5ef2aSThomas Huth if (!dc->type_b) { 1040d248e1beSEdgar E. Iglesias ea = extract32(dc->ir, 7, 1); 1041b51b3d43SEdgar E. Iglesias rev = extract32(dc->ir, 9, 1); 1042b51b3d43SEdgar E. Iglesias ex = extract32(dc->ir, 10, 1); 1043fcf5ef2aSThomas Huth } 1044fcf5ef2aSThomas Huth mop |= MO_TE; 1045fcf5ef2aSThomas Huth if (rev) { 1046fcf5ef2aSThomas Huth mop ^= MO_BSWAP; 1047fcf5ef2aSThomas Huth } 1048fcf5ef2aSThomas Huth 10499ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, size > 4)) { 1050fcf5ef2aSThomas Huth return; 1051fcf5ef2aSThomas Huth } 1052fcf5ef2aSThomas Huth 1053d248e1beSEdgar E. Iglesias trap_userspace(dc, ea); 1054d248e1beSEdgar E. Iglesias 1055d248e1beSEdgar E. Iglesias LOG_DIS("s%d%s%s%s%s\n", size, dc->type_b ? "i" : "", rev ? "r" : "", 1056d248e1beSEdgar E. Iglesias ex ? "x" : "", 1057d248e1beSEdgar E. Iglesias ea ? "ea" : ""); 1058fcf5ef2aSThomas Huth t_sync_flags(dc); 1059fcf5ef2aSThomas Huth /* If we get a fault on a dslot, the jmpstate better be in sync. */ 1060fcf5ef2aSThomas Huth sync_jmpstate(dc); 10610dc4af5cSEdgar E. Iglesias /* SWX needs a temp_local. */ 1062403322eaSEdgar E. Iglesias addr = ex ? tcg_temp_local_new() : tcg_temp_new(); 1063d248e1beSEdgar E. Iglesias compute_ldst_addr(dc, ea, addr); 1064d248e1beSEdgar E. Iglesias /* Extended addressing bypasses the MMU. */ 1065d248e1beSEdgar E. Iglesias mem_index = ea ? MMU_NOMMU_IDX : mem_index; 1066fcf5ef2aSThomas Huth 1067fcf5ef2aSThomas Huth if (ex) { /* swx */ 1068cfeea807SEdgar E. Iglesias TCGv_i32 tval; 1069fcf5ef2aSThomas Huth 1070fcf5ef2aSThomas Huth /* swx does not throw unaligned access errors, so force alignment */ 1071403322eaSEdgar E. Iglesias tcg_gen_andi_tl(addr, addr, ~3); 1072fcf5ef2aSThomas Huth 1073fcf5ef2aSThomas Huth write_carryi(dc, 1); 1074fcf5ef2aSThomas Huth swx_skip = gen_new_label(); 1075403322eaSEdgar E. Iglesias tcg_gen_brcond_tl(TCG_COND_NE, env_res_addr, addr, swx_skip); 1076fcf5ef2aSThomas Huth 1077fcf5ef2aSThomas Huth /* Compare the value loaded at lwx with current contents of 1078fcf5ef2aSThomas Huth the reserved location. 1079fcf5ef2aSThomas Huth FIXME: This only works for system emulation where we can expect 1080fcf5ef2aSThomas Huth this compare and the following write to be atomic. For user 1081fcf5ef2aSThomas Huth emulation we need to add atomicity between threads. */ 1082cfeea807SEdgar E. Iglesias tval = tcg_temp_new_i32(); 10830dc4af5cSEdgar E. Iglesias tcg_gen_qemu_ld_i32(tval, addr, cpu_mmu_index(&dc->cpu->env, false), 1084fcf5ef2aSThomas Huth MO_TEUL); 1085cfeea807SEdgar E. Iglesias tcg_gen_brcond_i32(TCG_COND_NE, env_res_val, tval, swx_skip); 1086fcf5ef2aSThomas Huth write_carryi(dc, 0); 1087cfeea807SEdgar E. Iglesias tcg_temp_free_i32(tval); 1088fcf5ef2aSThomas Huth } 1089fcf5ef2aSThomas Huth 1090fcf5ef2aSThomas Huth if (rev && size != 4) { 1091fcf5ef2aSThomas Huth /* Endian reverse the address. t is addr. */ 1092fcf5ef2aSThomas Huth switch (size) { 1093fcf5ef2aSThomas Huth case 1: 1094fcf5ef2aSThomas Huth { 1095a6338015SEdgar E. Iglesias tcg_gen_xori_tl(addr, addr, 3); 1096fcf5ef2aSThomas Huth break; 1097fcf5ef2aSThomas Huth } 1098fcf5ef2aSThomas Huth 1099fcf5ef2aSThomas Huth case 2: 1100fcf5ef2aSThomas Huth /* 00 -> 10 1101fcf5ef2aSThomas Huth 10 -> 00. */ 1102fcf5ef2aSThomas Huth /* Force addr into the temp. */ 1103403322eaSEdgar E. Iglesias tcg_gen_xori_tl(addr, addr, 2); 1104fcf5ef2aSThomas Huth break; 1105fcf5ef2aSThomas Huth default: 1106fcf5ef2aSThomas Huth cpu_abort(CPU(dc->cpu), "Invalid reverse size\n"); 1107fcf5ef2aSThomas Huth break; 1108fcf5ef2aSThomas Huth } 1109fcf5ef2aSThomas Huth } 1110d248e1beSEdgar E. Iglesias tcg_gen_qemu_st_i32(cpu_R[dc->rd], addr, mem_index, mop); 1111fcf5ef2aSThomas Huth 1112fcf5ef2aSThomas Huth /* Verify alignment if needed. */ 1113fcf5ef2aSThomas Huth if ((dc->cpu->env.pvr.regs[2] & PVR2_UNALIGNED_EXC_MASK) && size > 1) { 1114a6338015SEdgar E. Iglesias TCGv_i32 t1 = tcg_const_i32(1); 1115a6338015SEdgar E. Iglesias TCGv_i32 treg = tcg_const_i32(dc->rd); 1116a6338015SEdgar E. Iglesias TCGv_i32 tsize = tcg_const_i32(size - 1); 1117a6338015SEdgar E. Iglesias 11180a22f8cfSEdgar E. Iglesias tcg_gen_movi_i64(cpu_SR[SR_PC], dc->pc); 1119fcf5ef2aSThomas Huth /* FIXME: if the alignment is wrong, we should restore the value 1120fcf5ef2aSThomas Huth * in memory. One possible way to achieve this is to probe 1121fcf5ef2aSThomas Huth * the MMU prior to the memaccess, thay way we could put 1122fcf5ef2aSThomas Huth * the alignment checks in between the probe and the mem 1123fcf5ef2aSThomas Huth * access. 1124fcf5ef2aSThomas Huth */ 1125a6338015SEdgar E. Iglesias gen_helper_memalign(cpu_env, addr, treg, t1, tsize); 1126a6338015SEdgar E. Iglesias 1127a6338015SEdgar E. Iglesias tcg_temp_free_i32(t1); 1128a6338015SEdgar E. Iglesias tcg_temp_free_i32(treg); 1129a6338015SEdgar E. Iglesias tcg_temp_free_i32(tsize); 1130fcf5ef2aSThomas Huth } 1131fcf5ef2aSThomas Huth 1132fcf5ef2aSThomas Huth if (ex) { 1133fcf5ef2aSThomas Huth gen_set_label(swx_skip); 1134fcf5ef2aSThomas Huth } 1135fcf5ef2aSThomas Huth 1136403322eaSEdgar E. Iglesias tcg_temp_free(addr); 1137fcf5ef2aSThomas Huth } 1138fcf5ef2aSThomas Huth 1139fcf5ef2aSThomas Huth static inline void eval_cc(DisasContext *dc, unsigned int cc, 11409e6e1828SEdgar E. Iglesias TCGv_i32 d, TCGv_i32 a) 1141fcf5ef2aSThomas Huth { 1142d89b86e9SEdgar E. Iglesias static const int mb_to_tcg_cc[] = { 1143d89b86e9SEdgar E. Iglesias [CC_EQ] = TCG_COND_EQ, 1144d89b86e9SEdgar E. Iglesias [CC_NE] = TCG_COND_NE, 1145d89b86e9SEdgar E. Iglesias [CC_LT] = TCG_COND_LT, 1146d89b86e9SEdgar E. Iglesias [CC_LE] = TCG_COND_LE, 1147d89b86e9SEdgar E. Iglesias [CC_GE] = TCG_COND_GE, 1148d89b86e9SEdgar E. Iglesias [CC_GT] = TCG_COND_GT, 1149d89b86e9SEdgar E. Iglesias }; 1150d89b86e9SEdgar E. Iglesias 1151fcf5ef2aSThomas Huth switch (cc) { 1152fcf5ef2aSThomas Huth case CC_EQ: 1153fcf5ef2aSThomas Huth case CC_NE: 1154fcf5ef2aSThomas Huth case CC_LT: 1155fcf5ef2aSThomas Huth case CC_LE: 1156fcf5ef2aSThomas Huth case CC_GE: 1157fcf5ef2aSThomas Huth case CC_GT: 11589e6e1828SEdgar E. Iglesias tcg_gen_setcondi_i32(mb_to_tcg_cc[cc], d, a, 0); 1159fcf5ef2aSThomas Huth break; 1160fcf5ef2aSThomas Huth default: 1161fcf5ef2aSThomas Huth cpu_abort(CPU(dc->cpu), "Unknown condition code %x.\n", cc); 1162fcf5ef2aSThomas Huth break; 1163fcf5ef2aSThomas Huth } 1164fcf5ef2aSThomas Huth } 1165fcf5ef2aSThomas Huth 116643d318b2SEdgar E. Iglesias static void eval_cond_jmp(DisasContext *dc, TCGv_i64 pc_true, TCGv_i64 pc_false) 1167fcf5ef2aSThomas Huth { 1168e956caf2SEdgar E. Iglesias TCGv_i64 tmp_btaken = tcg_temp_new_i64(); 1169e956caf2SEdgar E. Iglesias TCGv_i64 tmp_zero = tcg_const_i64(0); 1170e956caf2SEdgar E. Iglesias 1171e956caf2SEdgar E. Iglesias tcg_gen_extu_i32_i64(tmp_btaken, env_btaken); 1172e956caf2SEdgar E. Iglesias tcg_gen_movcond_i64(TCG_COND_NE, cpu_SR[SR_PC], 1173e956caf2SEdgar E. Iglesias tmp_btaken, tmp_zero, 1174e956caf2SEdgar E. Iglesias pc_true, pc_false); 1175e956caf2SEdgar E. Iglesias 1176e956caf2SEdgar E. Iglesias tcg_temp_free_i64(tmp_btaken); 1177e956caf2SEdgar E. Iglesias tcg_temp_free_i64(tmp_zero); 1178fcf5ef2aSThomas Huth } 1179fcf5ef2aSThomas Huth 1180f91c60f0SEdgar E. Iglesias static void dec_setup_dslot(DisasContext *dc) 1181f91c60f0SEdgar E. Iglesias { 1182f91c60f0SEdgar E. Iglesias TCGv_i32 tmp = tcg_const_i32(dc->type_b && (dc->tb_flags & IMM_FLAG)); 1183f91c60f0SEdgar E. Iglesias 1184f91c60f0SEdgar E. Iglesias dc->delayed_branch = 2; 1185f91c60f0SEdgar E. Iglesias dc->tb_flags |= D_FLAG; 1186f91c60f0SEdgar E. Iglesias 1187f91c60f0SEdgar E. Iglesias tcg_gen_st_i32(tmp, cpu_env, offsetof(CPUMBState, bimm)); 1188f91c60f0SEdgar E. Iglesias tcg_temp_free_i32(tmp); 1189f91c60f0SEdgar E. Iglesias } 1190f91c60f0SEdgar E. Iglesias 1191fcf5ef2aSThomas Huth static void dec_bcc(DisasContext *dc) 1192fcf5ef2aSThomas Huth { 1193fcf5ef2aSThomas Huth unsigned int cc; 1194fcf5ef2aSThomas Huth unsigned int dslot; 1195fcf5ef2aSThomas Huth 1196fcf5ef2aSThomas Huth cc = EXTRACT_FIELD(dc->ir, 21, 23); 1197fcf5ef2aSThomas Huth dslot = dc->ir & (1 << 25); 1198fcf5ef2aSThomas Huth LOG_DIS("bcc%s r%d %x\n", dslot ? "d" : "", dc->ra, dc->imm); 1199fcf5ef2aSThomas Huth 1200fcf5ef2aSThomas Huth dc->delayed_branch = 1; 1201fcf5ef2aSThomas Huth if (dslot) { 1202f91c60f0SEdgar E. Iglesias dec_setup_dslot(dc); 1203fcf5ef2aSThomas Huth } 1204fcf5ef2aSThomas Huth 1205fcf5ef2aSThomas Huth if (dec_alu_op_b_is_small_imm(dc)) { 1206fcf5ef2aSThomas Huth int32_t offset = (int32_t)((int16_t)dc->imm); /* sign-extend. */ 1207fcf5ef2aSThomas Huth 120843d318b2SEdgar E. Iglesias tcg_gen_movi_i64(env_btarget, dc->pc + offset); 1209fcf5ef2aSThomas Huth dc->jmp = JMP_DIRECT_CC; 1210fcf5ef2aSThomas Huth dc->jmp_pc = dc->pc + offset; 1211fcf5ef2aSThomas Huth } else { 1212fcf5ef2aSThomas Huth dc->jmp = JMP_INDIRECT; 121343d318b2SEdgar E. Iglesias tcg_gen_extu_i32_i64(env_btarget, *(dec_alu_op_b(dc))); 121443d318b2SEdgar E. Iglesias tcg_gen_addi_i64(env_btarget, env_btarget, dc->pc); 121543d318b2SEdgar E. Iglesias tcg_gen_andi_i64(env_btarget, env_btarget, UINT32_MAX); 1216fcf5ef2aSThomas Huth } 12179e6e1828SEdgar E. Iglesias eval_cc(dc, cc, env_btaken, cpu_R[dc->ra]); 1218fcf5ef2aSThomas Huth } 1219fcf5ef2aSThomas Huth 1220fcf5ef2aSThomas Huth static void dec_br(DisasContext *dc) 1221fcf5ef2aSThomas Huth { 1222fcf5ef2aSThomas Huth unsigned int dslot, link, abs, mbar; 1223fcf5ef2aSThomas Huth 1224fcf5ef2aSThomas Huth dslot = dc->ir & (1 << 20); 1225fcf5ef2aSThomas Huth abs = dc->ir & (1 << 19); 1226fcf5ef2aSThomas Huth link = dc->ir & (1 << 18); 1227fcf5ef2aSThomas Huth 1228fcf5ef2aSThomas Huth /* Memory barrier. */ 1229fcf5ef2aSThomas Huth mbar = (dc->ir >> 16) & 31; 1230fcf5ef2aSThomas Huth if (mbar == 2 && dc->imm == 4) { 1231fcf5ef2aSThomas Huth /* mbar IMM & 16 decodes to sleep. */ 1232fcf5ef2aSThomas Huth if (dc->rd & 16) { 1233fcf5ef2aSThomas Huth TCGv_i32 tmp_hlt = tcg_const_i32(EXCP_HLT); 1234fcf5ef2aSThomas Huth TCGv_i32 tmp_1 = tcg_const_i32(1); 1235fcf5ef2aSThomas Huth 1236fcf5ef2aSThomas Huth LOG_DIS("sleep\n"); 1237fcf5ef2aSThomas Huth 1238fcf5ef2aSThomas Huth t_sync_flags(dc); 1239fcf5ef2aSThomas Huth tcg_gen_st_i32(tmp_1, cpu_env, 1240fcf5ef2aSThomas Huth -offsetof(MicroBlazeCPU, env) 1241fcf5ef2aSThomas Huth +offsetof(CPUState, halted)); 12420a22f8cfSEdgar E. Iglesias tcg_gen_movi_i64(cpu_SR[SR_PC], dc->pc + 4); 1243fcf5ef2aSThomas Huth gen_helper_raise_exception(cpu_env, tmp_hlt); 1244fcf5ef2aSThomas Huth tcg_temp_free_i32(tmp_hlt); 1245fcf5ef2aSThomas Huth tcg_temp_free_i32(tmp_1); 1246fcf5ef2aSThomas Huth return; 1247fcf5ef2aSThomas Huth } 1248fcf5ef2aSThomas Huth LOG_DIS("mbar %d\n", dc->rd); 1249fcf5ef2aSThomas Huth /* Break the TB. */ 1250fcf5ef2aSThomas Huth dc->cpustate_changed = 1; 1251fcf5ef2aSThomas Huth return; 1252fcf5ef2aSThomas Huth } 1253fcf5ef2aSThomas Huth 1254fcf5ef2aSThomas Huth LOG_DIS("br%s%s%s%s imm=%x\n", 1255fcf5ef2aSThomas Huth abs ? "a" : "", link ? "l" : "", 1256fcf5ef2aSThomas Huth dc->type_b ? "i" : "", dslot ? "d" : "", 1257fcf5ef2aSThomas Huth dc->imm); 1258fcf5ef2aSThomas Huth 1259fcf5ef2aSThomas Huth dc->delayed_branch = 1; 1260fcf5ef2aSThomas Huth if (dslot) { 1261f91c60f0SEdgar E. Iglesias dec_setup_dslot(dc); 1262fcf5ef2aSThomas Huth } 1263fcf5ef2aSThomas Huth if (link && dc->rd) 1264cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_R[dc->rd], dc->pc); 1265fcf5ef2aSThomas Huth 1266fcf5ef2aSThomas Huth dc->jmp = JMP_INDIRECT; 1267fcf5ef2aSThomas Huth if (abs) { 1268cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_btaken, 1); 126943d318b2SEdgar E. Iglesias tcg_gen_extu_i32_i64(env_btarget, *(dec_alu_op_b(dc))); 1270fcf5ef2aSThomas Huth if (link && !dslot) { 1271fcf5ef2aSThomas Huth if (!(dc->tb_flags & IMM_FLAG) && (dc->imm == 8 || dc->imm == 0x18)) 1272fcf5ef2aSThomas Huth t_gen_raise_exception(dc, EXCP_BREAK); 1273fcf5ef2aSThomas Huth if (dc->imm == 0) { 1274bdfc1e88SEdgar E. Iglesias if (trap_userspace(dc, true)) { 1275fcf5ef2aSThomas Huth return; 1276fcf5ef2aSThomas Huth } 1277fcf5ef2aSThomas Huth 1278fcf5ef2aSThomas Huth t_gen_raise_exception(dc, EXCP_DEBUG); 1279fcf5ef2aSThomas Huth } 1280fcf5ef2aSThomas Huth } 1281fcf5ef2aSThomas Huth } else { 1282fcf5ef2aSThomas Huth if (dec_alu_op_b_is_small_imm(dc)) { 1283fcf5ef2aSThomas Huth dc->jmp = JMP_DIRECT; 1284fcf5ef2aSThomas Huth dc->jmp_pc = dc->pc + (int32_t)((int16_t)dc->imm); 1285fcf5ef2aSThomas Huth } else { 1286cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_btaken, 1); 128743d318b2SEdgar E. Iglesias tcg_gen_extu_i32_i64(env_btarget, *(dec_alu_op_b(dc))); 128843d318b2SEdgar E. Iglesias tcg_gen_addi_i64(env_btarget, env_btarget, dc->pc); 128943d318b2SEdgar E. Iglesias tcg_gen_andi_i64(env_btarget, env_btarget, UINT32_MAX); 1290fcf5ef2aSThomas Huth } 1291fcf5ef2aSThomas Huth } 1292fcf5ef2aSThomas Huth } 1293fcf5ef2aSThomas Huth 1294fcf5ef2aSThomas Huth static inline void do_rti(DisasContext *dc) 1295fcf5ef2aSThomas Huth { 1296cfeea807SEdgar E. Iglesias TCGv_i32 t0, t1; 1297cfeea807SEdgar E. Iglesias t0 = tcg_temp_new_i32(); 1298cfeea807SEdgar E. Iglesias t1 = tcg_temp_new_i32(); 12990a22f8cfSEdgar E. Iglesias tcg_gen_extrl_i64_i32(t1, cpu_SR[SR_MSR]); 13000a22f8cfSEdgar E. Iglesias tcg_gen_shri_i32(t0, t1, 1); 13010a22f8cfSEdgar E. Iglesias tcg_gen_ori_i32(t1, t1, MSR_IE); 1302cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t0, t0, (MSR_VM | MSR_UM)); 1303fcf5ef2aSThomas Huth 1304cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t1, t1, ~(MSR_VM | MSR_UM)); 1305cfeea807SEdgar E. Iglesias tcg_gen_or_i32(t1, t1, t0); 1306fcf5ef2aSThomas Huth msr_write(dc, t1); 1307cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t1); 1308cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t0); 1309fcf5ef2aSThomas Huth dc->tb_flags &= ~DRTI_FLAG; 1310fcf5ef2aSThomas Huth } 1311fcf5ef2aSThomas Huth 1312fcf5ef2aSThomas Huth static inline void do_rtb(DisasContext *dc) 1313fcf5ef2aSThomas Huth { 1314cfeea807SEdgar E. Iglesias TCGv_i32 t0, t1; 1315cfeea807SEdgar E. Iglesias t0 = tcg_temp_new_i32(); 1316cfeea807SEdgar E. Iglesias t1 = tcg_temp_new_i32(); 13170a22f8cfSEdgar E. Iglesias tcg_gen_extrl_i64_i32(t1, cpu_SR[SR_MSR]); 13180a22f8cfSEdgar E. Iglesias tcg_gen_andi_i32(t1, t1, ~MSR_BIP); 1319cfeea807SEdgar E. Iglesias tcg_gen_shri_i32(t0, t1, 1); 1320cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t0, t0, (MSR_VM | MSR_UM)); 1321fcf5ef2aSThomas Huth 1322cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t1, t1, ~(MSR_VM | MSR_UM)); 1323cfeea807SEdgar E. Iglesias tcg_gen_or_i32(t1, t1, t0); 1324fcf5ef2aSThomas Huth msr_write(dc, t1); 1325cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t1); 1326cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t0); 1327fcf5ef2aSThomas Huth dc->tb_flags &= ~DRTB_FLAG; 1328fcf5ef2aSThomas Huth } 1329fcf5ef2aSThomas Huth 1330fcf5ef2aSThomas Huth static inline void do_rte(DisasContext *dc) 1331fcf5ef2aSThomas Huth { 1332cfeea807SEdgar E. Iglesias TCGv_i32 t0, t1; 1333cfeea807SEdgar E. Iglesias t0 = tcg_temp_new_i32(); 1334cfeea807SEdgar E. Iglesias t1 = tcg_temp_new_i32(); 1335fcf5ef2aSThomas Huth 13360a22f8cfSEdgar E. Iglesias tcg_gen_extrl_i64_i32(t1, cpu_SR[SR_MSR]); 13370a22f8cfSEdgar E. Iglesias tcg_gen_ori_i32(t1, t1, MSR_EE); 1338cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t1, t1, ~MSR_EIP); 1339cfeea807SEdgar E. Iglesias tcg_gen_shri_i32(t0, t1, 1); 1340cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t0, t0, (MSR_VM | MSR_UM)); 1341fcf5ef2aSThomas Huth 1342cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t1, t1, ~(MSR_VM | MSR_UM)); 1343cfeea807SEdgar E. Iglesias tcg_gen_or_i32(t1, t1, t0); 1344fcf5ef2aSThomas Huth msr_write(dc, t1); 1345cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t1); 1346cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t0); 1347fcf5ef2aSThomas Huth dc->tb_flags &= ~DRTE_FLAG; 1348fcf5ef2aSThomas Huth } 1349fcf5ef2aSThomas Huth 1350fcf5ef2aSThomas Huth static void dec_rts(DisasContext *dc) 1351fcf5ef2aSThomas Huth { 1352fcf5ef2aSThomas Huth unsigned int b_bit, i_bit, e_bit; 135343d318b2SEdgar E. Iglesias TCGv_i64 tmp64; 1354fcf5ef2aSThomas Huth 1355fcf5ef2aSThomas Huth i_bit = dc->ir & (1 << 21); 1356fcf5ef2aSThomas Huth b_bit = dc->ir & (1 << 22); 1357fcf5ef2aSThomas Huth e_bit = dc->ir & (1 << 23); 1358fcf5ef2aSThomas Huth 1359bdfc1e88SEdgar E. Iglesias if (trap_userspace(dc, i_bit || b_bit || e_bit)) { 1360bdfc1e88SEdgar E. Iglesias return; 1361bdfc1e88SEdgar E. Iglesias } 1362bdfc1e88SEdgar E. Iglesias 1363f91c60f0SEdgar E. Iglesias dec_setup_dslot(dc); 1364fcf5ef2aSThomas Huth 1365fcf5ef2aSThomas Huth if (i_bit) { 1366fcf5ef2aSThomas Huth LOG_DIS("rtid ir=%x\n", dc->ir); 1367fcf5ef2aSThomas Huth dc->tb_flags |= DRTI_FLAG; 1368fcf5ef2aSThomas Huth } else if (b_bit) { 1369fcf5ef2aSThomas Huth LOG_DIS("rtbd ir=%x\n", dc->ir); 1370fcf5ef2aSThomas Huth dc->tb_flags |= DRTB_FLAG; 1371fcf5ef2aSThomas Huth } else if (e_bit) { 1372fcf5ef2aSThomas Huth LOG_DIS("rted ir=%x\n", dc->ir); 1373fcf5ef2aSThomas Huth dc->tb_flags |= DRTE_FLAG; 1374fcf5ef2aSThomas Huth } else 1375fcf5ef2aSThomas Huth LOG_DIS("rts ir=%x\n", dc->ir); 1376fcf5ef2aSThomas Huth 1377fcf5ef2aSThomas Huth dc->jmp = JMP_INDIRECT; 1378cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_btaken, 1); 137943d318b2SEdgar E. Iglesias 138043d318b2SEdgar E. Iglesias tmp64 = tcg_temp_new_i64(); 138143d318b2SEdgar E. Iglesias tcg_gen_extu_i32_i64(env_btarget, *(dec_alu_op_b(dc))); 138243d318b2SEdgar E. Iglesias tcg_gen_extu_i32_i64(tmp64, cpu_R[dc->ra]); 138343d318b2SEdgar E. Iglesias tcg_gen_add_i64(env_btarget, env_btarget, tmp64); 138443d318b2SEdgar E. Iglesias tcg_gen_andi_i64(env_btarget, env_btarget, UINT32_MAX); 138543d318b2SEdgar E. Iglesias tcg_temp_free_i64(tmp64); 1386fcf5ef2aSThomas Huth } 1387fcf5ef2aSThomas Huth 1388fcf5ef2aSThomas Huth static int dec_check_fpuv2(DisasContext *dc) 1389fcf5ef2aSThomas Huth { 1390fcf5ef2aSThomas Huth if ((dc->cpu->cfg.use_fpu != 2) && (dc->tb_flags & MSR_EE_FLAG)) { 13910a22f8cfSEdgar E. Iglesias tcg_gen_movi_i64(cpu_SR[SR_ESR], ESR_EC_FPU); 1392fcf5ef2aSThomas Huth t_gen_raise_exception(dc, EXCP_HW_EXCP); 1393fcf5ef2aSThomas Huth } 1394fcf5ef2aSThomas Huth return (dc->cpu->cfg.use_fpu == 2) ? 0 : PVR2_USE_FPU2_MASK; 1395fcf5ef2aSThomas Huth } 1396fcf5ef2aSThomas Huth 1397fcf5ef2aSThomas Huth static void dec_fpu(DisasContext *dc) 1398fcf5ef2aSThomas Huth { 1399fcf5ef2aSThomas Huth unsigned int fpu_insn; 1400fcf5ef2aSThomas Huth 14019ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, !dc->cpu->cfg.use_fpu)) { 1402fcf5ef2aSThomas Huth return; 1403fcf5ef2aSThomas Huth } 1404fcf5ef2aSThomas Huth 1405fcf5ef2aSThomas Huth fpu_insn = (dc->ir >> 7) & 7; 1406fcf5ef2aSThomas Huth 1407fcf5ef2aSThomas Huth switch (fpu_insn) { 1408fcf5ef2aSThomas Huth case 0: 1409fcf5ef2aSThomas Huth gen_helper_fadd(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra], 1410fcf5ef2aSThomas Huth cpu_R[dc->rb]); 1411fcf5ef2aSThomas Huth break; 1412fcf5ef2aSThomas Huth 1413fcf5ef2aSThomas Huth case 1: 1414fcf5ef2aSThomas Huth gen_helper_frsub(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra], 1415fcf5ef2aSThomas Huth cpu_R[dc->rb]); 1416fcf5ef2aSThomas Huth break; 1417fcf5ef2aSThomas Huth 1418fcf5ef2aSThomas Huth case 2: 1419fcf5ef2aSThomas Huth gen_helper_fmul(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra], 1420fcf5ef2aSThomas Huth cpu_R[dc->rb]); 1421fcf5ef2aSThomas Huth break; 1422fcf5ef2aSThomas Huth 1423fcf5ef2aSThomas Huth case 3: 1424fcf5ef2aSThomas Huth gen_helper_fdiv(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra], 1425fcf5ef2aSThomas Huth cpu_R[dc->rb]); 1426fcf5ef2aSThomas Huth break; 1427fcf5ef2aSThomas Huth 1428fcf5ef2aSThomas Huth case 4: 1429fcf5ef2aSThomas Huth switch ((dc->ir >> 4) & 7) { 1430fcf5ef2aSThomas Huth case 0: 1431fcf5ef2aSThomas Huth gen_helper_fcmp_un(cpu_R[dc->rd], cpu_env, 1432fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 1433fcf5ef2aSThomas Huth break; 1434fcf5ef2aSThomas Huth case 1: 1435fcf5ef2aSThomas Huth gen_helper_fcmp_lt(cpu_R[dc->rd], cpu_env, 1436fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 1437fcf5ef2aSThomas Huth break; 1438fcf5ef2aSThomas Huth case 2: 1439fcf5ef2aSThomas Huth gen_helper_fcmp_eq(cpu_R[dc->rd], cpu_env, 1440fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 1441fcf5ef2aSThomas Huth break; 1442fcf5ef2aSThomas Huth case 3: 1443fcf5ef2aSThomas Huth gen_helper_fcmp_le(cpu_R[dc->rd], cpu_env, 1444fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 1445fcf5ef2aSThomas Huth break; 1446fcf5ef2aSThomas Huth case 4: 1447fcf5ef2aSThomas Huth gen_helper_fcmp_gt(cpu_R[dc->rd], cpu_env, 1448fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 1449fcf5ef2aSThomas Huth break; 1450fcf5ef2aSThomas Huth case 5: 1451fcf5ef2aSThomas Huth gen_helper_fcmp_ne(cpu_R[dc->rd], cpu_env, 1452fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 1453fcf5ef2aSThomas Huth break; 1454fcf5ef2aSThomas Huth case 6: 1455fcf5ef2aSThomas Huth gen_helper_fcmp_ge(cpu_R[dc->rd], cpu_env, 1456fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 1457fcf5ef2aSThomas Huth break; 1458fcf5ef2aSThomas Huth default: 1459fcf5ef2aSThomas Huth qemu_log_mask(LOG_UNIMP, 1460fcf5ef2aSThomas Huth "unimplemented fcmp fpu_insn=%x pc=%x" 1461fcf5ef2aSThomas Huth " opc=%x\n", 1462fcf5ef2aSThomas Huth fpu_insn, dc->pc, dc->opcode); 1463fcf5ef2aSThomas Huth dc->abort_at_next_insn = 1; 1464fcf5ef2aSThomas Huth break; 1465fcf5ef2aSThomas Huth } 1466fcf5ef2aSThomas Huth break; 1467fcf5ef2aSThomas Huth 1468fcf5ef2aSThomas Huth case 5: 1469fcf5ef2aSThomas Huth if (!dec_check_fpuv2(dc)) { 1470fcf5ef2aSThomas Huth return; 1471fcf5ef2aSThomas Huth } 1472fcf5ef2aSThomas Huth gen_helper_flt(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra]); 1473fcf5ef2aSThomas Huth break; 1474fcf5ef2aSThomas Huth 1475fcf5ef2aSThomas Huth case 6: 1476fcf5ef2aSThomas Huth if (!dec_check_fpuv2(dc)) { 1477fcf5ef2aSThomas Huth return; 1478fcf5ef2aSThomas Huth } 1479fcf5ef2aSThomas Huth gen_helper_fint(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra]); 1480fcf5ef2aSThomas Huth break; 1481fcf5ef2aSThomas Huth 1482fcf5ef2aSThomas Huth case 7: 1483fcf5ef2aSThomas Huth if (!dec_check_fpuv2(dc)) { 1484fcf5ef2aSThomas Huth return; 1485fcf5ef2aSThomas Huth } 1486fcf5ef2aSThomas Huth gen_helper_fsqrt(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra]); 1487fcf5ef2aSThomas Huth break; 1488fcf5ef2aSThomas Huth 1489fcf5ef2aSThomas Huth default: 1490fcf5ef2aSThomas Huth qemu_log_mask(LOG_UNIMP, "unimplemented FPU insn fpu_insn=%x pc=%x" 1491fcf5ef2aSThomas Huth " opc=%x\n", 1492fcf5ef2aSThomas Huth fpu_insn, dc->pc, dc->opcode); 1493fcf5ef2aSThomas Huth dc->abort_at_next_insn = 1; 1494fcf5ef2aSThomas Huth break; 1495fcf5ef2aSThomas Huth } 1496fcf5ef2aSThomas Huth } 1497fcf5ef2aSThomas Huth 1498fcf5ef2aSThomas Huth static void dec_null(DisasContext *dc) 1499fcf5ef2aSThomas Huth { 15009ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, true)) { 1501fcf5ef2aSThomas Huth return; 1502fcf5ef2aSThomas Huth } 1503fcf5ef2aSThomas Huth qemu_log_mask(LOG_GUEST_ERROR, "unknown insn pc=%x opc=%x\n", dc->pc, dc->opcode); 1504fcf5ef2aSThomas Huth dc->abort_at_next_insn = 1; 1505fcf5ef2aSThomas Huth } 1506fcf5ef2aSThomas Huth 1507fcf5ef2aSThomas Huth /* Insns connected to FSL or AXI stream attached devices. */ 1508fcf5ef2aSThomas Huth static void dec_stream(DisasContext *dc) 1509fcf5ef2aSThomas Huth { 1510fcf5ef2aSThomas Huth TCGv_i32 t_id, t_ctrl; 1511fcf5ef2aSThomas Huth int ctrl; 1512fcf5ef2aSThomas Huth 1513fcf5ef2aSThomas Huth LOG_DIS("%s%s imm=%x\n", dc->rd ? "get" : "put", 1514fcf5ef2aSThomas Huth dc->type_b ? "" : "d", dc->imm); 1515fcf5ef2aSThomas Huth 1516bdfc1e88SEdgar E. Iglesias if (trap_userspace(dc, true)) { 1517fcf5ef2aSThomas Huth return; 1518fcf5ef2aSThomas Huth } 1519fcf5ef2aSThomas Huth 1520cfeea807SEdgar E. Iglesias t_id = tcg_temp_new_i32(); 1521fcf5ef2aSThomas Huth if (dc->type_b) { 1522cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(t_id, dc->imm & 0xf); 1523fcf5ef2aSThomas Huth ctrl = dc->imm >> 10; 1524fcf5ef2aSThomas Huth } else { 1525cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t_id, cpu_R[dc->rb], 0xf); 1526fcf5ef2aSThomas Huth ctrl = dc->imm >> 5; 1527fcf5ef2aSThomas Huth } 1528fcf5ef2aSThomas Huth 1529cfeea807SEdgar E. Iglesias t_ctrl = tcg_const_i32(ctrl); 1530fcf5ef2aSThomas Huth 1531fcf5ef2aSThomas Huth if (dc->rd == 0) { 1532fcf5ef2aSThomas Huth gen_helper_put(t_id, t_ctrl, cpu_R[dc->ra]); 1533fcf5ef2aSThomas Huth } else { 1534fcf5ef2aSThomas Huth gen_helper_get(cpu_R[dc->rd], t_id, t_ctrl); 1535fcf5ef2aSThomas Huth } 1536cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t_id); 1537cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t_ctrl); 1538fcf5ef2aSThomas Huth } 1539fcf5ef2aSThomas Huth 1540fcf5ef2aSThomas Huth static struct decoder_info { 1541fcf5ef2aSThomas Huth struct { 1542fcf5ef2aSThomas Huth uint32_t bits; 1543fcf5ef2aSThomas Huth uint32_t mask; 1544fcf5ef2aSThomas Huth }; 1545fcf5ef2aSThomas Huth void (*dec)(DisasContext *dc); 1546fcf5ef2aSThomas Huth } decinfo[] = { 1547fcf5ef2aSThomas Huth {DEC_ADD, dec_add}, 1548fcf5ef2aSThomas Huth {DEC_SUB, dec_sub}, 1549fcf5ef2aSThomas Huth {DEC_AND, dec_and}, 1550fcf5ef2aSThomas Huth {DEC_XOR, dec_xor}, 1551fcf5ef2aSThomas Huth {DEC_OR, dec_or}, 1552fcf5ef2aSThomas Huth {DEC_BIT, dec_bit}, 1553fcf5ef2aSThomas Huth {DEC_BARREL, dec_barrel}, 1554fcf5ef2aSThomas Huth {DEC_LD, dec_load}, 1555fcf5ef2aSThomas Huth {DEC_ST, dec_store}, 1556fcf5ef2aSThomas Huth {DEC_IMM, dec_imm}, 1557fcf5ef2aSThomas Huth {DEC_BR, dec_br}, 1558fcf5ef2aSThomas Huth {DEC_BCC, dec_bcc}, 1559fcf5ef2aSThomas Huth {DEC_RTS, dec_rts}, 1560fcf5ef2aSThomas Huth {DEC_FPU, dec_fpu}, 1561fcf5ef2aSThomas Huth {DEC_MUL, dec_mul}, 1562fcf5ef2aSThomas Huth {DEC_DIV, dec_div}, 1563fcf5ef2aSThomas Huth {DEC_MSR, dec_msr}, 1564fcf5ef2aSThomas Huth {DEC_STREAM, dec_stream}, 1565fcf5ef2aSThomas Huth {{0, 0}, dec_null} 1566fcf5ef2aSThomas Huth }; 1567fcf5ef2aSThomas Huth 1568fcf5ef2aSThomas Huth static inline void decode(DisasContext *dc, uint32_t ir) 1569fcf5ef2aSThomas Huth { 1570fcf5ef2aSThomas Huth int i; 1571fcf5ef2aSThomas Huth 1572fcf5ef2aSThomas Huth dc->ir = ir; 1573fcf5ef2aSThomas Huth LOG_DIS("%8.8x\t", dc->ir); 1574fcf5ef2aSThomas Huth 1575462c2544SEdgar E. Iglesias if (ir == 0) { 15769ba8cd45SEdgar E. Iglesias trap_illegal(dc, dc->cpu->env.pvr.regs[2] & PVR2_OPCODE_0x0_ILL_MASK); 1577462c2544SEdgar E. Iglesias /* Don't decode nop/zero instructions any further. */ 1578462c2544SEdgar E. Iglesias return; 1579462c2544SEdgar E. Iglesias } 1580fcf5ef2aSThomas Huth 1581fcf5ef2aSThomas Huth /* bit 2 seems to indicate insn type. */ 1582fcf5ef2aSThomas Huth dc->type_b = ir & (1 << 29); 1583fcf5ef2aSThomas Huth 1584fcf5ef2aSThomas Huth dc->opcode = EXTRACT_FIELD(ir, 26, 31); 1585fcf5ef2aSThomas Huth dc->rd = EXTRACT_FIELD(ir, 21, 25); 1586fcf5ef2aSThomas Huth dc->ra = EXTRACT_FIELD(ir, 16, 20); 1587fcf5ef2aSThomas Huth dc->rb = EXTRACT_FIELD(ir, 11, 15); 1588fcf5ef2aSThomas Huth dc->imm = EXTRACT_FIELD(ir, 0, 15); 1589fcf5ef2aSThomas Huth 1590fcf5ef2aSThomas Huth /* Large switch for all insns. */ 1591fcf5ef2aSThomas Huth for (i = 0; i < ARRAY_SIZE(decinfo); i++) { 1592fcf5ef2aSThomas Huth if ((dc->opcode & decinfo[i].mask) == decinfo[i].bits) { 1593fcf5ef2aSThomas Huth decinfo[i].dec(dc); 1594fcf5ef2aSThomas Huth break; 1595fcf5ef2aSThomas Huth } 1596fcf5ef2aSThomas Huth } 1597fcf5ef2aSThomas Huth } 1598fcf5ef2aSThomas Huth 1599fcf5ef2aSThomas Huth /* generate intermediate code for basic block 'tb'. */ 16008b86d6d2SRichard Henderson void gen_intermediate_code(CPUState *cs, TranslationBlock *tb, int max_insns) 1601fcf5ef2aSThomas Huth { 16029c489ea6SLluís Vilanova CPUMBState *env = cs->env_ptr; 1603f5c7e93aSRichard Henderson MicroBlazeCPU *cpu = env_archcpu(env); 1604fcf5ef2aSThomas Huth uint32_t pc_start; 1605fcf5ef2aSThomas Huth struct DisasContext ctx; 1606fcf5ef2aSThomas Huth struct DisasContext *dc = &ctx; 160756371527SEmilio G. Cota uint32_t page_start, org_flags; 1608cfeea807SEdgar E. Iglesias uint32_t npc; 1609fcf5ef2aSThomas Huth int num_insns; 1610fcf5ef2aSThomas Huth 1611fcf5ef2aSThomas Huth pc_start = tb->pc; 1612fcf5ef2aSThomas Huth dc->cpu = cpu; 1613fcf5ef2aSThomas Huth dc->tb = tb; 1614fcf5ef2aSThomas Huth org_flags = dc->synced_flags = dc->tb_flags = tb->flags; 1615fcf5ef2aSThomas Huth 1616fcf5ef2aSThomas Huth dc->is_jmp = DISAS_NEXT; 1617fcf5ef2aSThomas Huth dc->jmp = 0; 1618fcf5ef2aSThomas Huth dc->delayed_branch = !!(dc->tb_flags & D_FLAG); 1619fcf5ef2aSThomas Huth if (dc->delayed_branch) { 1620fcf5ef2aSThomas Huth dc->jmp = JMP_INDIRECT; 1621fcf5ef2aSThomas Huth } 1622fcf5ef2aSThomas Huth dc->pc = pc_start; 1623fcf5ef2aSThomas Huth dc->singlestep_enabled = cs->singlestep_enabled; 1624fcf5ef2aSThomas Huth dc->cpustate_changed = 0; 1625fcf5ef2aSThomas Huth dc->abort_at_next_insn = 0; 1626fcf5ef2aSThomas Huth 1627fcf5ef2aSThomas Huth if (pc_start & 3) { 1628fcf5ef2aSThomas Huth cpu_abort(cs, "Microblaze: unaligned PC=%x\n", pc_start); 1629fcf5ef2aSThomas Huth } 1630fcf5ef2aSThomas Huth 163156371527SEmilio G. Cota page_start = pc_start & TARGET_PAGE_MASK; 1632fcf5ef2aSThomas Huth num_insns = 0; 1633fcf5ef2aSThomas Huth 1634fcf5ef2aSThomas Huth gen_tb_start(tb); 1635fcf5ef2aSThomas Huth do 1636fcf5ef2aSThomas Huth { 1637fcf5ef2aSThomas Huth tcg_gen_insn_start(dc->pc); 1638fcf5ef2aSThomas Huth num_insns++; 1639fcf5ef2aSThomas Huth 1640fcf5ef2aSThomas Huth #if SIM_COMPAT 1641fcf5ef2aSThomas Huth if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM)) { 16420a22f8cfSEdgar E. Iglesias tcg_gen_movi_i64(cpu_SR[SR_PC], dc->pc); 1643fcf5ef2aSThomas Huth gen_helper_debug(); 1644fcf5ef2aSThomas Huth } 1645fcf5ef2aSThomas Huth #endif 1646fcf5ef2aSThomas Huth 1647fcf5ef2aSThomas Huth if (unlikely(cpu_breakpoint_test(cs, dc->pc, BP_ANY))) { 1648fcf5ef2aSThomas Huth t_gen_raise_exception(dc, EXCP_DEBUG); 1649fcf5ef2aSThomas Huth dc->is_jmp = DISAS_UPDATE; 1650fcf5ef2aSThomas Huth /* The address covered by the breakpoint must be included in 1651fcf5ef2aSThomas Huth [tb->pc, tb->pc + tb->size) in order to for it to be 1652fcf5ef2aSThomas Huth properly cleared -- thus we increment the PC here so that 1653fcf5ef2aSThomas Huth the logic setting tb->size below does the right thing. */ 1654fcf5ef2aSThomas Huth dc->pc += 4; 1655fcf5ef2aSThomas Huth break; 1656fcf5ef2aSThomas Huth } 1657fcf5ef2aSThomas Huth 1658fcf5ef2aSThomas Huth /* Pretty disas. */ 1659fcf5ef2aSThomas Huth LOG_DIS("%8.8x:\t", dc->pc); 1660fcf5ef2aSThomas Huth 1661c5a49c63SEmilio G. Cota if (num_insns == max_insns && (tb_cflags(tb) & CF_LAST_IO)) { 1662fcf5ef2aSThomas Huth gen_io_start(); 1663fcf5ef2aSThomas Huth } 1664fcf5ef2aSThomas Huth 1665fcf5ef2aSThomas Huth dc->clear_imm = 1; 1666fcf5ef2aSThomas Huth decode(dc, cpu_ldl_code(env, dc->pc)); 1667fcf5ef2aSThomas Huth if (dc->clear_imm) 1668fcf5ef2aSThomas Huth dc->tb_flags &= ~IMM_FLAG; 1669fcf5ef2aSThomas Huth dc->pc += 4; 1670fcf5ef2aSThomas Huth 1671fcf5ef2aSThomas Huth if (dc->delayed_branch) { 1672fcf5ef2aSThomas Huth dc->delayed_branch--; 1673fcf5ef2aSThomas Huth if (!dc->delayed_branch) { 1674fcf5ef2aSThomas Huth if (dc->tb_flags & DRTI_FLAG) 1675fcf5ef2aSThomas Huth do_rti(dc); 1676fcf5ef2aSThomas Huth if (dc->tb_flags & DRTB_FLAG) 1677fcf5ef2aSThomas Huth do_rtb(dc); 1678fcf5ef2aSThomas Huth if (dc->tb_flags & DRTE_FLAG) 1679fcf5ef2aSThomas Huth do_rte(dc); 1680fcf5ef2aSThomas Huth /* Clear the delay slot flag. */ 1681fcf5ef2aSThomas Huth dc->tb_flags &= ~D_FLAG; 1682fcf5ef2aSThomas Huth /* If it is a direct jump, try direct chaining. */ 1683fcf5ef2aSThomas Huth if (dc->jmp == JMP_INDIRECT) { 1684*c49a41b0SEdgar E. Iglesias TCGv_i64 tmp_pc = tcg_const_i64(dc->pc); 1685*c49a41b0SEdgar E. Iglesias eval_cond_jmp(dc, env_btarget, tmp_pc); 1686*c49a41b0SEdgar E. Iglesias tcg_temp_free_i64(tmp_pc); 1687*c49a41b0SEdgar E. Iglesias 1688fcf5ef2aSThomas Huth dc->is_jmp = DISAS_JUMP; 1689fcf5ef2aSThomas Huth } else if (dc->jmp == JMP_DIRECT) { 1690fcf5ef2aSThomas Huth t_sync_flags(dc); 1691fcf5ef2aSThomas Huth gen_goto_tb(dc, 0, dc->jmp_pc); 1692fcf5ef2aSThomas Huth dc->is_jmp = DISAS_TB_JUMP; 1693fcf5ef2aSThomas Huth } else if (dc->jmp == JMP_DIRECT_CC) { 1694fcf5ef2aSThomas Huth TCGLabel *l1 = gen_new_label(); 1695fcf5ef2aSThomas Huth t_sync_flags(dc); 1696fcf5ef2aSThomas Huth /* Conditional jmp. */ 1697cfeea807SEdgar E. Iglesias tcg_gen_brcondi_i32(TCG_COND_NE, env_btaken, 0, l1); 1698fcf5ef2aSThomas Huth gen_goto_tb(dc, 1, dc->pc); 1699fcf5ef2aSThomas Huth gen_set_label(l1); 1700fcf5ef2aSThomas Huth gen_goto_tb(dc, 0, dc->jmp_pc); 1701fcf5ef2aSThomas Huth 1702fcf5ef2aSThomas Huth dc->is_jmp = DISAS_TB_JUMP; 1703fcf5ef2aSThomas Huth } 1704fcf5ef2aSThomas Huth break; 1705fcf5ef2aSThomas Huth } 1706fcf5ef2aSThomas Huth } 1707fcf5ef2aSThomas Huth if (cs->singlestep_enabled) { 1708fcf5ef2aSThomas Huth break; 1709fcf5ef2aSThomas Huth } 1710fcf5ef2aSThomas Huth } while (!dc->is_jmp && !dc->cpustate_changed 1711fcf5ef2aSThomas Huth && !tcg_op_buf_full() 1712fcf5ef2aSThomas Huth && !singlestep 171356371527SEmilio G. Cota && (dc->pc - page_start < TARGET_PAGE_SIZE) 1714fcf5ef2aSThomas Huth && num_insns < max_insns); 1715fcf5ef2aSThomas Huth 1716fcf5ef2aSThomas Huth npc = dc->pc; 1717fcf5ef2aSThomas Huth if (dc->jmp == JMP_DIRECT || dc->jmp == JMP_DIRECT_CC) { 1718fcf5ef2aSThomas Huth if (dc->tb_flags & D_FLAG) { 1719fcf5ef2aSThomas Huth dc->is_jmp = DISAS_UPDATE; 17200a22f8cfSEdgar E. Iglesias tcg_gen_movi_i64(cpu_SR[SR_PC], npc); 1721fcf5ef2aSThomas Huth sync_jmpstate(dc); 1722fcf5ef2aSThomas Huth } else 1723fcf5ef2aSThomas Huth npc = dc->jmp_pc; 1724fcf5ef2aSThomas Huth } 1725fcf5ef2aSThomas Huth 1726fcf5ef2aSThomas Huth /* Force an update if the per-tb cpu state has changed. */ 1727fcf5ef2aSThomas Huth if (dc->is_jmp == DISAS_NEXT 1728fcf5ef2aSThomas Huth && (dc->cpustate_changed || org_flags != dc->tb_flags)) { 1729fcf5ef2aSThomas Huth dc->is_jmp = DISAS_UPDATE; 17300a22f8cfSEdgar E. Iglesias tcg_gen_movi_i64(cpu_SR[SR_PC], npc); 1731fcf5ef2aSThomas Huth } 1732fcf5ef2aSThomas Huth t_sync_flags(dc); 1733fcf5ef2aSThomas Huth 1734fcf5ef2aSThomas Huth if (unlikely(cs->singlestep_enabled)) { 1735fcf5ef2aSThomas Huth TCGv_i32 tmp = tcg_const_i32(EXCP_DEBUG); 1736fcf5ef2aSThomas Huth 1737fcf5ef2aSThomas Huth if (dc->is_jmp != DISAS_JUMP) { 17380a22f8cfSEdgar E. Iglesias tcg_gen_movi_i64(cpu_SR[SR_PC], npc); 1739fcf5ef2aSThomas Huth } 1740fcf5ef2aSThomas Huth gen_helper_raise_exception(cpu_env, tmp); 1741fcf5ef2aSThomas Huth tcg_temp_free_i32(tmp); 1742fcf5ef2aSThomas Huth } else { 1743fcf5ef2aSThomas Huth switch(dc->is_jmp) { 1744fcf5ef2aSThomas Huth case DISAS_NEXT: 1745fcf5ef2aSThomas Huth gen_goto_tb(dc, 1, npc); 1746fcf5ef2aSThomas Huth break; 1747fcf5ef2aSThomas Huth default: 1748fcf5ef2aSThomas Huth case DISAS_JUMP: 1749fcf5ef2aSThomas Huth case DISAS_UPDATE: 1750fcf5ef2aSThomas Huth /* indicate that the hash table must be used 1751fcf5ef2aSThomas Huth to find the next TB */ 175207ea28b4SRichard Henderson tcg_gen_exit_tb(NULL, 0); 1753fcf5ef2aSThomas Huth break; 1754fcf5ef2aSThomas Huth case DISAS_TB_JUMP: 1755fcf5ef2aSThomas Huth /* nothing more to generate */ 1756fcf5ef2aSThomas Huth break; 1757fcf5ef2aSThomas Huth } 1758fcf5ef2aSThomas Huth } 1759fcf5ef2aSThomas Huth gen_tb_end(tb, num_insns); 1760fcf5ef2aSThomas Huth 1761fcf5ef2aSThomas Huth tb->size = dc->pc - pc_start; 1762fcf5ef2aSThomas Huth tb->icount = num_insns; 1763fcf5ef2aSThomas Huth 1764fcf5ef2aSThomas Huth #ifdef DEBUG_DISAS 1765fcf5ef2aSThomas Huth #if !SIM_COMPAT 1766fcf5ef2aSThomas Huth if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM) 1767fcf5ef2aSThomas Huth && qemu_log_in_addr_range(pc_start)) { 1768fcf5ef2aSThomas Huth qemu_log_lock(); 1769fcf5ef2aSThomas Huth qemu_log("--------------\n"); 17701d48474dSRichard Henderson log_target_disas(cs, pc_start, dc->pc - pc_start); 1771fcf5ef2aSThomas Huth qemu_log_unlock(); 1772fcf5ef2aSThomas Huth } 1773fcf5ef2aSThomas Huth #endif 1774fcf5ef2aSThomas Huth #endif 1775fcf5ef2aSThomas Huth assert(!dc->abort_at_next_insn); 1776fcf5ef2aSThomas Huth } 1777fcf5ef2aSThomas Huth 177890c84c56SMarkus Armbruster void mb_cpu_dump_state(CPUState *cs, FILE *f, int flags) 1779fcf5ef2aSThomas Huth { 1780fcf5ef2aSThomas Huth MicroBlazeCPU *cpu = MICROBLAZE_CPU(cs); 1781fcf5ef2aSThomas Huth CPUMBState *env = &cpu->env; 1782fcf5ef2aSThomas Huth int i; 1783fcf5ef2aSThomas Huth 178490c84c56SMarkus Armbruster if (!env) { 1785fcf5ef2aSThomas Huth return; 178690c84c56SMarkus Armbruster } 1787fcf5ef2aSThomas Huth 178890c84c56SMarkus Armbruster qemu_fprintf(f, "IN: PC=%" PRIx64 " %s\n", 1789fcf5ef2aSThomas Huth env->sregs[SR_PC], lookup_symbol(env->sregs[SR_PC])); 179090c84c56SMarkus Armbruster qemu_fprintf(f, "rmsr=%" PRIx64 " resr=%" PRIx64 " rear=%" PRIx64 " " 17910a22f8cfSEdgar E. Iglesias "debug=%x imm=%x iflags=%x fsr=%" PRIx64 "\n", 1792fcf5ef2aSThomas Huth env->sregs[SR_MSR], env->sregs[SR_ESR], env->sregs[SR_EAR], 1793fcf5ef2aSThomas Huth env->debug, env->imm, env->iflags, env->sregs[SR_FSR]); 179490c84c56SMarkus Armbruster qemu_fprintf(f, "btaken=%d btarget=%" PRIx64 " mode=%s(saved=%s) " 179543d318b2SEdgar E. Iglesias "eip=%d ie=%d\n", 1796fcf5ef2aSThomas Huth env->btaken, env->btarget, 1797fcf5ef2aSThomas Huth (env->sregs[SR_MSR] & MSR_UM) ? "user" : "kernel", 1798fcf5ef2aSThomas Huth (env->sregs[SR_MSR] & MSR_UMS) ? "user" : "kernel", 17990a22f8cfSEdgar E. Iglesias (bool)(env->sregs[SR_MSR] & MSR_EIP), 18000a22f8cfSEdgar E. Iglesias (bool)(env->sregs[SR_MSR] & MSR_IE)); 1801fcf5ef2aSThomas Huth 1802fcf5ef2aSThomas Huth for (i = 0; i < 32; i++) { 180390c84c56SMarkus Armbruster qemu_fprintf(f, "r%2.2d=%8.8x ", i, env->regs[i]); 1804fcf5ef2aSThomas Huth if ((i + 1) % 4 == 0) 180590c84c56SMarkus Armbruster qemu_fprintf(f, "\n"); 1806fcf5ef2aSThomas Huth } 180790c84c56SMarkus Armbruster qemu_fprintf(f, "\n\n"); 1808fcf5ef2aSThomas Huth } 1809fcf5ef2aSThomas Huth 1810fcf5ef2aSThomas Huth void mb_tcg_init(void) 1811fcf5ef2aSThomas Huth { 1812fcf5ef2aSThomas Huth int i; 1813fcf5ef2aSThomas Huth 1814cfeea807SEdgar E. Iglesias env_debug = tcg_global_mem_new_i32(cpu_env, 1815fcf5ef2aSThomas Huth offsetof(CPUMBState, debug), 1816fcf5ef2aSThomas Huth "debug0"); 1817cfeea807SEdgar E. Iglesias env_iflags = tcg_global_mem_new_i32(cpu_env, 1818fcf5ef2aSThomas Huth offsetof(CPUMBState, iflags), 1819fcf5ef2aSThomas Huth "iflags"); 1820cfeea807SEdgar E. Iglesias env_imm = tcg_global_mem_new_i32(cpu_env, 1821fcf5ef2aSThomas Huth offsetof(CPUMBState, imm), 1822fcf5ef2aSThomas Huth "imm"); 182343d318b2SEdgar E. Iglesias env_btarget = tcg_global_mem_new_i64(cpu_env, 1824fcf5ef2aSThomas Huth offsetof(CPUMBState, btarget), 1825fcf5ef2aSThomas Huth "btarget"); 1826cfeea807SEdgar E. Iglesias env_btaken = tcg_global_mem_new_i32(cpu_env, 1827fcf5ef2aSThomas Huth offsetof(CPUMBState, btaken), 1828fcf5ef2aSThomas Huth "btaken"); 1829403322eaSEdgar E. Iglesias env_res_addr = tcg_global_mem_new(cpu_env, 1830fcf5ef2aSThomas Huth offsetof(CPUMBState, res_addr), 1831fcf5ef2aSThomas Huth "res_addr"); 1832cfeea807SEdgar E. Iglesias env_res_val = tcg_global_mem_new_i32(cpu_env, 1833fcf5ef2aSThomas Huth offsetof(CPUMBState, res_val), 1834fcf5ef2aSThomas Huth "res_val"); 1835fcf5ef2aSThomas Huth for (i = 0; i < ARRAY_SIZE(cpu_R); i++) { 1836cfeea807SEdgar E. Iglesias cpu_R[i] = tcg_global_mem_new_i32(cpu_env, 1837fcf5ef2aSThomas Huth offsetof(CPUMBState, regs[i]), 1838fcf5ef2aSThomas Huth regnames[i]); 1839fcf5ef2aSThomas Huth } 1840fcf5ef2aSThomas Huth for (i = 0; i < ARRAY_SIZE(cpu_SR); i++) { 18410a22f8cfSEdgar E. Iglesias cpu_SR[i] = tcg_global_mem_new_i64(cpu_env, 1842fcf5ef2aSThomas Huth offsetof(CPUMBState, sregs[i]), 1843fcf5ef2aSThomas Huth special_regnames[i]); 1844fcf5ef2aSThomas Huth } 1845fcf5ef2aSThomas Huth } 1846fcf5ef2aSThomas Huth 1847fcf5ef2aSThomas Huth void restore_state_to_opc(CPUMBState *env, TranslationBlock *tb, 1848fcf5ef2aSThomas Huth target_ulong *data) 1849fcf5ef2aSThomas Huth { 1850fcf5ef2aSThomas Huth env->sregs[SR_PC] = data[0]; 1851fcf5ef2aSThomas Huth } 1852