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" 31fcf5ef2aSThomas Huth 32fcf5ef2aSThomas Huth #include "trace-tcg.h" 33fcf5ef2aSThomas Huth #include "exec/log.h" 34fcf5ef2aSThomas Huth 35fcf5ef2aSThomas Huth 36fcf5ef2aSThomas Huth #define SIM_COMPAT 0 37fcf5ef2aSThomas Huth #define DISAS_GNU 1 38fcf5ef2aSThomas Huth #define DISAS_MB 1 39fcf5ef2aSThomas Huth #if DISAS_MB && !SIM_COMPAT 40fcf5ef2aSThomas Huth # define LOG_DIS(...) qemu_log_mask(CPU_LOG_TB_IN_ASM, ## __VA_ARGS__) 41fcf5ef2aSThomas Huth #else 42fcf5ef2aSThomas Huth # define LOG_DIS(...) do { } while (0) 43fcf5ef2aSThomas Huth #endif 44fcf5ef2aSThomas Huth 45fcf5ef2aSThomas Huth #define D(x) 46fcf5ef2aSThomas Huth 47fcf5ef2aSThomas Huth #define EXTRACT_FIELD(src, start, end) \ 48fcf5ef2aSThomas Huth (((src) >> start) & ((1 << (end - start + 1)) - 1)) 49fcf5ef2aSThomas Huth 5077fc6f5eSLluís Vilanova /* is_jmp field values */ 5177fc6f5eSLluís Vilanova #define DISAS_JUMP DISAS_TARGET_0 /* only pc was modified dynamically */ 5277fc6f5eSLluís Vilanova #define DISAS_UPDATE DISAS_TARGET_1 /* cpu state was modified dynamically */ 5377fc6f5eSLluís Vilanova #define DISAS_TB_JUMP DISAS_TARGET_2 /* only pc was modified statically */ 5477fc6f5eSLluís Vilanova 55cfeea807SEdgar E. Iglesias static TCGv_i32 env_debug; 56cfeea807SEdgar E. Iglesias static TCGv_i32 cpu_R[32]; 57cfeea807SEdgar E. Iglesias static TCGv_i32 cpu_SR[14]; 58cfeea807SEdgar E. Iglesias static TCGv_i32 env_imm; 59cfeea807SEdgar E. Iglesias static TCGv_i32 env_btaken; 60cfeea807SEdgar E. Iglesias static TCGv_i32 env_btarget; 61cfeea807SEdgar E. Iglesias static TCGv_i32 env_iflags; 62403322eaSEdgar E. Iglesias static TCGv env_res_addr; 63cfeea807SEdgar E. Iglesias static TCGv_i32 env_res_val; 64fcf5ef2aSThomas Huth 65fcf5ef2aSThomas Huth #include "exec/gen-icount.h" 66fcf5ef2aSThomas Huth 67fcf5ef2aSThomas Huth /* This is the state at translation time. */ 68fcf5ef2aSThomas Huth typedef struct DisasContext { 69fcf5ef2aSThomas Huth MicroBlazeCPU *cpu; 70cfeea807SEdgar E. Iglesias uint32_t pc; 71fcf5ef2aSThomas Huth 72fcf5ef2aSThomas Huth /* Decoder. */ 73fcf5ef2aSThomas Huth int type_b; 74fcf5ef2aSThomas Huth uint32_t ir; 75fcf5ef2aSThomas Huth uint8_t opcode; 76fcf5ef2aSThomas Huth uint8_t rd, ra, rb; 77fcf5ef2aSThomas Huth uint16_t imm; 78fcf5ef2aSThomas Huth 79fcf5ef2aSThomas Huth unsigned int cpustate_changed; 80fcf5ef2aSThomas Huth unsigned int delayed_branch; 81fcf5ef2aSThomas Huth unsigned int tb_flags, synced_flags; /* tb dependent flags. */ 82fcf5ef2aSThomas Huth unsigned int clear_imm; 83fcf5ef2aSThomas Huth int is_jmp; 84fcf5ef2aSThomas Huth 85fcf5ef2aSThomas Huth #define JMP_NOJMP 0 86fcf5ef2aSThomas Huth #define JMP_DIRECT 1 87fcf5ef2aSThomas Huth #define JMP_DIRECT_CC 2 88fcf5ef2aSThomas Huth #define JMP_INDIRECT 3 89fcf5ef2aSThomas Huth unsigned int jmp; 90fcf5ef2aSThomas Huth uint32_t jmp_pc; 91fcf5ef2aSThomas Huth 92fcf5ef2aSThomas Huth int abort_at_next_insn; 93fcf5ef2aSThomas Huth int nr_nops; 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); 126cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(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); 145cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_SR[SR_PC], dest); 146fcf5ef2aSThomas Huth tcg_gen_exit_tb((uintptr_t)dc->tb + n); 147fcf5ef2aSThomas Huth } else { 148cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_SR[SR_PC], dest); 149fcf5ef2aSThomas Huth tcg_gen_exit_tb(0); 150fcf5ef2aSThomas Huth } 151fcf5ef2aSThomas Huth } 152fcf5ef2aSThomas Huth 153cfeea807SEdgar E. Iglesias static void read_carry(DisasContext *dc, TCGv_i32 d) 154fcf5ef2aSThomas Huth { 155cfeea807SEdgar E. Iglesias tcg_gen_shri_i32(d, cpu_SR[SR_MSR], 31); 156fcf5ef2aSThomas Huth } 157fcf5ef2aSThomas Huth 158fcf5ef2aSThomas Huth /* 159fcf5ef2aSThomas Huth * write_carry sets the carry bits in MSR based on bit 0 of v. 160fcf5ef2aSThomas Huth * v[31:1] are ignored. 161fcf5ef2aSThomas Huth */ 162cfeea807SEdgar E. Iglesias static void write_carry(DisasContext *dc, TCGv_i32 v) 163fcf5ef2aSThomas Huth { 164cfeea807SEdgar E. Iglesias TCGv_i32 t0 = tcg_temp_new_i32(); 165cfeea807SEdgar E. Iglesias tcg_gen_shli_i32(t0, v, 31); 166cfeea807SEdgar E. Iglesias tcg_gen_sari_i32(t0, t0, 31); 167cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t0, t0, (MSR_C | MSR_CC)); 168cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(cpu_SR[SR_MSR], cpu_SR[SR_MSR], 169fcf5ef2aSThomas Huth ~(MSR_C | MSR_CC)); 170cfeea807SEdgar E. Iglesias tcg_gen_or_i32(cpu_SR[SR_MSR], cpu_SR[SR_MSR], t0); 171cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t0); 172fcf5ef2aSThomas Huth } 173fcf5ef2aSThomas Huth 174fcf5ef2aSThomas Huth static void write_carryi(DisasContext *dc, bool carry) 175fcf5ef2aSThomas Huth { 176cfeea807SEdgar E. Iglesias TCGv_i32 t0 = tcg_temp_new_i32(); 177cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(t0, carry); 178fcf5ef2aSThomas Huth write_carry(dc, t0); 179cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t0); 180fcf5ef2aSThomas Huth } 181fcf5ef2aSThomas Huth 182bdfc1e88SEdgar E. Iglesias /* 1839ba8cd45SEdgar E. Iglesias * Returns true if the insn an illegal operation. 1849ba8cd45SEdgar E. Iglesias * If exceptions are enabled, an exception is raised. 1859ba8cd45SEdgar E. Iglesias */ 1869ba8cd45SEdgar E. Iglesias static bool trap_illegal(DisasContext *dc, bool cond) 1879ba8cd45SEdgar E. Iglesias { 1889ba8cd45SEdgar E. Iglesias if (cond && (dc->tb_flags & MSR_EE_FLAG) 1899ba8cd45SEdgar E. Iglesias && (dc->cpu->env.pvr.regs[2] & PVR2_ILL_OPCODE_EXC_MASK)) { 1909ba8cd45SEdgar E. Iglesias tcg_gen_movi_i32(cpu_SR[SR_ESR], ESR_EC_ILLEGAL_OP); 1919ba8cd45SEdgar E. Iglesias t_gen_raise_exception(dc, EXCP_HW_EXCP); 1929ba8cd45SEdgar E. Iglesias } 1939ba8cd45SEdgar E. Iglesias return cond; 1949ba8cd45SEdgar E. Iglesias } 1959ba8cd45SEdgar E. Iglesias 1969ba8cd45SEdgar E. Iglesias /* 197bdfc1e88SEdgar E. Iglesias * Returns true if the insn is illegal in userspace. 198bdfc1e88SEdgar E. Iglesias * If exceptions are enabled, an exception is raised. 199bdfc1e88SEdgar E. Iglesias */ 200bdfc1e88SEdgar E. Iglesias static bool trap_userspace(DisasContext *dc, bool cond) 201bdfc1e88SEdgar E. Iglesias { 202bdfc1e88SEdgar E. Iglesias int mem_index = cpu_mmu_index(&dc->cpu->env, false); 203bdfc1e88SEdgar E. Iglesias bool cond_user = cond && mem_index == MMU_USER_IDX; 204bdfc1e88SEdgar E. Iglesias 205bdfc1e88SEdgar E. Iglesias if (cond_user && (dc->tb_flags & MSR_EE_FLAG)) { 206bdfc1e88SEdgar E. Iglesias tcg_gen_movi_i32(cpu_SR[SR_ESR], ESR_EC_PRIVINSN); 207bdfc1e88SEdgar E. Iglesias t_gen_raise_exception(dc, EXCP_HW_EXCP); 208bdfc1e88SEdgar E. Iglesias } 209bdfc1e88SEdgar E. Iglesias return cond_user; 210bdfc1e88SEdgar E. Iglesias } 211bdfc1e88SEdgar E. Iglesias 212fcf5ef2aSThomas Huth /* True if ALU operand b is a small immediate that may deserve 213fcf5ef2aSThomas Huth faster treatment. */ 214fcf5ef2aSThomas Huth static inline int dec_alu_op_b_is_small_imm(DisasContext *dc) 215fcf5ef2aSThomas Huth { 216fcf5ef2aSThomas Huth /* Immediate insn without the imm prefix ? */ 217fcf5ef2aSThomas Huth return dc->type_b && !(dc->tb_flags & IMM_FLAG); 218fcf5ef2aSThomas Huth } 219fcf5ef2aSThomas Huth 220cfeea807SEdgar E. Iglesias static inline TCGv_i32 *dec_alu_op_b(DisasContext *dc) 221fcf5ef2aSThomas Huth { 222fcf5ef2aSThomas Huth if (dc->type_b) { 223fcf5ef2aSThomas Huth if (dc->tb_flags & IMM_FLAG) 224cfeea807SEdgar E. Iglesias tcg_gen_ori_i32(env_imm, env_imm, dc->imm); 225fcf5ef2aSThomas Huth else 226cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_imm, (int32_t)((int16_t)dc->imm)); 227fcf5ef2aSThomas Huth return &env_imm; 228fcf5ef2aSThomas Huth } else 229fcf5ef2aSThomas Huth return &cpu_R[dc->rb]; 230fcf5ef2aSThomas Huth } 231fcf5ef2aSThomas Huth 232fcf5ef2aSThomas Huth static void dec_add(DisasContext *dc) 233fcf5ef2aSThomas Huth { 234fcf5ef2aSThomas Huth unsigned int k, c; 235cfeea807SEdgar E. Iglesias TCGv_i32 cf; 236fcf5ef2aSThomas Huth 237fcf5ef2aSThomas Huth k = dc->opcode & 4; 238fcf5ef2aSThomas Huth c = dc->opcode & 2; 239fcf5ef2aSThomas Huth 240fcf5ef2aSThomas Huth LOG_DIS("add%s%s%s r%d r%d r%d\n", 241fcf5ef2aSThomas Huth dc->type_b ? "i" : "", k ? "k" : "", c ? "c" : "", 242fcf5ef2aSThomas Huth dc->rd, dc->ra, dc->rb); 243fcf5ef2aSThomas Huth 244fcf5ef2aSThomas Huth /* Take care of the easy cases first. */ 245fcf5ef2aSThomas Huth if (k) { 246fcf5ef2aSThomas Huth /* k - keep carry, no need to update MSR. */ 247fcf5ef2aSThomas Huth /* If rd == r0, it's a nop. */ 248fcf5ef2aSThomas Huth if (dc->rd) { 249cfeea807SEdgar E. Iglesias tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc))); 250fcf5ef2aSThomas Huth 251fcf5ef2aSThomas Huth if (c) { 252fcf5ef2aSThomas Huth /* c - Add carry into the result. */ 253cfeea807SEdgar E. Iglesias cf = tcg_temp_new_i32(); 254fcf5ef2aSThomas Huth 255fcf5ef2aSThomas Huth read_carry(dc, cf); 256cfeea807SEdgar E. Iglesias tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->rd], cf); 257cfeea807SEdgar E. Iglesias tcg_temp_free_i32(cf); 258fcf5ef2aSThomas Huth } 259fcf5ef2aSThomas Huth } 260fcf5ef2aSThomas Huth return; 261fcf5ef2aSThomas Huth } 262fcf5ef2aSThomas Huth 263fcf5ef2aSThomas Huth /* From now on, we can assume k is zero. So we need to update MSR. */ 264fcf5ef2aSThomas Huth /* Extract carry. */ 265cfeea807SEdgar E. Iglesias cf = tcg_temp_new_i32(); 266fcf5ef2aSThomas Huth if (c) { 267fcf5ef2aSThomas Huth read_carry(dc, cf); 268fcf5ef2aSThomas Huth } else { 269cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cf, 0); 270fcf5ef2aSThomas Huth } 271fcf5ef2aSThomas Huth 272fcf5ef2aSThomas Huth if (dc->rd) { 273cfeea807SEdgar E. Iglesias TCGv_i32 ncf = tcg_temp_new_i32(); 274fcf5ef2aSThomas Huth gen_helper_carry(ncf, cpu_R[dc->ra], *(dec_alu_op_b(dc)), cf); 275cfeea807SEdgar E. Iglesias tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc))); 276cfeea807SEdgar E. Iglesias tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->rd], cf); 277fcf5ef2aSThomas Huth write_carry(dc, ncf); 278cfeea807SEdgar E. Iglesias tcg_temp_free_i32(ncf); 279fcf5ef2aSThomas Huth } else { 280fcf5ef2aSThomas Huth gen_helper_carry(cf, cpu_R[dc->ra], *(dec_alu_op_b(dc)), cf); 281fcf5ef2aSThomas Huth write_carry(dc, cf); 282fcf5ef2aSThomas Huth } 283cfeea807SEdgar E. Iglesias tcg_temp_free_i32(cf); 284fcf5ef2aSThomas Huth } 285fcf5ef2aSThomas Huth 286fcf5ef2aSThomas Huth static void dec_sub(DisasContext *dc) 287fcf5ef2aSThomas Huth { 288fcf5ef2aSThomas Huth unsigned int u, cmp, k, c; 289cfeea807SEdgar E. Iglesias TCGv_i32 cf, na; 290fcf5ef2aSThomas Huth 291fcf5ef2aSThomas Huth u = dc->imm & 2; 292fcf5ef2aSThomas Huth k = dc->opcode & 4; 293fcf5ef2aSThomas Huth c = dc->opcode & 2; 294fcf5ef2aSThomas Huth cmp = (dc->imm & 1) && (!dc->type_b) && k; 295fcf5ef2aSThomas Huth 296fcf5ef2aSThomas Huth if (cmp) { 297fcf5ef2aSThomas Huth LOG_DIS("cmp%s r%d, r%d ir=%x\n", u ? "u" : "", dc->rd, dc->ra, dc->ir); 298fcf5ef2aSThomas Huth if (dc->rd) { 299fcf5ef2aSThomas Huth if (u) 300fcf5ef2aSThomas Huth gen_helper_cmpu(cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]); 301fcf5ef2aSThomas Huth else 302fcf5ef2aSThomas Huth gen_helper_cmp(cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]); 303fcf5ef2aSThomas Huth } 304fcf5ef2aSThomas Huth return; 305fcf5ef2aSThomas Huth } 306fcf5ef2aSThomas Huth 307fcf5ef2aSThomas Huth LOG_DIS("sub%s%s r%d, r%d r%d\n", 308fcf5ef2aSThomas Huth k ? "k" : "", c ? "c" : "", dc->rd, dc->ra, dc->rb); 309fcf5ef2aSThomas Huth 310fcf5ef2aSThomas Huth /* Take care of the easy cases first. */ 311fcf5ef2aSThomas Huth if (k) { 312fcf5ef2aSThomas Huth /* k - keep carry, no need to update MSR. */ 313fcf5ef2aSThomas Huth /* If rd == r0, it's a nop. */ 314fcf5ef2aSThomas Huth if (dc->rd) { 315cfeea807SEdgar E. Iglesias tcg_gen_sub_i32(cpu_R[dc->rd], *(dec_alu_op_b(dc)), cpu_R[dc->ra]); 316fcf5ef2aSThomas Huth 317fcf5ef2aSThomas Huth if (c) { 318fcf5ef2aSThomas Huth /* c - Add carry into the result. */ 319cfeea807SEdgar E. Iglesias cf = tcg_temp_new_i32(); 320fcf5ef2aSThomas Huth 321fcf5ef2aSThomas Huth read_carry(dc, cf); 322cfeea807SEdgar E. Iglesias tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->rd], cf); 323cfeea807SEdgar E. Iglesias tcg_temp_free_i32(cf); 324fcf5ef2aSThomas Huth } 325fcf5ef2aSThomas Huth } 326fcf5ef2aSThomas Huth return; 327fcf5ef2aSThomas Huth } 328fcf5ef2aSThomas Huth 329fcf5ef2aSThomas Huth /* From now on, we can assume k is zero. So we need to update MSR. */ 330fcf5ef2aSThomas Huth /* Extract carry. And complement a into na. */ 331cfeea807SEdgar E. Iglesias cf = tcg_temp_new_i32(); 332cfeea807SEdgar E. Iglesias na = tcg_temp_new_i32(); 333fcf5ef2aSThomas Huth if (c) { 334fcf5ef2aSThomas Huth read_carry(dc, cf); 335fcf5ef2aSThomas Huth } else { 336cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cf, 1); 337fcf5ef2aSThomas Huth } 338fcf5ef2aSThomas Huth 339fcf5ef2aSThomas Huth /* d = b + ~a + c. carry defaults to 1. */ 340cfeea807SEdgar E. Iglesias tcg_gen_not_i32(na, cpu_R[dc->ra]); 341fcf5ef2aSThomas Huth 342fcf5ef2aSThomas Huth if (dc->rd) { 343cfeea807SEdgar E. Iglesias TCGv_i32 ncf = tcg_temp_new_i32(); 344fcf5ef2aSThomas Huth gen_helper_carry(ncf, na, *(dec_alu_op_b(dc)), cf); 345cfeea807SEdgar E. Iglesias tcg_gen_add_i32(cpu_R[dc->rd], na, *(dec_alu_op_b(dc))); 346cfeea807SEdgar E. Iglesias tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->rd], cf); 347fcf5ef2aSThomas Huth write_carry(dc, ncf); 348cfeea807SEdgar E. Iglesias tcg_temp_free_i32(ncf); 349fcf5ef2aSThomas Huth } else { 350fcf5ef2aSThomas Huth gen_helper_carry(cf, na, *(dec_alu_op_b(dc)), cf); 351fcf5ef2aSThomas Huth write_carry(dc, cf); 352fcf5ef2aSThomas Huth } 353cfeea807SEdgar E. Iglesias tcg_temp_free_i32(cf); 354cfeea807SEdgar E. Iglesias tcg_temp_free_i32(na); 355fcf5ef2aSThomas Huth } 356fcf5ef2aSThomas Huth 357fcf5ef2aSThomas Huth static void dec_pattern(DisasContext *dc) 358fcf5ef2aSThomas Huth { 359fcf5ef2aSThomas Huth unsigned int mode; 360fcf5ef2aSThomas Huth 3619ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, !dc->cpu->cfg.use_pcmp_instr)) { 3629ba8cd45SEdgar E. Iglesias return; 363fcf5ef2aSThomas Huth } 364fcf5ef2aSThomas Huth 365fcf5ef2aSThomas Huth mode = dc->opcode & 3; 366fcf5ef2aSThomas Huth switch (mode) { 367fcf5ef2aSThomas Huth case 0: 368fcf5ef2aSThomas Huth /* pcmpbf. */ 369fcf5ef2aSThomas Huth LOG_DIS("pcmpbf r%d r%d r%d\n", dc->rd, dc->ra, dc->rb); 370fcf5ef2aSThomas Huth if (dc->rd) 371fcf5ef2aSThomas Huth gen_helper_pcmpbf(cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]); 372fcf5ef2aSThomas Huth break; 373fcf5ef2aSThomas Huth case 2: 374fcf5ef2aSThomas Huth LOG_DIS("pcmpeq r%d r%d r%d\n", dc->rd, dc->ra, dc->rb); 375fcf5ef2aSThomas Huth if (dc->rd) { 376cfeea807SEdgar E. Iglesias tcg_gen_setcond_i32(TCG_COND_EQ, cpu_R[dc->rd], 377fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 378fcf5ef2aSThomas Huth } 379fcf5ef2aSThomas Huth break; 380fcf5ef2aSThomas Huth case 3: 381fcf5ef2aSThomas Huth LOG_DIS("pcmpne r%d r%d r%d\n", dc->rd, dc->ra, dc->rb); 382fcf5ef2aSThomas Huth if (dc->rd) { 383cfeea807SEdgar E. Iglesias tcg_gen_setcond_i32(TCG_COND_NE, cpu_R[dc->rd], 384fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 385fcf5ef2aSThomas Huth } 386fcf5ef2aSThomas Huth break; 387fcf5ef2aSThomas Huth default: 388fcf5ef2aSThomas Huth cpu_abort(CPU(dc->cpu), 389fcf5ef2aSThomas Huth "unsupported pattern insn opcode=%x\n", dc->opcode); 390fcf5ef2aSThomas Huth break; 391fcf5ef2aSThomas Huth } 392fcf5ef2aSThomas Huth } 393fcf5ef2aSThomas Huth 394fcf5ef2aSThomas Huth static void dec_and(DisasContext *dc) 395fcf5ef2aSThomas Huth { 396fcf5ef2aSThomas Huth unsigned int not; 397fcf5ef2aSThomas Huth 398fcf5ef2aSThomas Huth if (!dc->type_b && (dc->imm & (1 << 10))) { 399fcf5ef2aSThomas Huth dec_pattern(dc); 400fcf5ef2aSThomas Huth return; 401fcf5ef2aSThomas Huth } 402fcf5ef2aSThomas Huth 403fcf5ef2aSThomas Huth not = dc->opcode & (1 << 1); 404fcf5ef2aSThomas Huth LOG_DIS("and%s\n", not ? "n" : ""); 405fcf5ef2aSThomas Huth 406fcf5ef2aSThomas Huth if (!dc->rd) 407fcf5ef2aSThomas Huth return; 408fcf5ef2aSThomas Huth 409fcf5ef2aSThomas Huth if (not) { 410cfeea807SEdgar E. Iglesias tcg_gen_andc_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc))); 411fcf5ef2aSThomas Huth } else 412cfeea807SEdgar E. Iglesias tcg_gen_and_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc))); 413fcf5ef2aSThomas Huth } 414fcf5ef2aSThomas Huth 415fcf5ef2aSThomas Huth static void dec_or(DisasContext *dc) 416fcf5ef2aSThomas Huth { 417fcf5ef2aSThomas Huth if (!dc->type_b && (dc->imm & (1 << 10))) { 418fcf5ef2aSThomas Huth dec_pattern(dc); 419fcf5ef2aSThomas Huth return; 420fcf5ef2aSThomas Huth } 421fcf5ef2aSThomas Huth 422fcf5ef2aSThomas Huth LOG_DIS("or r%d r%d r%d imm=%x\n", dc->rd, dc->ra, dc->rb, dc->imm); 423fcf5ef2aSThomas Huth if (dc->rd) 424cfeea807SEdgar E. Iglesias tcg_gen_or_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc))); 425fcf5ef2aSThomas Huth } 426fcf5ef2aSThomas Huth 427fcf5ef2aSThomas Huth static void dec_xor(DisasContext *dc) 428fcf5ef2aSThomas Huth { 429fcf5ef2aSThomas Huth if (!dc->type_b && (dc->imm & (1 << 10))) { 430fcf5ef2aSThomas Huth dec_pattern(dc); 431fcf5ef2aSThomas Huth return; 432fcf5ef2aSThomas Huth } 433fcf5ef2aSThomas Huth 434fcf5ef2aSThomas Huth LOG_DIS("xor r%d\n", dc->rd); 435fcf5ef2aSThomas Huth if (dc->rd) 436cfeea807SEdgar E. Iglesias tcg_gen_xor_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc))); 437fcf5ef2aSThomas Huth } 438fcf5ef2aSThomas Huth 439cfeea807SEdgar E. Iglesias static inline void msr_read(DisasContext *dc, TCGv_i32 d) 440fcf5ef2aSThomas Huth { 441cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(d, cpu_SR[SR_MSR]); 442fcf5ef2aSThomas Huth } 443fcf5ef2aSThomas Huth 444cfeea807SEdgar E. Iglesias static inline void msr_write(DisasContext *dc, TCGv_i32 v) 445fcf5ef2aSThomas Huth { 446cfeea807SEdgar E. Iglesias TCGv_i32 t; 447fcf5ef2aSThomas Huth 448cfeea807SEdgar E. Iglesias t = tcg_temp_new_i32(); 449fcf5ef2aSThomas Huth dc->cpustate_changed = 1; 450fcf5ef2aSThomas Huth /* PVR bit is not writable. */ 451cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t, v, ~MSR_PVR); 452cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(cpu_SR[SR_MSR], cpu_SR[SR_MSR], MSR_PVR); 453cfeea807SEdgar E. Iglesias tcg_gen_or_i32(cpu_SR[SR_MSR], cpu_SR[SR_MSR], t); 454fcf5ef2aSThomas Huth tcg_temp_free(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; 461*2023e9a3SEdgar E. Iglesias unsigned int sr, rn; 462*2023e9a3SEdgar E. Iglesias bool to, clrset; 463fcf5ef2aSThomas Huth 464*2023e9a3SEdgar E. Iglesias sr = extract32(dc->imm, 0, 14); 465*2023e9a3SEdgar E. Iglesias to = extract32(dc->imm, 14, 1); 466*2023e9a3SEdgar E. Iglesias clrset = extract32(dc->imm, 15, 1) == 0; 467fcf5ef2aSThomas Huth dc->type_b = 1; 468*2023e9a3SEdgar E. Iglesias if (to) { 469fcf5ef2aSThomas Huth dc->cpustate_changed = 1; 470*2023e9a3SEdgar E. Iglesias } 471fcf5ef2aSThomas Huth 472fcf5ef2aSThomas Huth /* msrclr and msrset. */ 473*2023e9a3SEdgar E. Iglesias if (clrset) { 474*2023e9a3SEdgar E. Iglesias bool clr = extract32(dc->ir, 16, 1); 475fcf5ef2aSThomas Huth 476fcf5ef2aSThomas Huth LOG_DIS("msr%s r%d imm=%x\n", clr ? "clr" : "set", 477fcf5ef2aSThomas Huth dc->rd, dc->imm); 478fcf5ef2aSThomas Huth 47956837509SEdgar E. Iglesias if (!dc->cpu->cfg.use_msr_instr) { 480fcf5ef2aSThomas Huth /* nop??? */ 481fcf5ef2aSThomas Huth return; 482fcf5ef2aSThomas Huth } 483fcf5ef2aSThomas Huth 484bdfc1e88SEdgar E. Iglesias if (trap_userspace(dc, dc->imm != 4 && dc->imm != 0)) { 485fcf5ef2aSThomas Huth return; 486fcf5ef2aSThomas Huth } 487fcf5ef2aSThomas Huth 488fcf5ef2aSThomas Huth if (dc->rd) 489fcf5ef2aSThomas Huth msr_read(dc, cpu_R[dc->rd]); 490fcf5ef2aSThomas Huth 491cfeea807SEdgar E. Iglesias t0 = tcg_temp_new_i32(); 492cfeea807SEdgar E. Iglesias t1 = tcg_temp_new_i32(); 493fcf5ef2aSThomas Huth msr_read(dc, t0); 494cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(t1, *(dec_alu_op_b(dc))); 495fcf5ef2aSThomas Huth 496fcf5ef2aSThomas Huth if (clr) { 497cfeea807SEdgar E. Iglesias tcg_gen_not_i32(t1, t1); 498cfeea807SEdgar E. Iglesias tcg_gen_and_i32(t0, t0, t1); 499fcf5ef2aSThomas Huth } else 500cfeea807SEdgar E. Iglesias tcg_gen_or_i32(t0, t0, t1); 501fcf5ef2aSThomas Huth msr_write(dc, t0); 502cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t0); 503cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t1); 504cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_SR[SR_PC], dc->pc + 4); 505fcf5ef2aSThomas Huth dc->is_jmp = DISAS_UPDATE; 506fcf5ef2aSThomas Huth return; 507fcf5ef2aSThomas Huth } 508fcf5ef2aSThomas Huth 509bdfc1e88SEdgar E. Iglesias if (trap_userspace(dc, to)) { 510fcf5ef2aSThomas Huth return; 511fcf5ef2aSThomas Huth } 512fcf5ef2aSThomas Huth 513fcf5ef2aSThomas Huth #if !defined(CONFIG_USER_ONLY) 514fcf5ef2aSThomas Huth /* Catch read/writes to the mmu block. */ 515fcf5ef2aSThomas Huth if ((sr & ~0xff) == 0x1000) { 516fcf5ef2aSThomas Huth sr &= 7; 517fcf5ef2aSThomas Huth LOG_DIS("m%ss sr%d r%d imm=%x\n", to ? "t" : "f", sr, dc->ra, dc->imm); 518fcf5ef2aSThomas Huth if (to) 519cfeea807SEdgar E. Iglesias gen_helper_mmu_write(cpu_env, tcg_const_i32(sr), cpu_R[dc->ra]); 520fcf5ef2aSThomas Huth else 521cfeea807SEdgar E. Iglesias gen_helper_mmu_read(cpu_R[dc->rd], cpu_env, tcg_const_i32(sr)); 522fcf5ef2aSThomas Huth return; 523fcf5ef2aSThomas Huth } 524fcf5ef2aSThomas Huth #endif 525fcf5ef2aSThomas Huth 526fcf5ef2aSThomas Huth if (to) { 527fcf5ef2aSThomas Huth LOG_DIS("m%ss sr%x r%d imm=%x\n", to ? "t" : "f", sr, dc->ra, dc->imm); 528fcf5ef2aSThomas Huth switch (sr) { 529fcf5ef2aSThomas Huth case 0: 530fcf5ef2aSThomas Huth break; 531fcf5ef2aSThomas Huth case 1: 532fcf5ef2aSThomas Huth msr_write(dc, cpu_R[dc->ra]); 533fcf5ef2aSThomas Huth break; 534fcf5ef2aSThomas Huth case 0x3: 535cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(cpu_SR[SR_EAR], cpu_R[dc->ra]); 536fcf5ef2aSThomas Huth break; 537fcf5ef2aSThomas Huth case 0x5: 538cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(cpu_SR[SR_ESR], cpu_R[dc->ra]); 539fcf5ef2aSThomas Huth break; 540fcf5ef2aSThomas Huth case 0x7: 541cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(cpu_SR[SR_FSR], cpu_R[dc->ra], 31); 542fcf5ef2aSThomas Huth break; 543fcf5ef2aSThomas Huth case 0x800: 544cfeea807SEdgar E. Iglesias tcg_gen_st_i32(cpu_R[dc->ra], 545cfeea807SEdgar E. Iglesias cpu_env, offsetof(CPUMBState, slr)); 546fcf5ef2aSThomas Huth break; 547fcf5ef2aSThomas Huth case 0x802: 548cfeea807SEdgar E. Iglesias tcg_gen_st_i32(cpu_R[dc->ra], 549cfeea807SEdgar E. Iglesias cpu_env, offsetof(CPUMBState, shr)); 550fcf5ef2aSThomas Huth break; 551fcf5ef2aSThomas Huth default: 552fcf5ef2aSThomas Huth cpu_abort(CPU(dc->cpu), "unknown mts reg %x\n", sr); 553fcf5ef2aSThomas Huth break; 554fcf5ef2aSThomas Huth } 555fcf5ef2aSThomas Huth } else { 556fcf5ef2aSThomas Huth LOG_DIS("m%ss r%d sr%x imm=%x\n", to ? "t" : "f", dc->rd, sr, dc->imm); 557fcf5ef2aSThomas Huth 558fcf5ef2aSThomas Huth switch (sr) { 559fcf5ef2aSThomas Huth case 0: 560cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_R[dc->rd], dc->pc); 561fcf5ef2aSThomas Huth break; 562fcf5ef2aSThomas Huth case 1: 563fcf5ef2aSThomas Huth msr_read(dc, cpu_R[dc->rd]); 564fcf5ef2aSThomas Huth break; 565fcf5ef2aSThomas Huth case 0x3: 566cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(cpu_R[dc->rd], cpu_SR[SR_EAR]); 567fcf5ef2aSThomas Huth break; 568fcf5ef2aSThomas Huth case 0x5: 569cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(cpu_R[dc->rd], cpu_SR[SR_ESR]); 570fcf5ef2aSThomas Huth break; 571fcf5ef2aSThomas Huth case 0x7: 572cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(cpu_R[dc->rd], cpu_SR[SR_FSR]); 573fcf5ef2aSThomas Huth break; 574fcf5ef2aSThomas Huth case 0xb: 575cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(cpu_R[dc->rd], cpu_SR[SR_BTR]); 576fcf5ef2aSThomas Huth break; 577fcf5ef2aSThomas Huth case 0x800: 578cfeea807SEdgar E. Iglesias tcg_gen_ld_i32(cpu_R[dc->rd], 579cfeea807SEdgar E. Iglesias cpu_env, offsetof(CPUMBState, slr)); 580fcf5ef2aSThomas Huth break; 581fcf5ef2aSThomas Huth case 0x802: 582cfeea807SEdgar E. Iglesias tcg_gen_ld_i32(cpu_R[dc->rd], 583cfeea807SEdgar E. Iglesias cpu_env, offsetof(CPUMBState, shr)); 584fcf5ef2aSThomas Huth break; 585fcf5ef2aSThomas Huth case 0x2000: 586fcf5ef2aSThomas Huth case 0x2001: 587fcf5ef2aSThomas Huth case 0x2002: 588fcf5ef2aSThomas Huth case 0x2003: 589fcf5ef2aSThomas Huth case 0x2004: 590fcf5ef2aSThomas Huth case 0x2005: 591fcf5ef2aSThomas Huth case 0x2006: 592fcf5ef2aSThomas Huth case 0x2007: 593fcf5ef2aSThomas Huth case 0x2008: 594fcf5ef2aSThomas Huth case 0x2009: 595fcf5ef2aSThomas Huth case 0x200a: 596fcf5ef2aSThomas Huth case 0x200b: 597fcf5ef2aSThomas Huth case 0x200c: 598fcf5ef2aSThomas Huth rn = sr & 0xf; 599cfeea807SEdgar E. Iglesias tcg_gen_ld_i32(cpu_R[dc->rd], 600fcf5ef2aSThomas Huth cpu_env, offsetof(CPUMBState, pvr.regs[rn])); 601fcf5ef2aSThomas Huth break; 602fcf5ef2aSThomas Huth default: 603fcf5ef2aSThomas Huth cpu_abort(cs, "unknown mfs reg %x\n", sr); 604fcf5ef2aSThomas Huth break; 605fcf5ef2aSThomas Huth } 606fcf5ef2aSThomas Huth } 607fcf5ef2aSThomas Huth 608fcf5ef2aSThomas Huth if (dc->rd == 0) { 609cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_R[0], 0); 610fcf5ef2aSThomas Huth } 611fcf5ef2aSThomas Huth } 612fcf5ef2aSThomas Huth 613fcf5ef2aSThomas Huth /* Multiplier unit. */ 614fcf5ef2aSThomas Huth static void dec_mul(DisasContext *dc) 615fcf5ef2aSThomas Huth { 616cfeea807SEdgar E. Iglesias TCGv_i32 tmp; 617fcf5ef2aSThomas Huth unsigned int subcode; 618fcf5ef2aSThomas Huth 6199ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, !dc->cpu->cfg.use_hw_mul)) { 620fcf5ef2aSThomas Huth return; 621fcf5ef2aSThomas Huth } 622fcf5ef2aSThomas Huth 623fcf5ef2aSThomas Huth subcode = dc->imm & 3; 624fcf5ef2aSThomas Huth 625fcf5ef2aSThomas Huth if (dc->type_b) { 626fcf5ef2aSThomas Huth LOG_DIS("muli r%d r%d %x\n", dc->rd, dc->ra, dc->imm); 627cfeea807SEdgar E. Iglesias tcg_gen_mul_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc))); 628fcf5ef2aSThomas Huth return; 629fcf5ef2aSThomas Huth } 630fcf5ef2aSThomas Huth 631fcf5ef2aSThomas Huth /* mulh, mulhsu and mulhu are not available if C_USE_HW_MUL is < 2. */ 6329b964318SEdgar E. Iglesias if (subcode >= 1 && subcode <= 3 && dc->cpu->cfg.use_hw_mul < 2) { 633fcf5ef2aSThomas Huth /* nop??? */ 634fcf5ef2aSThomas Huth } 635fcf5ef2aSThomas Huth 636cfeea807SEdgar E. Iglesias tmp = tcg_temp_new_i32(); 637fcf5ef2aSThomas Huth switch (subcode) { 638fcf5ef2aSThomas Huth case 0: 639fcf5ef2aSThomas Huth LOG_DIS("mul r%d r%d r%d\n", dc->rd, dc->ra, dc->rb); 640cfeea807SEdgar E. Iglesias tcg_gen_mul_i32(cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]); 641fcf5ef2aSThomas Huth break; 642fcf5ef2aSThomas Huth case 1: 643fcf5ef2aSThomas Huth LOG_DIS("mulh r%d r%d r%d\n", dc->rd, dc->ra, dc->rb); 644cfeea807SEdgar E. Iglesias tcg_gen_muls2_i32(tmp, cpu_R[dc->rd], 645cfeea807SEdgar E. Iglesias cpu_R[dc->ra], cpu_R[dc->rb]); 646fcf5ef2aSThomas Huth break; 647fcf5ef2aSThomas Huth case 2: 648fcf5ef2aSThomas Huth LOG_DIS("mulhsu r%d r%d r%d\n", dc->rd, dc->ra, dc->rb); 649cfeea807SEdgar E. Iglesias tcg_gen_mulsu2_i32(tmp, cpu_R[dc->rd], 650cfeea807SEdgar E. Iglesias cpu_R[dc->ra], cpu_R[dc->rb]); 651fcf5ef2aSThomas Huth break; 652fcf5ef2aSThomas Huth case 3: 653fcf5ef2aSThomas Huth LOG_DIS("mulhu r%d r%d r%d\n", dc->rd, dc->ra, dc->rb); 654cfeea807SEdgar E. Iglesias tcg_gen_mulu2_i32(tmp, cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]); 655fcf5ef2aSThomas Huth break; 656fcf5ef2aSThomas Huth default: 657fcf5ef2aSThomas Huth cpu_abort(CPU(dc->cpu), "unknown MUL insn %x\n", subcode); 658fcf5ef2aSThomas Huth break; 659fcf5ef2aSThomas Huth } 660cfeea807SEdgar E. Iglesias tcg_temp_free_i32(tmp); 661fcf5ef2aSThomas Huth } 662fcf5ef2aSThomas Huth 663fcf5ef2aSThomas Huth /* Div unit. */ 664fcf5ef2aSThomas Huth static void dec_div(DisasContext *dc) 665fcf5ef2aSThomas Huth { 666fcf5ef2aSThomas Huth unsigned int u; 667fcf5ef2aSThomas Huth 668fcf5ef2aSThomas Huth u = dc->imm & 2; 669fcf5ef2aSThomas Huth LOG_DIS("div\n"); 670fcf5ef2aSThomas Huth 6719ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, !dc->cpu->cfg.use_div)) { 6729ba8cd45SEdgar E. Iglesias return; 673fcf5ef2aSThomas Huth } 674fcf5ef2aSThomas Huth 675fcf5ef2aSThomas Huth if (u) 676fcf5ef2aSThomas Huth gen_helper_divu(cpu_R[dc->rd], cpu_env, *(dec_alu_op_b(dc)), 677fcf5ef2aSThomas Huth cpu_R[dc->ra]); 678fcf5ef2aSThomas Huth else 679fcf5ef2aSThomas Huth gen_helper_divs(cpu_R[dc->rd], cpu_env, *(dec_alu_op_b(dc)), 680fcf5ef2aSThomas Huth cpu_R[dc->ra]); 681fcf5ef2aSThomas Huth if (!dc->rd) 682cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_R[dc->rd], 0); 683fcf5ef2aSThomas Huth } 684fcf5ef2aSThomas Huth 685fcf5ef2aSThomas Huth static void dec_barrel(DisasContext *dc) 686fcf5ef2aSThomas Huth { 687cfeea807SEdgar E. Iglesias TCGv_i32 t0; 688faa48d74SEdgar E. Iglesias unsigned int imm_w, imm_s; 689d09b2585SEdgar E. Iglesias bool s, t, e = false, i = false; 690fcf5ef2aSThomas Huth 6919ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, !dc->cpu->cfg.use_barrel)) { 692fcf5ef2aSThomas Huth return; 693fcf5ef2aSThomas Huth } 694fcf5ef2aSThomas Huth 695faa48d74SEdgar E. Iglesias if (dc->type_b) { 696faa48d74SEdgar E. Iglesias /* Insert and extract are only available in immediate mode. */ 697d09b2585SEdgar E. Iglesias i = extract32(dc->imm, 15, 1); 698faa48d74SEdgar E. Iglesias e = extract32(dc->imm, 14, 1); 699faa48d74SEdgar E. Iglesias } 700e3e84983SEdgar E. Iglesias s = extract32(dc->imm, 10, 1); 701e3e84983SEdgar E. Iglesias t = extract32(dc->imm, 9, 1); 702faa48d74SEdgar E. Iglesias imm_w = extract32(dc->imm, 6, 5); 703faa48d74SEdgar E. Iglesias imm_s = extract32(dc->imm, 0, 5); 704fcf5ef2aSThomas Huth 705faa48d74SEdgar E. Iglesias LOG_DIS("bs%s%s%s r%d r%d r%d\n", 706faa48d74SEdgar E. Iglesias e ? "e" : "", 707fcf5ef2aSThomas Huth s ? "l" : "r", t ? "a" : "l", dc->rd, dc->ra, dc->rb); 708fcf5ef2aSThomas Huth 709faa48d74SEdgar E. Iglesias if (e) { 710faa48d74SEdgar E. Iglesias if (imm_w + imm_s > 32 || imm_w == 0) { 711faa48d74SEdgar E. Iglesias /* These inputs have an undefined behavior. */ 712faa48d74SEdgar E. Iglesias qemu_log_mask(LOG_GUEST_ERROR, "bsefi: Bad input w=%d s=%d\n", 713faa48d74SEdgar E. Iglesias imm_w, imm_s); 714faa48d74SEdgar E. Iglesias } else { 715faa48d74SEdgar E. Iglesias tcg_gen_extract_i32(cpu_R[dc->rd], cpu_R[dc->ra], imm_s, imm_w); 716faa48d74SEdgar E. Iglesias } 717d09b2585SEdgar E. Iglesias } else if (i) { 718d09b2585SEdgar E. Iglesias int width = imm_w - imm_s + 1; 719d09b2585SEdgar E. Iglesias 720d09b2585SEdgar E. Iglesias if (imm_w < imm_s) { 721d09b2585SEdgar E. Iglesias /* These inputs have an undefined behavior. */ 722d09b2585SEdgar E. Iglesias qemu_log_mask(LOG_GUEST_ERROR, "bsifi: Bad input w=%d s=%d\n", 723d09b2585SEdgar E. Iglesias imm_w, imm_s); 724d09b2585SEdgar E. Iglesias } else { 725d09b2585SEdgar E. Iglesias tcg_gen_deposit_i32(cpu_R[dc->rd], cpu_R[dc->rd], cpu_R[dc->ra], 726d09b2585SEdgar E. Iglesias imm_s, width); 727d09b2585SEdgar E. Iglesias } 728faa48d74SEdgar E. Iglesias } else { 729cfeea807SEdgar E. Iglesias t0 = tcg_temp_new_i32(); 730fcf5ef2aSThomas Huth 731cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(t0, *(dec_alu_op_b(dc))); 732cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t0, t0, 31); 733fcf5ef2aSThomas Huth 7342acf6d53SEdgar E. Iglesias if (s) { 735cfeea807SEdgar E. Iglesias tcg_gen_shl_i32(cpu_R[dc->rd], cpu_R[dc->ra], t0); 7362acf6d53SEdgar E. Iglesias } else { 7372acf6d53SEdgar E. Iglesias if (t) { 738cfeea807SEdgar E. Iglesias tcg_gen_sar_i32(cpu_R[dc->rd], cpu_R[dc->ra], t0); 7392acf6d53SEdgar E. Iglesias } else { 740cfeea807SEdgar E. Iglesias tcg_gen_shr_i32(cpu_R[dc->rd], cpu_R[dc->ra], t0); 741fcf5ef2aSThomas Huth } 742fcf5ef2aSThomas Huth } 743cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t0); 7442acf6d53SEdgar E. Iglesias } 745faa48d74SEdgar E. Iglesias } 746fcf5ef2aSThomas Huth 747fcf5ef2aSThomas Huth static void dec_bit(DisasContext *dc) 748fcf5ef2aSThomas Huth { 749fcf5ef2aSThomas Huth CPUState *cs = CPU(dc->cpu); 750cfeea807SEdgar E. Iglesias TCGv_i32 t0; 751fcf5ef2aSThomas Huth unsigned int op; 752fcf5ef2aSThomas Huth 753fcf5ef2aSThomas Huth op = dc->ir & ((1 << 9) - 1); 754fcf5ef2aSThomas Huth switch (op) { 755fcf5ef2aSThomas Huth case 0x21: 756fcf5ef2aSThomas Huth /* src. */ 757cfeea807SEdgar E. Iglesias t0 = tcg_temp_new_i32(); 758fcf5ef2aSThomas Huth 759fcf5ef2aSThomas Huth LOG_DIS("src r%d r%d\n", dc->rd, dc->ra); 760cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t0, cpu_SR[SR_MSR], MSR_CC); 761fcf5ef2aSThomas Huth write_carry(dc, cpu_R[dc->ra]); 762fcf5ef2aSThomas Huth if (dc->rd) { 763cfeea807SEdgar E. Iglesias tcg_gen_shri_i32(cpu_R[dc->rd], cpu_R[dc->ra], 1); 764cfeea807SEdgar E. Iglesias tcg_gen_or_i32(cpu_R[dc->rd], cpu_R[dc->rd], t0); 765fcf5ef2aSThomas Huth } 766cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t0); 767fcf5ef2aSThomas Huth break; 768fcf5ef2aSThomas Huth 769fcf5ef2aSThomas Huth case 0x1: 770fcf5ef2aSThomas Huth case 0x41: 771fcf5ef2aSThomas Huth /* srl. */ 772fcf5ef2aSThomas Huth LOG_DIS("srl r%d r%d\n", dc->rd, dc->ra); 773fcf5ef2aSThomas Huth 774fcf5ef2aSThomas Huth /* Update carry. Note that write carry only looks at the LSB. */ 775fcf5ef2aSThomas Huth write_carry(dc, cpu_R[dc->ra]); 776fcf5ef2aSThomas Huth if (dc->rd) { 777fcf5ef2aSThomas Huth if (op == 0x41) 778cfeea807SEdgar E. Iglesias tcg_gen_shri_i32(cpu_R[dc->rd], cpu_R[dc->ra], 1); 779fcf5ef2aSThomas Huth else 780cfeea807SEdgar E. Iglesias tcg_gen_sari_i32(cpu_R[dc->rd], cpu_R[dc->ra], 1); 781fcf5ef2aSThomas Huth } 782fcf5ef2aSThomas Huth break; 783fcf5ef2aSThomas Huth case 0x60: 784fcf5ef2aSThomas Huth LOG_DIS("ext8s r%d r%d\n", dc->rd, dc->ra); 785fcf5ef2aSThomas Huth tcg_gen_ext8s_i32(cpu_R[dc->rd], cpu_R[dc->ra]); 786fcf5ef2aSThomas Huth break; 787fcf5ef2aSThomas Huth case 0x61: 788fcf5ef2aSThomas Huth LOG_DIS("ext16s r%d r%d\n", dc->rd, dc->ra); 789fcf5ef2aSThomas Huth tcg_gen_ext16s_i32(cpu_R[dc->rd], cpu_R[dc->ra]); 790fcf5ef2aSThomas Huth break; 791fcf5ef2aSThomas Huth case 0x64: 792fcf5ef2aSThomas Huth case 0x66: 793fcf5ef2aSThomas Huth case 0x74: 794fcf5ef2aSThomas Huth case 0x76: 795fcf5ef2aSThomas Huth /* wdc. */ 796fcf5ef2aSThomas Huth LOG_DIS("wdc r%d\n", dc->ra); 797bdfc1e88SEdgar E. Iglesias trap_userspace(dc, true); 798fcf5ef2aSThomas Huth break; 799fcf5ef2aSThomas Huth case 0x68: 800fcf5ef2aSThomas Huth /* wic. */ 801fcf5ef2aSThomas Huth LOG_DIS("wic r%d\n", dc->ra); 802bdfc1e88SEdgar E. Iglesias trap_userspace(dc, true); 803fcf5ef2aSThomas Huth break; 804fcf5ef2aSThomas Huth case 0xe0: 8059ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, !dc->cpu->cfg.use_pcmp_instr)) { 8069ba8cd45SEdgar E. Iglesias return; 807fcf5ef2aSThomas Huth } 8088fc5239eSEdgar E. Iglesias if (dc->cpu->cfg.use_pcmp_instr) { 8095318420cSRichard Henderson tcg_gen_clzi_i32(cpu_R[dc->rd], cpu_R[dc->ra], 32); 810fcf5ef2aSThomas Huth } 811fcf5ef2aSThomas Huth break; 812fcf5ef2aSThomas Huth case 0x1e0: 813fcf5ef2aSThomas Huth /* swapb */ 814fcf5ef2aSThomas Huth LOG_DIS("swapb r%d r%d\n", dc->rd, dc->ra); 815fcf5ef2aSThomas Huth tcg_gen_bswap32_i32(cpu_R[dc->rd], cpu_R[dc->ra]); 816fcf5ef2aSThomas Huth break; 817fcf5ef2aSThomas Huth case 0x1e2: 818fcf5ef2aSThomas Huth /*swaph */ 819fcf5ef2aSThomas Huth LOG_DIS("swaph r%d r%d\n", dc->rd, dc->ra); 820fcf5ef2aSThomas Huth tcg_gen_rotri_i32(cpu_R[dc->rd], cpu_R[dc->ra], 16); 821fcf5ef2aSThomas Huth break; 822fcf5ef2aSThomas Huth default: 823fcf5ef2aSThomas Huth cpu_abort(cs, "unknown bit oc=%x op=%x rd=%d ra=%d rb=%d\n", 824fcf5ef2aSThomas Huth dc->pc, op, dc->rd, dc->ra, dc->rb); 825fcf5ef2aSThomas Huth break; 826fcf5ef2aSThomas Huth } 827fcf5ef2aSThomas Huth } 828fcf5ef2aSThomas Huth 829fcf5ef2aSThomas Huth static inline void sync_jmpstate(DisasContext *dc) 830fcf5ef2aSThomas Huth { 831fcf5ef2aSThomas Huth if (dc->jmp == JMP_DIRECT || dc->jmp == JMP_DIRECT_CC) { 832fcf5ef2aSThomas Huth if (dc->jmp == JMP_DIRECT) { 833cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_btaken, 1); 834fcf5ef2aSThomas Huth } 835fcf5ef2aSThomas Huth dc->jmp = JMP_INDIRECT; 836cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_btarget, dc->jmp_pc); 837fcf5ef2aSThomas Huth } 838fcf5ef2aSThomas Huth } 839fcf5ef2aSThomas Huth 840fcf5ef2aSThomas Huth static void dec_imm(DisasContext *dc) 841fcf5ef2aSThomas Huth { 842fcf5ef2aSThomas Huth LOG_DIS("imm %x\n", dc->imm << 16); 843cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_imm, (dc->imm << 16)); 844fcf5ef2aSThomas Huth dc->tb_flags |= IMM_FLAG; 845fcf5ef2aSThomas Huth dc->clear_imm = 0; 846fcf5ef2aSThomas Huth } 847fcf5ef2aSThomas Huth 848403322eaSEdgar E. Iglesias static inline void compute_ldst_addr(DisasContext *dc, TCGv t) 849fcf5ef2aSThomas Huth { 8500e9033c8SEdgar E. Iglesias bool extimm = dc->tb_flags & IMM_FLAG; 8510e9033c8SEdgar E. Iglesias /* Should be set to true if r1 is used by loadstores. */ 8520e9033c8SEdgar E. Iglesias bool stackprot = false; 853403322eaSEdgar E. Iglesias TCGv_i32 t32; 854fcf5ef2aSThomas Huth 855fcf5ef2aSThomas Huth /* All load/stores use ra. */ 856fcf5ef2aSThomas Huth if (dc->ra == 1 && dc->cpu->cfg.stackprot) { 8570e9033c8SEdgar E. Iglesias stackprot = true; 858fcf5ef2aSThomas Huth } 859fcf5ef2aSThomas Huth 860fcf5ef2aSThomas Huth /* Treat the common cases first. */ 861fcf5ef2aSThomas Huth if (!dc->type_b) { 8620dc4af5cSEdgar E. Iglesias /* If any of the regs is r0, set t to the value of the other reg. */ 863fcf5ef2aSThomas Huth if (dc->ra == 0) { 864403322eaSEdgar E. Iglesias tcg_gen_extu_i32_tl(t, cpu_R[dc->rb]); 8650dc4af5cSEdgar E. Iglesias return; 866fcf5ef2aSThomas Huth } else if (dc->rb == 0) { 867403322eaSEdgar E. Iglesias tcg_gen_extu_i32_tl(t, cpu_R[dc->ra]); 8680dc4af5cSEdgar E. Iglesias return; 869fcf5ef2aSThomas Huth } 870fcf5ef2aSThomas Huth 871fcf5ef2aSThomas Huth if (dc->rb == 1 && dc->cpu->cfg.stackprot) { 8720e9033c8SEdgar E. Iglesias stackprot = true; 873fcf5ef2aSThomas Huth } 874fcf5ef2aSThomas Huth 875403322eaSEdgar E. Iglesias t32 = tcg_temp_new_i32(); 876403322eaSEdgar E. Iglesias tcg_gen_add_i32(t32, cpu_R[dc->ra], cpu_R[dc->rb]); 877403322eaSEdgar E. Iglesias tcg_gen_extu_i32_tl(t, t32); 878403322eaSEdgar E. Iglesias tcg_temp_free_i32(t32); 879fcf5ef2aSThomas Huth 880fcf5ef2aSThomas Huth if (stackprot) { 8810a87e691SEdgar E. Iglesias gen_helper_stackprot(cpu_env, t); 882fcf5ef2aSThomas Huth } 8830dc4af5cSEdgar E. Iglesias return; 884fcf5ef2aSThomas Huth } 885fcf5ef2aSThomas Huth /* Immediate. */ 886403322eaSEdgar E. Iglesias t32 = tcg_temp_new_i32(); 887fcf5ef2aSThomas Huth if (!extimm) { 888fcf5ef2aSThomas Huth if (dc->imm == 0) { 889403322eaSEdgar E. Iglesias tcg_gen_mov_i32(t32, cpu_R[dc->ra]); 890fcf5ef2aSThomas Huth } else { 891403322eaSEdgar E. Iglesias tcg_gen_movi_i32(t32, (int32_t)((int16_t)dc->imm)); 892403322eaSEdgar E. Iglesias tcg_gen_add_i32(t32, cpu_R[dc->ra], t32); 893fcf5ef2aSThomas Huth } 894403322eaSEdgar E. Iglesias } else { 895403322eaSEdgar E. Iglesias tcg_gen_add_i32(t32, cpu_R[dc->ra], *(dec_alu_op_b(dc))); 896403322eaSEdgar E. Iglesias } 897403322eaSEdgar E. Iglesias tcg_gen_extu_i32_tl(t, t32); 898403322eaSEdgar E. Iglesias tcg_temp_free_i32(t32); 899fcf5ef2aSThomas Huth 900fcf5ef2aSThomas Huth if (stackprot) { 9010a87e691SEdgar E. Iglesias gen_helper_stackprot(cpu_env, t); 902fcf5ef2aSThomas Huth } 9030dc4af5cSEdgar E. Iglesias return; 904fcf5ef2aSThomas Huth } 905fcf5ef2aSThomas Huth 906fcf5ef2aSThomas Huth static void dec_load(DisasContext *dc) 907fcf5ef2aSThomas Huth { 908403322eaSEdgar E. Iglesias TCGv_i32 v; 909403322eaSEdgar E. Iglesias TCGv addr; 9108534063aSEdgar E. Iglesias unsigned int size; 9118534063aSEdgar E. Iglesias bool rev = false, ex = false; 912fcf5ef2aSThomas Huth TCGMemOp mop; 913fcf5ef2aSThomas Huth 914fcf5ef2aSThomas Huth mop = dc->opcode & 3; 915fcf5ef2aSThomas Huth size = 1 << mop; 916fcf5ef2aSThomas Huth if (!dc->type_b) { 9178534063aSEdgar E. Iglesias rev = extract32(dc->ir, 9, 1); 9188534063aSEdgar E. Iglesias ex = extract32(dc->ir, 10, 1); 919fcf5ef2aSThomas Huth } 920fcf5ef2aSThomas Huth mop |= MO_TE; 921fcf5ef2aSThomas Huth if (rev) { 922fcf5ef2aSThomas Huth mop ^= MO_BSWAP; 923fcf5ef2aSThomas Huth } 924fcf5ef2aSThomas Huth 9259ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, size > 4)) { 926fcf5ef2aSThomas Huth return; 927fcf5ef2aSThomas Huth } 928fcf5ef2aSThomas Huth 929fcf5ef2aSThomas Huth LOG_DIS("l%d%s%s%s\n", size, dc->type_b ? "i" : "", rev ? "r" : "", 930fcf5ef2aSThomas Huth ex ? "x" : ""); 931fcf5ef2aSThomas Huth 932fcf5ef2aSThomas Huth t_sync_flags(dc); 933403322eaSEdgar E. Iglesias addr = tcg_temp_new(); 9340a87e691SEdgar E. Iglesias compute_ldst_addr(dc, addr); 935fcf5ef2aSThomas Huth 936fcf5ef2aSThomas Huth /* 937fcf5ef2aSThomas Huth * When doing reverse accesses we need to do two things. 938fcf5ef2aSThomas Huth * 939fcf5ef2aSThomas Huth * 1. Reverse the address wrt endianness. 940fcf5ef2aSThomas Huth * 2. Byteswap the data lanes on the way back into the CPU core. 941fcf5ef2aSThomas Huth */ 942fcf5ef2aSThomas Huth if (rev && size != 4) { 943fcf5ef2aSThomas Huth /* Endian reverse the address. t is addr. */ 944fcf5ef2aSThomas Huth switch (size) { 945fcf5ef2aSThomas Huth case 1: 946fcf5ef2aSThomas Huth { 947fcf5ef2aSThomas Huth /* 00 -> 11 948fcf5ef2aSThomas Huth 01 -> 10 949fcf5ef2aSThomas Huth 10 -> 10 950fcf5ef2aSThomas Huth 11 -> 00 */ 951403322eaSEdgar E. Iglesias TCGv low = tcg_temp_new(); 952fcf5ef2aSThomas Huth 953403322eaSEdgar E. Iglesias tcg_gen_andi_tl(low, addr, 3); 954403322eaSEdgar E. Iglesias tcg_gen_sub_tl(low, tcg_const_tl(3), low); 955403322eaSEdgar E. Iglesias tcg_gen_andi_tl(addr, addr, ~3); 956403322eaSEdgar E. Iglesias tcg_gen_or_tl(addr, addr, low); 957403322eaSEdgar E. Iglesias tcg_temp_free(low); 958fcf5ef2aSThomas Huth break; 959fcf5ef2aSThomas Huth } 960fcf5ef2aSThomas Huth 961fcf5ef2aSThomas Huth case 2: 962fcf5ef2aSThomas Huth /* 00 -> 10 963fcf5ef2aSThomas Huth 10 -> 00. */ 964403322eaSEdgar E. Iglesias tcg_gen_xori_tl(addr, addr, 2); 965fcf5ef2aSThomas Huth break; 966fcf5ef2aSThomas Huth default: 967fcf5ef2aSThomas Huth cpu_abort(CPU(dc->cpu), "Invalid reverse size\n"); 968fcf5ef2aSThomas Huth break; 969fcf5ef2aSThomas Huth } 970fcf5ef2aSThomas Huth } 971fcf5ef2aSThomas Huth 972fcf5ef2aSThomas Huth /* lwx does not throw unaligned access errors, so force alignment */ 973fcf5ef2aSThomas Huth if (ex) { 974403322eaSEdgar E. Iglesias tcg_gen_andi_tl(addr, addr, ~3); 975fcf5ef2aSThomas Huth } 976fcf5ef2aSThomas Huth 977fcf5ef2aSThomas Huth /* If we get a fault on a dslot, the jmpstate better be in sync. */ 978fcf5ef2aSThomas Huth sync_jmpstate(dc); 979fcf5ef2aSThomas Huth 980fcf5ef2aSThomas Huth /* Verify alignment if needed. */ 981fcf5ef2aSThomas Huth /* 982fcf5ef2aSThomas Huth * Microblaze gives MMU faults priority over faults due to 983fcf5ef2aSThomas Huth * unaligned addresses. That's why we speculatively do the load 984fcf5ef2aSThomas Huth * into v. If the load succeeds, we verify alignment of the 985fcf5ef2aSThomas Huth * address and if that succeeds we write into the destination reg. 986fcf5ef2aSThomas Huth */ 987cfeea807SEdgar E. Iglesias v = tcg_temp_new_i32(); 9880dc4af5cSEdgar E. Iglesias tcg_gen_qemu_ld_i32(v, addr, cpu_mmu_index(&dc->cpu->env, false), mop); 989fcf5ef2aSThomas Huth 990fcf5ef2aSThomas Huth if ((dc->cpu->env.pvr.regs[2] & PVR2_UNALIGNED_EXC_MASK) && size > 1) { 991cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_SR[SR_PC], dc->pc); 9920dc4af5cSEdgar E. Iglesias gen_helper_memalign(cpu_env, addr, tcg_const_i32(dc->rd), 993cfeea807SEdgar E. Iglesias tcg_const_i32(0), tcg_const_i32(size - 1)); 994fcf5ef2aSThomas Huth } 995fcf5ef2aSThomas Huth 996fcf5ef2aSThomas Huth if (ex) { 997403322eaSEdgar E. Iglesias tcg_gen_mov_tl(env_res_addr, addr); 998cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(env_res_val, v); 999fcf5ef2aSThomas Huth } 1000fcf5ef2aSThomas Huth if (dc->rd) { 1001cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(cpu_R[dc->rd], v); 1002fcf5ef2aSThomas Huth } 1003cfeea807SEdgar E. Iglesias tcg_temp_free_i32(v); 1004fcf5ef2aSThomas Huth 1005fcf5ef2aSThomas Huth if (ex) { /* lwx */ 1006fcf5ef2aSThomas Huth /* no support for AXI exclusive so always clear C */ 1007fcf5ef2aSThomas Huth write_carryi(dc, 0); 1008fcf5ef2aSThomas Huth } 1009fcf5ef2aSThomas Huth 1010403322eaSEdgar E. Iglesias tcg_temp_free(addr); 1011fcf5ef2aSThomas Huth } 1012fcf5ef2aSThomas Huth 1013fcf5ef2aSThomas Huth static void dec_store(DisasContext *dc) 1014fcf5ef2aSThomas Huth { 1015403322eaSEdgar E. Iglesias TCGv addr; 1016fcf5ef2aSThomas Huth TCGLabel *swx_skip = NULL; 1017b51b3d43SEdgar E. Iglesias unsigned int size; 1018b51b3d43SEdgar E. Iglesias bool rev = false, ex = false; 1019fcf5ef2aSThomas Huth TCGMemOp mop; 1020fcf5ef2aSThomas Huth 1021fcf5ef2aSThomas Huth mop = dc->opcode & 3; 1022fcf5ef2aSThomas Huth size = 1 << mop; 1023fcf5ef2aSThomas Huth if (!dc->type_b) { 1024b51b3d43SEdgar E. Iglesias rev = extract32(dc->ir, 9, 1); 1025b51b3d43SEdgar E. Iglesias ex = extract32(dc->ir, 10, 1); 1026fcf5ef2aSThomas Huth } 1027fcf5ef2aSThomas Huth mop |= MO_TE; 1028fcf5ef2aSThomas Huth if (rev) { 1029fcf5ef2aSThomas Huth mop ^= MO_BSWAP; 1030fcf5ef2aSThomas Huth } 1031fcf5ef2aSThomas Huth 10329ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, size > 4)) { 1033fcf5ef2aSThomas Huth return; 1034fcf5ef2aSThomas Huth } 1035fcf5ef2aSThomas Huth 1036fcf5ef2aSThomas Huth LOG_DIS("s%d%s%s%s\n", size, dc->type_b ? "i" : "", rev ? "r" : "", 1037fcf5ef2aSThomas Huth ex ? "x" : ""); 1038fcf5ef2aSThomas Huth t_sync_flags(dc); 1039fcf5ef2aSThomas Huth /* If we get a fault on a dslot, the jmpstate better be in sync. */ 1040fcf5ef2aSThomas Huth sync_jmpstate(dc); 10410dc4af5cSEdgar E. Iglesias /* SWX needs a temp_local. */ 1042403322eaSEdgar E. Iglesias addr = ex ? tcg_temp_local_new() : tcg_temp_new(); 10430a87e691SEdgar E. Iglesias compute_ldst_addr(dc, addr); 1044fcf5ef2aSThomas Huth 1045fcf5ef2aSThomas Huth if (ex) { /* swx */ 1046cfeea807SEdgar E. Iglesias TCGv_i32 tval; 1047fcf5ef2aSThomas Huth 1048fcf5ef2aSThomas Huth /* swx does not throw unaligned access errors, so force alignment */ 1049403322eaSEdgar E. Iglesias tcg_gen_andi_tl(addr, addr, ~3); 1050fcf5ef2aSThomas Huth 1051fcf5ef2aSThomas Huth write_carryi(dc, 1); 1052fcf5ef2aSThomas Huth swx_skip = gen_new_label(); 1053403322eaSEdgar E. Iglesias tcg_gen_brcond_tl(TCG_COND_NE, env_res_addr, addr, swx_skip); 1054fcf5ef2aSThomas Huth 1055fcf5ef2aSThomas Huth /* Compare the value loaded at lwx with current contents of 1056fcf5ef2aSThomas Huth the reserved location. 1057fcf5ef2aSThomas Huth FIXME: This only works for system emulation where we can expect 1058fcf5ef2aSThomas Huth this compare and the following write to be atomic. For user 1059fcf5ef2aSThomas Huth emulation we need to add atomicity between threads. */ 1060cfeea807SEdgar E. Iglesias tval = tcg_temp_new_i32(); 10610dc4af5cSEdgar E. Iglesias tcg_gen_qemu_ld_i32(tval, addr, cpu_mmu_index(&dc->cpu->env, false), 1062fcf5ef2aSThomas Huth MO_TEUL); 1063cfeea807SEdgar E. Iglesias tcg_gen_brcond_i32(TCG_COND_NE, env_res_val, tval, swx_skip); 1064fcf5ef2aSThomas Huth write_carryi(dc, 0); 1065cfeea807SEdgar E. Iglesias tcg_temp_free_i32(tval); 1066fcf5ef2aSThomas Huth } 1067fcf5ef2aSThomas Huth 1068fcf5ef2aSThomas Huth if (rev && size != 4) { 1069fcf5ef2aSThomas Huth /* Endian reverse the address. t is addr. */ 1070fcf5ef2aSThomas Huth switch (size) { 1071fcf5ef2aSThomas Huth case 1: 1072fcf5ef2aSThomas Huth { 1073fcf5ef2aSThomas Huth /* 00 -> 11 1074fcf5ef2aSThomas Huth 01 -> 10 1075fcf5ef2aSThomas Huth 10 -> 10 1076fcf5ef2aSThomas Huth 11 -> 00 */ 1077403322eaSEdgar E. Iglesias TCGv low = tcg_temp_new(); 1078fcf5ef2aSThomas Huth 1079403322eaSEdgar E. Iglesias tcg_gen_andi_tl(low, addr, 3); 1080403322eaSEdgar E. Iglesias tcg_gen_sub_tl(low, tcg_const_tl(3), low); 1081403322eaSEdgar E. Iglesias tcg_gen_andi_tl(addr, addr, ~3); 1082403322eaSEdgar E. Iglesias tcg_gen_or_tl(addr, addr, low); 1083403322eaSEdgar E. Iglesias tcg_temp_free(low); 1084fcf5ef2aSThomas Huth break; 1085fcf5ef2aSThomas Huth } 1086fcf5ef2aSThomas Huth 1087fcf5ef2aSThomas Huth case 2: 1088fcf5ef2aSThomas Huth /* 00 -> 10 1089fcf5ef2aSThomas Huth 10 -> 00. */ 1090fcf5ef2aSThomas Huth /* Force addr into the temp. */ 1091403322eaSEdgar E. Iglesias tcg_gen_xori_tl(addr, addr, 2); 1092fcf5ef2aSThomas Huth break; 1093fcf5ef2aSThomas Huth default: 1094fcf5ef2aSThomas Huth cpu_abort(CPU(dc->cpu), "Invalid reverse size\n"); 1095fcf5ef2aSThomas Huth break; 1096fcf5ef2aSThomas Huth } 1097fcf5ef2aSThomas Huth } 10980dc4af5cSEdgar E. Iglesias tcg_gen_qemu_st_i32(cpu_R[dc->rd], addr, 1099cfeea807SEdgar E. Iglesias cpu_mmu_index(&dc->cpu->env, false), mop); 1100fcf5ef2aSThomas Huth 1101fcf5ef2aSThomas Huth /* Verify alignment if needed. */ 1102fcf5ef2aSThomas Huth if ((dc->cpu->env.pvr.regs[2] & PVR2_UNALIGNED_EXC_MASK) && size > 1) { 1103cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_SR[SR_PC], dc->pc); 1104fcf5ef2aSThomas Huth /* FIXME: if the alignment is wrong, we should restore the value 1105fcf5ef2aSThomas Huth * in memory. One possible way to achieve this is to probe 1106fcf5ef2aSThomas Huth * the MMU prior to the memaccess, thay way we could put 1107fcf5ef2aSThomas Huth * the alignment checks in between the probe and the mem 1108fcf5ef2aSThomas Huth * access. 1109fcf5ef2aSThomas Huth */ 11100dc4af5cSEdgar E. Iglesias gen_helper_memalign(cpu_env, addr, tcg_const_i32(dc->rd), 1111cfeea807SEdgar E. Iglesias tcg_const_i32(1), tcg_const_i32(size - 1)); 1112fcf5ef2aSThomas Huth } 1113fcf5ef2aSThomas Huth 1114fcf5ef2aSThomas Huth if (ex) { 1115fcf5ef2aSThomas Huth gen_set_label(swx_skip); 1116fcf5ef2aSThomas Huth } 1117fcf5ef2aSThomas Huth 1118403322eaSEdgar E. Iglesias tcg_temp_free(addr); 1119fcf5ef2aSThomas Huth } 1120fcf5ef2aSThomas Huth 1121fcf5ef2aSThomas Huth static inline void eval_cc(DisasContext *dc, unsigned int cc, 1122cfeea807SEdgar E. Iglesias TCGv_i32 d, TCGv_i32 a, TCGv_i32 b) 1123fcf5ef2aSThomas Huth { 1124fcf5ef2aSThomas Huth switch (cc) { 1125fcf5ef2aSThomas Huth case CC_EQ: 1126cfeea807SEdgar E. Iglesias tcg_gen_setcond_i32(TCG_COND_EQ, d, a, b); 1127fcf5ef2aSThomas Huth break; 1128fcf5ef2aSThomas Huth case CC_NE: 1129cfeea807SEdgar E. Iglesias tcg_gen_setcond_i32(TCG_COND_NE, d, a, b); 1130fcf5ef2aSThomas Huth break; 1131fcf5ef2aSThomas Huth case CC_LT: 1132cfeea807SEdgar E. Iglesias tcg_gen_setcond_i32(TCG_COND_LT, d, a, b); 1133fcf5ef2aSThomas Huth break; 1134fcf5ef2aSThomas Huth case CC_LE: 1135cfeea807SEdgar E. Iglesias tcg_gen_setcond_i32(TCG_COND_LE, d, a, b); 1136fcf5ef2aSThomas Huth break; 1137fcf5ef2aSThomas Huth case CC_GE: 1138cfeea807SEdgar E. Iglesias tcg_gen_setcond_i32(TCG_COND_GE, d, a, b); 1139fcf5ef2aSThomas Huth break; 1140fcf5ef2aSThomas Huth case CC_GT: 1141cfeea807SEdgar E. Iglesias tcg_gen_setcond_i32(TCG_COND_GT, d, a, b); 1142fcf5ef2aSThomas Huth break; 1143fcf5ef2aSThomas Huth default: 1144fcf5ef2aSThomas Huth cpu_abort(CPU(dc->cpu), "Unknown condition code %x.\n", cc); 1145fcf5ef2aSThomas Huth break; 1146fcf5ef2aSThomas Huth } 1147fcf5ef2aSThomas Huth } 1148fcf5ef2aSThomas Huth 1149cfeea807SEdgar E. Iglesias static void eval_cond_jmp(DisasContext *dc, TCGv_i32 pc_true, TCGv_i32 pc_false) 1150fcf5ef2aSThomas Huth { 1151fcf5ef2aSThomas Huth TCGLabel *l1 = gen_new_label(); 1152fcf5ef2aSThomas Huth /* Conditional jmp. */ 1153cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(cpu_SR[SR_PC], pc_false); 1154cfeea807SEdgar E. Iglesias tcg_gen_brcondi_i32(TCG_COND_EQ, env_btaken, 0, l1); 1155cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(cpu_SR[SR_PC], pc_true); 1156fcf5ef2aSThomas Huth gen_set_label(l1); 1157fcf5ef2aSThomas Huth } 1158fcf5ef2aSThomas Huth 1159fcf5ef2aSThomas Huth static void dec_bcc(DisasContext *dc) 1160fcf5ef2aSThomas Huth { 1161fcf5ef2aSThomas Huth unsigned int cc; 1162fcf5ef2aSThomas Huth unsigned int dslot; 1163fcf5ef2aSThomas Huth 1164fcf5ef2aSThomas Huth cc = EXTRACT_FIELD(dc->ir, 21, 23); 1165fcf5ef2aSThomas Huth dslot = dc->ir & (1 << 25); 1166fcf5ef2aSThomas Huth LOG_DIS("bcc%s r%d %x\n", dslot ? "d" : "", dc->ra, dc->imm); 1167fcf5ef2aSThomas Huth 1168fcf5ef2aSThomas Huth dc->delayed_branch = 1; 1169fcf5ef2aSThomas Huth if (dslot) { 1170fcf5ef2aSThomas Huth dc->delayed_branch = 2; 1171fcf5ef2aSThomas Huth dc->tb_flags |= D_FLAG; 1172cfeea807SEdgar E. Iglesias tcg_gen_st_i32(tcg_const_i32(dc->type_b && (dc->tb_flags & IMM_FLAG)), 1173fcf5ef2aSThomas Huth cpu_env, offsetof(CPUMBState, bimm)); 1174fcf5ef2aSThomas Huth } 1175fcf5ef2aSThomas Huth 1176fcf5ef2aSThomas Huth if (dec_alu_op_b_is_small_imm(dc)) { 1177fcf5ef2aSThomas Huth int32_t offset = (int32_t)((int16_t)dc->imm); /* sign-extend. */ 1178fcf5ef2aSThomas Huth 1179cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_btarget, dc->pc + offset); 1180fcf5ef2aSThomas Huth dc->jmp = JMP_DIRECT_CC; 1181fcf5ef2aSThomas Huth dc->jmp_pc = dc->pc + offset; 1182fcf5ef2aSThomas Huth } else { 1183fcf5ef2aSThomas Huth dc->jmp = JMP_INDIRECT; 1184cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_btarget, dc->pc); 1185cfeea807SEdgar E. Iglesias tcg_gen_add_i32(env_btarget, env_btarget, *(dec_alu_op_b(dc))); 1186fcf5ef2aSThomas Huth } 1187cfeea807SEdgar E. Iglesias eval_cc(dc, cc, env_btaken, cpu_R[dc->ra], tcg_const_i32(0)); 1188fcf5ef2aSThomas Huth } 1189fcf5ef2aSThomas Huth 1190fcf5ef2aSThomas Huth static void dec_br(DisasContext *dc) 1191fcf5ef2aSThomas Huth { 1192fcf5ef2aSThomas Huth unsigned int dslot, link, abs, mbar; 1193fcf5ef2aSThomas Huth 1194fcf5ef2aSThomas Huth dslot = dc->ir & (1 << 20); 1195fcf5ef2aSThomas Huth abs = dc->ir & (1 << 19); 1196fcf5ef2aSThomas Huth link = dc->ir & (1 << 18); 1197fcf5ef2aSThomas Huth 1198fcf5ef2aSThomas Huth /* Memory barrier. */ 1199fcf5ef2aSThomas Huth mbar = (dc->ir >> 16) & 31; 1200fcf5ef2aSThomas Huth if (mbar == 2 && dc->imm == 4) { 1201fcf5ef2aSThomas Huth /* mbar IMM & 16 decodes to sleep. */ 1202fcf5ef2aSThomas Huth if (dc->rd & 16) { 1203fcf5ef2aSThomas Huth TCGv_i32 tmp_hlt = tcg_const_i32(EXCP_HLT); 1204fcf5ef2aSThomas Huth TCGv_i32 tmp_1 = tcg_const_i32(1); 1205fcf5ef2aSThomas Huth 1206fcf5ef2aSThomas Huth LOG_DIS("sleep\n"); 1207fcf5ef2aSThomas Huth 1208fcf5ef2aSThomas Huth t_sync_flags(dc); 1209fcf5ef2aSThomas Huth tcg_gen_st_i32(tmp_1, cpu_env, 1210fcf5ef2aSThomas Huth -offsetof(MicroBlazeCPU, env) 1211fcf5ef2aSThomas Huth +offsetof(CPUState, halted)); 1212cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_SR[SR_PC], dc->pc + 4); 1213fcf5ef2aSThomas Huth gen_helper_raise_exception(cpu_env, tmp_hlt); 1214fcf5ef2aSThomas Huth tcg_temp_free_i32(tmp_hlt); 1215fcf5ef2aSThomas Huth tcg_temp_free_i32(tmp_1); 1216fcf5ef2aSThomas Huth return; 1217fcf5ef2aSThomas Huth } 1218fcf5ef2aSThomas Huth LOG_DIS("mbar %d\n", dc->rd); 1219fcf5ef2aSThomas Huth /* Break the TB. */ 1220fcf5ef2aSThomas Huth dc->cpustate_changed = 1; 1221fcf5ef2aSThomas Huth return; 1222fcf5ef2aSThomas Huth } 1223fcf5ef2aSThomas Huth 1224fcf5ef2aSThomas Huth LOG_DIS("br%s%s%s%s imm=%x\n", 1225fcf5ef2aSThomas Huth abs ? "a" : "", link ? "l" : "", 1226fcf5ef2aSThomas Huth dc->type_b ? "i" : "", dslot ? "d" : "", 1227fcf5ef2aSThomas Huth dc->imm); 1228fcf5ef2aSThomas Huth 1229fcf5ef2aSThomas Huth dc->delayed_branch = 1; 1230fcf5ef2aSThomas Huth if (dslot) { 1231fcf5ef2aSThomas Huth dc->delayed_branch = 2; 1232fcf5ef2aSThomas Huth dc->tb_flags |= D_FLAG; 1233cfeea807SEdgar E. Iglesias tcg_gen_st_i32(tcg_const_i32(dc->type_b && (dc->tb_flags & IMM_FLAG)), 1234fcf5ef2aSThomas Huth cpu_env, offsetof(CPUMBState, bimm)); 1235fcf5ef2aSThomas Huth } 1236fcf5ef2aSThomas Huth if (link && dc->rd) 1237cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_R[dc->rd], dc->pc); 1238fcf5ef2aSThomas Huth 1239fcf5ef2aSThomas Huth dc->jmp = JMP_INDIRECT; 1240fcf5ef2aSThomas Huth if (abs) { 1241cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_btaken, 1); 1242cfeea807SEdgar E. Iglesias tcg_gen_mov_i32(env_btarget, *(dec_alu_op_b(dc))); 1243fcf5ef2aSThomas Huth if (link && !dslot) { 1244fcf5ef2aSThomas Huth if (!(dc->tb_flags & IMM_FLAG) && (dc->imm == 8 || dc->imm == 0x18)) 1245fcf5ef2aSThomas Huth t_gen_raise_exception(dc, EXCP_BREAK); 1246fcf5ef2aSThomas Huth if (dc->imm == 0) { 1247bdfc1e88SEdgar E. Iglesias if (trap_userspace(dc, true)) { 1248fcf5ef2aSThomas Huth return; 1249fcf5ef2aSThomas Huth } 1250fcf5ef2aSThomas Huth 1251fcf5ef2aSThomas Huth t_gen_raise_exception(dc, EXCP_DEBUG); 1252fcf5ef2aSThomas Huth } 1253fcf5ef2aSThomas Huth } 1254fcf5ef2aSThomas Huth } else { 1255fcf5ef2aSThomas Huth if (dec_alu_op_b_is_small_imm(dc)) { 1256fcf5ef2aSThomas Huth dc->jmp = JMP_DIRECT; 1257fcf5ef2aSThomas Huth dc->jmp_pc = dc->pc + (int32_t)((int16_t)dc->imm); 1258fcf5ef2aSThomas Huth } else { 1259cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_btaken, 1); 1260cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_btarget, dc->pc); 1261cfeea807SEdgar E. Iglesias tcg_gen_add_i32(env_btarget, env_btarget, *(dec_alu_op_b(dc))); 1262fcf5ef2aSThomas Huth } 1263fcf5ef2aSThomas Huth } 1264fcf5ef2aSThomas Huth } 1265fcf5ef2aSThomas Huth 1266fcf5ef2aSThomas Huth static inline void do_rti(DisasContext *dc) 1267fcf5ef2aSThomas Huth { 1268cfeea807SEdgar E. Iglesias TCGv_i32 t0, t1; 1269cfeea807SEdgar E. Iglesias t0 = tcg_temp_new_i32(); 1270cfeea807SEdgar E. Iglesias t1 = tcg_temp_new_i32(); 1271cfeea807SEdgar E. Iglesias tcg_gen_shri_i32(t0, cpu_SR[SR_MSR], 1); 1272cfeea807SEdgar E. Iglesias tcg_gen_ori_i32(t1, cpu_SR[SR_MSR], MSR_IE); 1273cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t0, t0, (MSR_VM | MSR_UM)); 1274fcf5ef2aSThomas Huth 1275cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t1, t1, ~(MSR_VM | MSR_UM)); 1276cfeea807SEdgar E. Iglesias tcg_gen_or_i32(t1, t1, t0); 1277fcf5ef2aSThomas Huth msr_write(dc, t1); 1278cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t1); 1279cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t0); 1280fcf5ef2aSThomas Huth dc->tb_flags &= ~DRTI_FLAG; 1281fcf5ef2aSThomas Huth } 1282fcf5ef2aSThomas Huth 1283fcf5ef2aSThomas Huth static inline void do_rtb(DisasContext *dc) 1284fcf5ef2aSThomas Huth { 1285cfeea807SEdgar E. Iglesias TCGv_i32 t0, t1; 1286cfeea807SEdgar E. Iglesias t0 = tcg_temp_new_i32(); 1287cfeea807SEdgar E. Iglesias t1 = tcg_temp_new_i32(); 1288cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t1, cpu_SR[SR_MSR], ~MSR_BIP); 1289cfeea807SEdgar E. Iglesias tcg_gen_shri_i32(t0, t1, 1); 1290cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t0, t0, (MSR_VM | MSR_UM)); 1291fcf5ef2aSThomas Huth 1292cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t1, t1, ~(MSR_VM | MSR_UM)); 1293cfeea807SEdgar E. Iglesias tcg_gen_or_i32(t1, t1, t0); 1294fcf5ef2aSThomas Huth msr_write(dc, t1); 1295cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t1); 1296cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t0); 1297fcf5ef2aSThomas Huth dc->tb_flags &= ~DRTB_FLAG; 1298fcf5ef2aSThomas Huth } 1299fcf5ef2aSThomas Huth 1300fcf5ef2aSThomas Huth static inline void do_rte(DisasContext *dc) 1301fcf5ef2aSThomas Huth { 1302cfeea807SEdgar E. Iglesias TCGv_i32 t0, t1; 1303cfeea807SEdgar E. Iglesias t0 = tcg_temp_new_i32(); 1304cfeea807SEdgar E. Iglesias t1 = tcg_temp_new_i32(); 1305fcf5ef2aSThomas Huth 1306cfeea807SEdgar E. Iglesias tcg_gen_ori_i32(t1, cpu_SR[SR_MSR], MSR_EE); 1307cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t1, t1, ~MSR_EIP); 1308cfeea807SEdgar E. Iglesias tcg_gen_shri_i32(t0, t1, 1); 1309cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t0, t0, (MSR_VM | MSR_UM)); 1310fcf5ef2aSThomas Huth 1311cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t1, t1, ~(MSR_VM | MSR_UM)); 1312cfeea807SEdgar E. Iglesias tcg_gen_or_i32(t1, t1, t0); 1313fcf5ef2aSThomas Huth msr_write(dc, t1); 1314cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t1); 1315cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t0); 1316fcf5ef2aSThomas Huth dc->tb_flags &= ~DRTE_FLAG; 1317fcf5ef2aSThomas Huth } 1318fcf5ef2aSThomas Huth 1319fcf5ef2aSThomas Huth static void dec_rts(DisasContext *dc) 1320fcf5ef2aSThomas Huth { 1321fcf5ef2aSThomas Huth unsigned int b_bit, i_bit, e_bit; 1322fcf5ef2aSThomas Huth 1323fcf5ef2aSThomas Huth i_bit = dc->ir & (1 << 21); 1324fcf5ef2aSThomas Huth b_bit = dc->ir & (1 << 22); 1325fcf5ef2aSThomas Huth e_bit = dc->ir & (1 << 23); 1326fcf5ef2aSThomas Huth 1327bdfc1e88SEdgar E. Iglesias if (trap_userspace(dc, i_bit || b_bit || e_bit)) { 1328bdfc1e88SEdgar E. Iglesias return; 1329bdfc1e88SEdgar E. Iglesias } 1330bdfc1e88SEdgar E. Iglesias 1331fcf5ef2aSThomas Huth dc->delayed_branch = 2; 1332fcf5ef2aSThomas Huth dc->tb_flags |= D_FLAG; 1333cfeea807SEdgar E. Iglesias tcg_gen_st_i32(tcg_const_i32(dc->type_b && (dc->tb_flags & IMM_FLAG)), 1334fcf5ef2aSThomas Huth cpu_env, offsetof(CPUMBState, bimm)); 1335fcf5ef2aSThomas Huth 1336fcf5ef2aSThomas Huth if (i_bit) { 1337fcf5ef2aSThomas Huth LOG_DIS("rtid ir=%x\n", dc->ir); 1338fcf5ef2aSThomas Huth dc->tb_flags |= DRTI_FLAG; 1339fcf5ef2aSThomas Huth } else if (b_bit) { 1340fcf5ef2aSThomas Huth LOG_DIS("rtbd ir=%x\n", dc->ir); 1341fcf5ef2aSThomas Huth dc->tb_flags |= DRTB_FLAG; 1342fcf5ef2aSThomas Huth } else if (e_bit) { 1343fcf5ef2aSThomas Huth LOG_DIS("rted ir=%x\n", dc->ir); 1344fcf5ef2aSThomas Huth dc->tb_flags |= DRTE_FLAG; 1345fcf5ef2aSThomas Huth } else 1346fcf5ef2aSThomas Huth LOG_DIS("rts ir=%x\n", dc->ir); 1347fcf5ef2aSThomas Huth 1348fcf5ef2aSThomas Huth dc->jmp = JMP_INDIRECT; 1349cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(env_btaken, 1); 1350cfeea807SEdgar E. Iglesias tcg_gen_add_i32(env_btarget, cpu_R[dc->ra], *(dec_alu_op_b(dc))); 1351fcf5ef2aSThomas Huth } 1352fcf5ef2aSThomas Huth 1353fcf5ef2aSThomas Huth static int dec_check_fpuv2(DisasContext *dc) 1354fcf5ef2aSThomas Huth { 1355fcf5ef2aSThomas Huth if ((dc->cpu->cfg.use_fpu != 2) && (dc->tb_flags & MSR_EE_FLAG)) { 1356cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_SR[SR_ESR], ESR_EC_FPU); 1357fcf5ef2aSThomas Huth t_gen_raise_exception(dc, EXCP_HW_EXCP); 1358fcf5ef2aSThomas Huth } 1359fcf5ef2aSThomas Huth return (dc->cpu->cfg.use_fpu == 2) ? 0 : PVR2_USE_FPU2_MASK; 1360fcf5ef2aSThomas Huth } 1361fcf5ef2aSThomas Huth 1362fcf5ef2aSThomas Huth static void dec_fpu(DisasContext *dc) 1363fcf5ef2aSThomas Huth { 1364fcf5ef2aSThomas Huth unsigned int fpu_insn; 1365fcf5ef2aSThomas Huth 13669ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, !dc->cpu->cfg.use_fpu)) { 1367fcf5ef2aSThomas Huth return; 1368fcf5ef2aSThomas Huth } 1369fcf5ef2aSThomas Huth 1370fcf5ef2aSThomas Huth fpu_insn = (dc->ir >> 7) & 7; 1371fcf5ef2aSThomas Huth 1372fcf5ef2aSThomas Huth switch (fpu_insn) { 1373fcf5ef2aSThomas Huth case 0: 1374fcf5ef2aSThomas Huth gen_helper_fadd(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra], 1375fcf5ef2aSThomas Huth cpu_R[dc->rb]); 1376fcf5ef2aSThomas Huth break; 1377fcf5ef2aSThomas Huth 1378fcf5ef2aSThomas Huth case 1: 1379fcf5ef2aSThomas Huth gen_helper_frsub(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra], 1380fcf5ef2aSThomas Huth cpu_R[dc->rb]); 1381fcf5ef2aSThomas Huth break; 1382fcf5ef2aSThomas Huth 1383fcf5ef2aSThomas Huth case 2: 1384fcf5ef2aSThomas Huth gen_helper_fmul(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra], 1385fcf5ef2aSThomas Huth cpu_R[dc->rb]); 1386fcf5ef2aSThomas Huth break; 1387fcf5ef2aSThomas Huth 1388fcf5ef2aSThomas Huth case 3: 1389fcf5ef2aSThomas Huth gen_helper_fdiv(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra], 1390fcf5ef2aSThomas Huth cpu_R[dc->rb]); 1391fcf5ef2aSThomas Huth break; 1392fcf5ef2aSThomas Huth 1393fcf5ef2aSThomas Huth case 4: 1394fcf5ef2aSThomas Huth switch ((dc->ir >> 4) & 7) { 1395fcf5ef2aSThomas Huth case 0: 1396fcf5ef2aSThomas Huth gen_helper_fcmp_un(cpu_R[dc->rd], cpu_env, 1397fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 1398fcf5ef2aSThomas Huth break; 1399fcf5ef2aSThomas Huth case 1: 1400fcf5ef2aSThomas Huth gen_helper_fcmp_lt(cpu_R[dc->rd], cpu_env, 1401fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 1402fcf5ef2aSThomas Huth break; 1403fcf5ef2aSThomas Huth case 2: 1404fcf5ef2aSThomas Huth gen_helper_fcmp_eq(cpu_R[dc->rd], cpu_env, 1405fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 1406fcf5ef2aSThomas Huth break; 1407fcf5ef2aSThomas Huth case 3: 1408fcf5ef2aSThomas Huth gen_helper_fcmp_le(cpu_R[dc->rd], cpu_env, 1409fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 1410fcf5ef2aSThomas Huth break; 1411fcf5ef2aSThomas Huth case 4: 1412fcf5ef2aSThomas Huth gen_helper_fcmp_gt(cpu_R[dc->rd], cpu_env, 1413fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 1414fcf5ef2aSThomas Huth break; 1415fcf5ef2aSThomas Huth case 5: 1416fcf5ef2aSThomas Huth gen_helper_fcmp_ne(cpu_R[dc->rd], cpu_env, 1417fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 1418fcf5ef2aSThomas Huth break; 1419fcf5ef2aSThomas Huth case 6: 1420fcf5ef2aSThomas Huth gen_helper_fcmp_ge(cpu_R[dc->rd], cpu_env, 1421fcf5ef2aSThomas Huth cpu_R[dc->ra], cpu_R[dc->rb]); 1422fcf5ef2aSThomas Huth break; 1423fcf5ef2aSThomas Huth default: 1424fcf5ef2aSThomas Huth qemu_log_mask(LOG_UNIMP, 1425fcf5ef2aSThomas Huth "unimplemented fcmp fpu_insn=%x pc=%x" 1426fcf5ef2aSThomas Huth " opc=%x\n", 1427fcf5ef2aSThomas Huth fpu_insn, dc->pc, dc->opcode); 1428fcf5ef2aSThomas Huth dc->abort_at_next_insn = 1; 1429fcf5ef2aSThomas Huth break; 1430fcf5ef2aSThomas Huth } 1431fcf5ef2aSThomas Huth break; 1432fcf5ef2aSThomas Huth 1433fcf5ef2aSThomas Huth case 5: 1434fcf5ef2aSThomas Huth if (!dec_check_fpuv2(dc)) { 1435fcf5ef2aSThomas Huth return; 1436fcf5ef2aSThomas Huth } 1437fcf5ef2aSThomas Huth gen_helper_flt(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra]); 1438fcf5ef2aSThomas Huth break; 1439fcf5ef2aSThomas Huth 1440fcf5ef2aSThomas Huth case 6: 1441fcf5ef2aSThomas Huth if (!dec_check_fpuv2(dc)) { 1442fcf5ef2aSThomas Huth return; 1443fcf5ef2aSThomas Huth } 1444fcf5ef2aSThomas Huth gen_helper_fint(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra]); 1445fcf5ef2aSThomas Huth break; 1446fcf5ef2aSThomas Huth 1447fcf5ef2aSThomas Huth case 7: 1448fcf5ef2aSThomas Huth if (!dec_check_fpuv2(dc)) { 1449fcf5ef2aSThomas Huth return; 1450fcf5ef2aSThomas Huth } 1451fcf5ef2aSThomas Huth gen_helper_fsqrt(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra]); 1452fcf5ef2aSThomas Huth break; 1453fcf5ef2aSThomas Huth 1454fcf5ef2aSThomas Huth default: 1455fcf5ef2aSThomas Huth qemu_log_mask(LOG_UNIMP, "unimplemented FPU insn fpu_insn=%x pc=%x" 1456fcf5ef2aSThomas Huth " opc=%x\n", 1457fcf5ef2aSThomas Huth fpu_insn, dc->pc, dc->opcode); 1458fcf5ef2aSThomas Huth dc->abort_at_next_insn = 1; 1459fcf5ef2aSThomas Huth break; 1460fcf5ef2aSThomas Huth } 1461fcf5ef2aSThomas Huth } 1462fcf5ef2aSThomas Huth 1463fcf5ef2aSThomas Huth static void dec_null(DisasContext *dc) 1464fcf5ef2aSThomas Huth { 14659ba8cd45SEdgar E. Iglesias if (trap_illegal(dc, true)) { 1466fcf5ef2aSThomas Huth return; 1467fcf5ef2aSThomas Huth } 1468fcf5ef2aSThomas Huth qemu_log_mask(LOG_GUEST_ERROR, "unknown insn pc=%x opc=%x\n", dc->pc, dc->opcode); 1469fcf5ef2aSThomas Huth dc->abort_at_next_insn = 1; 1470fcf5ef2aSThomas Huth } 1471fcf5ef2aSThomas Huth 1472fcf5ef2aSThomas Huth /* Insns connected to FSL or AXI stream attached devices. */ 1473fcf5ef2aSThomas Huth static void dec_stream(DisasContext *dc) 1474fcf5ef2aSThomas Huth { 1475fcf5ef2aSThomas Huth TCGv_i32 t_id, t_ctrl; 1476fcf5ef2aSThomas Huth int ctrl; 1477fcf5ef2aSThomas Huth 1478fcf5ef2aSThomas Huth LOG_DIS("%s%s imm=%x\n", dc->rd ? "get" : "put", 1479fcf5ef2aSThomas Huth dc->type_b ? "" : "d", dc->imm); 1480fcf5ef2aSThomas Huth 1481bdfc1e88SEdgar E. Iglesias if (trap_userspace(dc, true)) { 1482fcf5ef2aSThomas Huth return; 1483fcf5ef2aSThomas Huth } 1484fcf5ef2aSThomas Huth 1485cfeea807SEdgar E. Iglesias t_id = tcg_temp_new_i32(); 1486fcf5ef2aSThomas Huth if (dc->type_b) { 1487cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(t_id, dc->imm & 0xf); 1488fcf5ef2aSThomas Huth ctrl = dc->imm >> 10; 1489fcf5ef2aSThomas Huth } else { 1490cfeea807SEdgar E. Iglesias tcg_gen_andi_i32(t_id, cpu_R[dc->rb], 0xf); 1491fcf5ef2aSThomas Huth ctrl = dc->imm >> 5; 1492fcf5ef2aSThomas Huth } 1493fcf5ef2aSThomas Huth 1494cfeea807SEdgar E. Iglesias t_ctrl = tcg_const_i32(ctrl); 1495fcf5ef2aSThomas Huth 1496fcf5ef2aSThomas Huth if (dc->rd == 0) { 1497fcf5ef2aSThomas Huth gen_helper_put(t_id, t_ctrl, cpu_R[dc->ra]); 1498fcf5ef2aSThomas Huth } else { 1499fcf5ef2aSThomas Huth gen_helper_get(cpu_R[dc->rd], t_id, t_ctrl); 1500fcf5ef2aSThomas Huth } 1501cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t_id); 1502cfeea807SEdgar E. Iglesias tcg_temp_free_i32(t_ctrl); 1503fcf5ef2aSThomas Huth } 1504fcf5ef2aSThomas Huth 1505fcf5ef2aSThomas Huth static struct decoder_info { 1506fcf5ef2aSThomas Huth struct { 1507fcf5ef2aSThomas Huth uint32_t bits; 1508fcf5ef2aSThomas Huth uint32_t mask; 1509fcf5ef2aSThomas Huth }; 1510fcf5ef2aSThomas Huth void (*dec)(DisasContext *dc); 1511fcf5ef2aSThomas Huth } decinfo[] = { 1512fcf5ef2aSThomas Huth {DEC_ADD, dec_add}, 1513fcf5ef2aSThomas Huth {DEC_SUB, dec_sub}, 1514fcf5ef2aSThomas Huth {DEC_AND, dec_and}, 1515fcf5ef2aSThomas Huth {DEC_XOR, dec_xor}, 1516fcf5ef2aSThomas Huth {DEC_OR, dec_or}, 1517fcf5ef2aSThomas Huth {DEC_BIT, dec_bit}, 1518fcf5ef2aSThomas Huth {DEC_BARREL, dec_barrel}, 1519fcf5ef2aSThomas Huth {DEC_LD, dec_load}, 1520fcf5ef2aSThomas Huth {DEC_ST, dec_store}, 1521fcf5ef2aSThomas Huth {DEC_IMM, dec_imm}, 1522fcf5ef2aSThomas Huth {DEC_BR, dec_br}, 1523fcf5ef2aSThomas Huth {DEC_BCC, dec_bcc}, 1524fcf5ef2aSThomas Huth {DEC_RTS, dec_rts}, 1525fcf5ef2aSThomas Huth {DEC_FPU, dec_fpu}, 1526fcf5ef2aSThomas Huth {DEC_MUL, dec_mul}, 1527fcf5ef2aSThomas Huth {DEC_DIV, dec_div}, 1528fcf5ef2aSThomas Huth {DEC_MSR, dec_msr}, 1529fcf5ef2aSThomas Huth {DEC_STREAM, dec_stream}, 1530fcf5ef2aSThomas Huth {{0, 0}, dec_null} 1531fcf5ef2aSThomas Huth }; 1532fcf5ef2aSThomas Huth 1533fcf5ef2aSThomas Huth static inline void decode(DisasContext *dc, uint32_t ir) 1534fcf5ef2aSThomas Huth { 1535fcf5ef2aSThomas Huth int i; 1536fcf5ef2aSThomas Huth 1537fcf5ef2aSThomas Huth dc->ir = ir; 1538fcf5ef2aSThomas Huth LOG_DIS("%8.8x\t", dc->ir); 1539fcf5ef2aSThomas Huth 1540fcf5ef2aSThomas Huth if (dc->ir) 1541fcf5ef2aSThomas Huth dc->nr_nops = 0; 1542fcf5ef2aSThomas Huth else { 15439ba8cd45SEdgar E. Iglesias trap_illegal(dc, dc->cpu->env.pvr.regs[2] & PVR2_OPCODE_0x0_ILL_MASK); 1544fcf5ef2aSThomas Huth 1545fcf5ef2aSThomas Huth LOG_DIS("nr_nops=%d\t", dc->nr_nops); 1546fcf5ef2aSThomas Huth dc->nr_nops++; 1547fcf5ef2aSThomas Huth if (dc->nr_nops > 4) { 1548fcf5ef2aSThomas Huth cpu_abort(CPU(dc->cpu), "fetching nop sequence\n"); 1549fcf5ef2aSThomas Huth } 1550fcf5ef2aSThomas Huth } 1551fcf5ef2aSThomas Huth /* bit 2 seems to indicate insn type. */ 1552fcf5ef2aSThomas Huth dc->type_b = ir & (1 << 29); 1553fcf5ef2aSThomas Huth 1554fcf5ef2aSThomas Huth dc->opcode = EXTRACT_FIELD(ir, 26, 31); 1555fcf5ef2aSThomas Huth dc->rd = EXTRACT_FIELD(ir, 21, 25); 1556fcf5ef2aSThomas Huth dc->ra = EXTRACT_FIELD(ir, 16, 20); 1557fcf5ef2aSThomas Huth dc->rb = EXTRACT_FIELD(ir, 11, 15); 1558fcf5ef2aSThomas Huth dc->imm = EXTRACT_FIELD(ir, 0, 15); 1559fcf5ef2aSThomas Huth 1560fcf5ef2aSThomas Huth /* Large switch for all insns. */ 1561fcf5ef2aSThomas Huth for (i = 0; i < ARRAY_SIZE(decinfo); i++) { 1562fcf5ef2aSThomas Huth if ((dc->opcode & decinfo[i].mask) == decinfo[i].bits) { 1563fcf5ef2aSThomas Huth decinfo[i].dec(dc); 1564fcf5ef2aSThomas Huth break; 1565fcf5ef2aSThomas Huth } 1566fcf5ef2aSThomas Huth } 1567fcf5ef2aSThomas Huth } 1568fcf5ef2aSThomas Huth 1569fcf5ef2aSThomas Huth /* generate intermediate code for basic block 'tb'. */ 15709c489ea6SLluís Vilanova void gen_intermediate_code(CPUState *cs, struct TranslationBlock *tb) 1571fcf5ef2aSThomas Huth { 15729c489ea6SLluís Vilanova CPUMBState *env = cs->env_ptr; 1573fcf5ef2aSThomas Huth MicroBlazeCPU *cpu = mb_env_get_cpu(env); 1574fcf5ef2aSThomas Huth uint32_t pc_start; 1575fcf5ef2aSThomas Huth struct DisasContext ctx; 1576fcf5ef2aSThomas Huth struct DisasContext *dc = &ctx; 157756371527SEmilio G. Cota uint32_t page_start, org_flags; 1578cfeea807SEdgar E. Iglesias uint32_t npc; 1579fcf5ef2aSThomas Huth int num_insns; 1580fcf5ef2aSThomas Huth int max_insns; 1581fcf5ef2aSThomas Huth 1582fcf5ef2aSThomas Huth pc_start = tb->pc; 1583fcf5ef2aSThomas Huth dc->cpu = cpu; 1584fcf5ef2aSThomas Huth dc->tb = tb; 1585fcf5ef2aSThomas Huth org_flags = dc->synced_flags = dc->tb_flags = tb->flags; 1586fcf5ef2aSThomas Huth 1587fcf5ef2aSThomas Huth dc->is_jmp = DISAS_NEXT; 1588fcf5ef2aSThomas Huth dc->jmp = 0; 1589fcf5ef2aSThomas Huth dc->delayed_branch = !!(dc->tb_flags & D_FLAG); 1590fcf5ef2aSThomas Huth if (dc->delayed_branch) { 1591fcf5ef2aSThomas Huth dc->jmp = JMP_INDIRECT; 1592fcf5ef2aSThomas Huth } 1593fcf5ef2aSThomas Huth dc->pc = pc_start; 1594fcf5ef2aSThomas Huth dc->singlestep_enabled = cs->singlestep_enabled; 1595fcf5ef2aSThomas Huth dc->cpustate_changed = 0; 1596fcf5ef2aSThomas Huth dc->abort_at_next_insn = 0; 1597fcf5ef2aSThomas Huth dc->nr_nops = 0; 1598fcf5ef2aSThomas Huth 1599fcf5ef2aSThomas Huth if (pc_start & 3) { 1600fcf5ef2aSThomas Huth cpu_abort(cs, "Microblaze: unaligned PC=%x\n", pc_start); 1601fcf5ef2aSThomas Huth } 1602fcf5ef2aSThomas Huth 160356371527SEmilio G. Cota page_start = pc_start & TARGET_PAGE_MASK; 1604fcf5ef2aSThomas Huth num_insns = 0; 1605c5a49c63SEmilio G. Cota max_insns = tb_cflags(tb) & CF_COUNT_MASK; 1606fcf5ef2aSThomas Huth if (max_insns == 0) { 1607fcf5ef2aSThomas Huth max_insns = CF_COUNT_MASK; 1608fcf5ef2aSThomas Huth } 1609fcf5ef2aSThomas Huth if (max_insns > TCG_MAX_INSNS) { 1610fcf5ef2aSThomas Huth max_insns = TCG_MAX_INSNS; 1611fcf5ef2aSThomas Huth } 1612fcf5ef2aSThomas Huth 1613fcf5ef2aSThomas Huth gen_tb_start(tb); 1614fcf5ef2aSThomas Huth do 1615fcf5ef2aSThomas Huth { 1616fcf5ef2aSThomas Huth tcg_gen_insn_start(dc->pc); 1617fcf5ef2aSThomas Huth num_insns++; 1618fcf5ef2aSThomas Huth 1619fcf5ef2aSThomas Huth #if SIM_COMPAT 1620fcf5ef2aSThomas Huth if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM)) { 1621cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_SR[SR_PC], dc->pc); 1622fcf5ef2aSThomas Huth gen_helper_debug(); 1623fcf5ef2aSThomas Huth } 1624fcf5ef2aSThomas Huth #endif 1625fcf5ef2aSThomas Huth 1626fcf5ef2aSThomas Huth if (unlikely(cpu_breakpoint_test(cs, dc->pc, BP_ANY))) { 1627fcf5ef2aSThomas Huth t_gen_raise_exception(dc, EXCP_DEBUG); 1628fcf5ef2aSThomas Huth dc->is_jmp = DISAS_UPDATE; 1629fcf5ef2aSThomas Huth /* The address covered by the breakpoint must be included in 1630fcf5ef2aSThomas Huth [tb->pc, tb->pc + tb->size) in order to for it to be 1631fcf5ef2aSThomas Huth properly cleared -- thus we increment the PC here so that 1632fcf5ef2aSThomas Huth the logic setting tb->size below does the right thing. */ 1633fcf5ef2aSThomas Huth dc->pc += 4; 1634fcf5ef2aSThomas Huth break; 1635fcf5ef2aSThomas Huth } 1636fcf5ef2aSThomas Huth 1637fcf5ef2aSThomas Huth /* Pretty disas. */ 1638fcf5ef2aSThomas Huth LOG_DIS("%8.8x:\t", dc->pc); 1639fcf5ef2aSThomas Huth 1640c5a49c63SEmilio G. Cota if (num_insns == max_insns && (tb_cflags(tb) & CF_LAST_IO)) { 1641fcf5ef2aSThomas Huth gen_io_start(); 1642fcf5ef2aSThomas Huth } 1643fcf5ef2aSThomas Huth 1644fcf5ef2aSThomas Huth dc->clear_imm = 1; 1645fcf5ef2aSThomas Huth decode(dc, cpu_ldl_code(env, dc->pc)); 1646fcf5ef2aSThomas Huth if (dc->clear_imm) 1647fcf5ef2aSThomas Huth dc->tb_flags &= ~IMM_FLAG; 1648fcf5ef2aSThomas Huth dc->pc += 4; 1649fcf5ef2aSThomas Huth 1650fcf5ef2aSThomas Huth if (dc->delayed_branch) { 1651fcf5ef2aSThomas Huth dc->delayed_branch--; 1652fcf5ef2aSThomas Huth if (!dc->delayed_branch) { 1653fcf5ef2aSThomas Huth if (dc->tb_flags & DRTI_FLAG) 1654fcf5ef2aSThomas Huth do_rti(dc); 1655fcf5ef2aSThomas Huth if (dc->tb_flags & DRTB_FLAG) 1656fcf5ef2aSThomas Huth do_rtb(dc); 1657fcf5ef2aSThomas Huth if (dc->tb_flags & DRTE_FLAG) 1658fcf5ef2aSThomas Huth do_rte(dc); 1659fcf5ef2aSThomas Huth /* Clear the delay slot flag. */ 1660fcf5ef2aSThomas Huth dc->tb_flags &= ~D_FLAG; 1661fcf5ef2aSThomas Huth /* If it is a direct jump, try direct chaining. */ 1662fcf5ef2aSThomas Huth if (dc->jmp == JMP_INDIRECT) { 1663cfeea807SEdgar E. Iglesias eval_cond_jmp(dc, env_btarget, tcg_const_i32(dc->pc)); 1664fcf5ef2aSThomas Huth dc->is_jmp = DISAS_JUMP; 1665fcf5ef2aSThomas Huth } else if (dc->jmp == JMP_DIRECT) { 1666fcf5ef2aSThomas Huth t_sync_flags(dc); 1667fcf5ef2aSThomas Huth gen_goto_tb(dc, 0, dc->jmp_pc); 1668fcf5ef2aSThomas Huth dc->is_jmp = DISAS_TB_JUMP; 1669fcf5ef2aSThomas Huth } else if (dc->jmp == JMP_DIRECT_CC) { 1670fcf5ef2aSThomas Huth TCGLabel *l1 = gen_new_label(); 1671fcf5ef2aSThomas Huth t_sync_flags(dc); 1672fcf5ef2aSThomas Huth /* Conditional jmp. */ 1673cfeea807SEdgar E. Iglesias tcg_gen_brcondi_i32(TCG_COND_NE, env_btaken, 0, l1); 1674fcf5ef2aSThomas Huth gen_goto_tb(dc, 1, dc->pc); 1675fcf5ef2aSThomas Huth gen_set_label(l1); 1676fcf5ef2aSThomas Huth gen_goto_tb(dc, 0, dc->jmp_pc); 1677fcf5ef2aSThomas Huth 1678fcf5ef2aSThomas Huth dc->is_jmp = DISAS_TB_JUMP; 1679fcf5ef2aSThomas Huth } 1680fcf5ef2aSThomas Huth break; 1681fcf5ef2aSThomas Huth } 1682fcf5ef2aSThomas Huth } 1683fcf5ef2aSThomas Huth if (cs->singlestep_enabled) { 1684fcf5ef2aSThomas Huth break; 1685fcf5ef2aSThomas Huth } 1686fcf5ef2aSThomas Huth } while (!dc->is_jmp && !dc->cpustate_changed 1687fcf5ef2aSThomas Huth && !tcg_op_buf_full() 1688fcf5ef2aSThomas Huth && !singlestep 168956371527SEmilio G. Cota && (dc->pc - page_start < TARGET_PAGE_SIZE) 1690fcf5ef2aSThomas Huth && num_insns < max_insns); 1691fcf5ef2aSThomas Huth 1692fcf5ef2aSThomas Huth npc = dc->pc; 1693fcf5ef2aSThomas Huth if (dc->jmp == JMP_DIRECT || dc->jmp == JMP_DIRECT_CC) { 1694fcf5ef2aSThomas Huth if (dc->tb_flags & D_FLAG) { 1695fcf5ef2aSThomas Huth dc->is_jmp = DISAS_UPDATE; 1696cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_SR[SR_PC], npc); 1697fcf5ef2aSThomas Huth sync_jmpstate(dc); 1698fcf5ef2aSThomas Huth } else 1699fcf5ef2aSThomas Huth npc = dc->jmp_pc; 1700fcf5ef2aSThomas Huth } 1701fcf5ef2aSThomas Huth 1702c5a49c63SEmilio G. Cota if (tb_cflags(tb) & CF_LAST_IO) 1703fcf5ef2aSThomas Huth gen_io_end(); 1704fcf5ef2aSThomas Huth /* Force an update if the per-tb cpu state has changed. */ 1705fcf5ef2aSThomas Huth if (dc->is_jmp == DISAS_NEXT 1706fcf5ef2aSThomas Huth && (dc->cpustate_changed || org_flags != dc->tb_flags)) { 1707fcf5ef2aSThomas Huth dc->is_jmp = DISAS_UPDATE; 1708cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_SR[SR_PC], npc); 1709fcf5ef2aSThomas Huth } 1710fcf5ef2aSThomas Huth t_sync_flags(dc); 1711fcf5ef2aSThomas Huth 1712fcf5ef2aSThomas Huth if (unlikely(cs->singlestep_enabled)) { 1713fcf5ef2aSThomas Huth TCGv_i32 tmp = tcg_const_i32(EXCP_DEBUG); 1714fcf5ef2aSThomas Huth 1715fcf5ef2aSThomas Huth if (dc->is_jmp != DISAS_JUMP) { 1716cfeea807SEdgar E. Iglesias tcg_gen_movi_i32(cpu_SR[SR_PC], npc); 1717fcf5ef2aSThomas Huth } 1718fcf5ef2aSThomas Huth gen_helper_raise_exception(cpu_env, tmp); 1719fcf5ef2aSThomas Huth tcg_temp_free_i32(tmp); 1720fcf5ef2aSThomas Huth } else { 1721fcf5ef2aSThomas Huth switch(dc->is_jmp) { 1722fcf5ef2aSThomas Huth case DISAS_NEXT: 1723fcf5ef2aSThomas Huth gen_goto_tb(dc, 1, npc); 1724fcf5ef2aSThomas Huth break; 1725fcf5ef2aSThomas Huth default: 1726fcf5ef2aSThomas Huth case DISAS_JUMP: 1727fcf5ef2aSThomas Huth case DISAS_UPDATE: 1728fcf5ef2aSThomas Huth /* indicate that the hash table must be used 1729fcf5ef2aSThomas Huth to find the next TB */ 1730fcf5ef2aSThomas Huth tcg_gen_exit_tb(0); 1731fcf5ef2aSThomas Huth break; 1732fcf5ef2aSThomas Huth case DISAS_TB_JUMP: 1733fcf5ef2aSThomas Huth /* nothing more to generate */ 1734fcf5ef2aSThomas Huth break; 1735fcf5ef2aSThomas Huth } 1736fcf5ef2aSThomas Huth } 1737fcf5ef2aSThomas Huth gen_tb_end(tb, num_insns); 1738fcf5ef2aSThomas Huth 1739fcf5ef2aSThomas Huth tb->size = dc->pc - pc_start; 1740fcf5ef2aSThomas Huth tb->icount = num_insns; 1741fcf5ef2aSThomas Huth 1742fcf5ef2aSThomas Huth #ifdef DEBUG_DISAS 1743fcf5ef2aSThomas Huth #if !SIM_COMPAT 1744fcf5ef2aSThomas Huth if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM) 1745fcf5ef2aSThomas Huth && qemu_log_in_addr_range(pc_start)) { 1746fcf5ef2aSThomas Huth qemu_log_lock(); 1747fcf5ef2aSThomas Huth qemu_log("--------------\n"); 17481d48474dSRichard Henderson log_target_disas(cs, pc_start, dc->pc - pc_start); 1749fcf5ef2aSThomas Huth qemu_log_unlock(); 1750fcf5ef2aSThomas Huth } 1751fcf5ef2aSThomas Huth #endif 1752fcf5ef2aSThomas Huth #endif 1753fcf5ef2aSThomas Huth assert(!dc->abort_at_next_insn); 1754fcf5ef2aSThomas Huth } 1755fcf5ef2aSThomas Huth 1756fcf5ef2aSThomas Huth void mb_cpu_dump_state(CPUState *cs, FILE *f, fprintf_function cpu_fprintf, 1757fcf5ef2aSThomas Huth int flags) 1758fcf5ef2aSThomas Huth { 1759fcf5ef2aSThomas Huth MicroBlazeCPU *cpu = MICROBLAZE_CPU(cs); 1760fcf5ef2aSThomas Huth CPUMBState *env = &cpu->env; 1761fcf5ef2aSThomas Huth int i; 1762fcf5ef2aSThomas Huth 1763fcf5ef2aSThomas Huth if (!env || !f) 1764fcf5ef2aSThomas Huth return; 1765fcf5ef2aSThomas Huth 1766fcf5ef2aSThomas Huth cpu_fprintf(f, "IN: PC=%x %s\n", 1767fcf5ef2aSThomas Huth env->sregs[SR_PC], lookup_symbol(env->sregs[SR_PC])); 1768fcf5ef2aSThomas Huth cpu_fprintf(f, "rmsr=%x resr=%x rear=%x debug=%x imm=%x iflags=%x fsr=%x\n", 1769fcf5ef2aSThomas Huth env->sregs[SR_MSR], env->sregs[SR_ESR], env->sregs[SR_EAR], 1770fcf5ef2aSThomas Huth env->debug, env->imm, env->iflags, env->sregs[SR_FSR]); 1771fcf5ef2aSThomas Huth cpu_fprintf(f, "btaken=%d btarget=%x mode=%s(saved=%s) eip=%d ie=%d\n", 1772fcf5ef2aSThomas Huth env->btaken, env->btarget, 1773fcf5ef2aSThomas Huth (env->sregs[SR_MSR] & MSR_UM) ? "user" : "kernel", 1774fcf5ef2aSThomas Huth (env->sregs[SR_MSR] & MSR_UMS) ? "user" : "kernel", 1775fcf5ef2aSThomas Huth (env->sregs[SR_MSR] & MSR_EIP), 1776fcf5ef2aSThomas Huth (env->sregs[SR_MSR] & MSR_IE)); 1777fcf5ef2aSThomas Huth 1778fcf5ef2aSThomas Huth for (i = 0; i < 32; i++) { 1779fcf5ef2aSThomas Huth cpu_fprintf(f, "r%2.2d=%8.8x ", i, env->regs[i]); 1780fcf5ef2aSThomas Huth if ((i + 1) % 4 == 0) 1781fcf5ef2aSThomas Huth cpu_fprintf(f, "\n"); 1782fcf5ef2aSThomas Huth } 1783fcf5ef2aSThomas Huth cpu_fprintf(f, "\n\n"); 1784fcf5ef2aSThomas Huth } 1785fcf5ef2aSThomas Huth 1786fcf5ef2aSThomas Huth void mb_tcg_init(void) 1787fcf5ef2aSThomas Huth { 1788fcf5ef2aSThomas Huth int i; 1789fcf5ef2aSThomas Huth 1790cfeea807SEdgar E. Iglesias env_debug = tcg_global_mem_new_i32(cpu_env, 1791fcf5ef2aSThomas Huth offsetof(CPUMBState, debug), 1792fcf5ef2aSThomas Huth "debug0"); 1793cfeea807SEdgar E. Iglesias env_iflags = tcg_global_mem_new_i32(cpu_env, 1794fcf5ef2aSThomas Huth offsetof(CPUMBState, iflags), 1795fcf5ef2aSThomas Huth "iflags"); 1796cfeea807SEdgar E. Iglesias env_imm = tcg_global_mem_new_i32(cpu_env, 1797fcf5ef2aSThomas Huth offsetof(CPUMBState, imm), 1798fcf5ef2aSThomas Huth "imm"); 1799cfeea807SEdgar E. Iglesias env_btarget = tcg_global_mem_new_i32(cpu_env, 1800fcf5ef2aSThomas Huth offsetof(CPUMBState, btarget), 1801fcf5ef2aSThomas Huth "btarget"); 1802cfeea807SEdgar E. Iglesias env_btaken = tcg_global_mem_new_i32(cpu_env, 1803fcf5ef2aSThomas Huth offsetof(CPUMBState, btaken), 1804fcf5ef2aSThomas Huth "btaken"); 1805403322eaSEdgar E. Iglesias env_res_addr = tcg_global_mem_new(cpu_env, 1806fcf5ef2aSThomas Huth offsetof(CPUMBState, res_addr), 1807fcf5ef2aSThomas Huth "res_addr"); 1808cfeea807SEdgar E. Iglesias env_res_val = tcg_global_mem_new_i32(cpu_env, 1809fcf5ef2aSThomas Huth offsetof(CPUMBState, res_val), 1810fcf5ef2aSThomas Huth "res_val"); 1811fcf5ef2aSThomas Huth for (i = 0; i < ARRAY_SIZE(cpu_R); i++) { 1812cfeea807SEdgar E. Iglesias cpu_R[i] = tcg_global_mem_new_i32(cpu_env, 1813fcf5ef2aSThomas Huth offsetof(CPUMBState, regs[i]), 1814fcf5ef2aSThomas Huth regnames[i]); 1815fcf5ef2aSThomas Huth } 1816fcf5ef2aSThomas Huth for (i = 0; i < ARRAY_SIZE(cpu_SR); i++) { 1817cfeea807SEdgar E. Iglesias cpu_SR[i] = tcg_global_mem_new_i32(cpu_env, 1818fcf5ef2aSThomas Huth offsetof(CPUMBState, sregs[i]), 1819fcf5ef2aSThomas Huth special_regnames[i]); 1820fcf5ef2aSThomas Huth } 1821fcf5ef2aSThomas Huth } 1822fcf5ef2aSThomas Huth 1823fcf5ef2aSThomas Huth void restore_state_to_opc(CPUMBState *env, TranslationBlock *tb, 1824fcf5ef2aSThomas Huth target_ulong *data) 1825fcf5ef2aSThomas Huth { 1826fcf5ef2aSThomas Huth env->sregs[SR_PC] = data[0]; 1827fcf5ef2aSThomas Huth } 1828