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