target-microblaze/translate.c

   1 /*
   2  *  Xilinx MicroBlaze emulation for qemu: main translation routines.
   3  *
   4  *  Copyright (c) 2009 Edgar E. Iglesias.
   5  *  Copyright (c) 2009-2012 PetaLogix Qld Pty Ltd.
   6  *
   7  * This library is free software; you can redistribute it and/or
   8  * modify it under the terms of the GNU Lesser General Public
   9  * License as published by the Free Software Foundation; either
  10  * version 2 of the License, or (at your option) any later version.
  11  *
  12  * This library is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  15  * Lesser General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU Lesser General Public
  18  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
  19  */
  20
  21 #include "cpu.h"
  22 #include "disas/disas.h"
  23 #include "tcg-op.h"
  24 #include "helper.h"
  25 #include "microblaze-decode.h"
  26
  27 #define GEN_HELPER 1
  28 #include "helper.h"
  29
  30 #define SIM_COMPAT 0
  31 #define DISAS_GNU 1
  32 #define DISAS_MB 1
  33 #if DISAS_MB && !SIM_COMPAT
  34 #  define LOG_DIS(...) qemu_log_mask(CPU_LOG_TB_IN_ASM, ## __VA_ARGS__)
  35 #else
  36 #  define LOG_DIS(...) do { } while (0)
  37 #endif
  38
  39 #define D(x)
  40
  41 #define EXTRACT_FIELD(src, start, end) \
  42             (((src) >> start) & ((1 << (end - start + 1)) - 1))
  43
  44 static TCGv env_debug;
  45 static TCGv_ptr cpu_env;
  46 static TCGv cpu_R[32];
  47 static TCGv cpu_SR[18];
  48 static TCGv env_imm;
  49 static TCGv env_btaken;
  50 static TCGv env_btarget;
  51 static TCGv env_iflags;
  52
  53 #include "exec/gen-icount.h"
  54
  55 /* This is the state at translation time.  */
  56 typedef struct DisasContext {
  57     CPUMBState *env;
  58     target_ulong pc;
  59
  60     /* Decoder.  */
  61     int type_b;
  62     uint32_t ir;
  63     uint8_t opcode;
  64     uint8_t rd, ra, rb;
  65     uint16_t imm;
  66
  67     unsigned int cpustate_changed;
  68     unsigned int delayed_branch;
  69     unsigned int tb_flags, synced_flags; /* tb dependent flags.  */
  70     unsigned int clear_imm;
  71     int is_jmp;
  72
  73 #define JMP_NOJMP     0
  74 #define JMP_DIRECT    1
  75 #define JMP_DIRECT_CC 2
  76 #define JMP_INDIRECT  3
  77     unsigned int jmp;
  78     uint32_t jmp_pc;
  79
  80     int abort_at_next_insn;
  81     int nr_nops;
  82     struct TranslationBlock *tb;
  83     int singlestep_enabled;
  84 } DisasContext;
  85
  86 static const char *regnames[] =
  87 {
  88     "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7",
  89     "r8", "r9", "r10", "r11", "r12", "r13", "r14", "r15",
  90     "r16", "r17", "r18", "r19", "r20", "r21", "r22", "r23",
  91     "r24", "r25", "r26", "r27", "r28", "r29", "r30", "r31",
  92 };
  93
  94 static const char *special_regnames[] =
  95 {
  96     "rpc", "rmsr", "sr2", "sr3", "sr4", "sr5", "sr6", "sr7",
  97     "sr8", "sr9", "sr10", "sr11", "sr12", "sr13", "sr14", "sr15",
  98     "sr16", "sr17", "sr18"
  99 };
 100
 101 /* Sign extend at translation time.  */
 102 static inline int sign_extend(unsigned int val, unsigned int width)
 103 {
 104         int sval;
 105
 106         /* LSL.  */
 107         val <<= 31 - width;
 108         sval = val;
 109         /* ASR.  */
 110         sval >>= 31 - width;
 111         return sval;
 112 }
 113
 114 static inline void t_sync_flags(DisasContext *dc)
 115 {
 116     /* Synch the tb dependent flags between translator and runtime.  */
 117     if (dc->tb_flags != dc->synced_flags) {
 118         tcg_gen_movi_tl(env_iflags, dc->tb_flags);
 119         dc->synced_flags = dc->tb_flags;
 120     }
 121 }
 122
 123 static inline void t_gen_raise_exception(DisasContext *dc, uint32_t index)
 124 {
 125     TCGv_i32 tmp = tcg_const_i32(index);
 126
 127     t_sync_flags(dc);
 128     tcg_gen_movi_tl(cpu_SR[SR_PC], dc->pc);
 129     gen_helper_raise_exception(cpu_env, tmp);
 130     tcg_temp_free_i32(tmp);
 131     dc->is_jmp = DISAS_UPDATE;
 132 }
 133
 134 static void gen_goto_tb(DisasContext *dc, int n, target_ulong dest)
 135 {
 136     TranslationBlock *tb;
 137     tb = dc->tb;
 138     if ((tb->pc & TARGET_PAGE_MASK) == (dest & TARGET_PAGE_MASK)) {
 139         tcg_gen_goto_tb(n);
 140         tcg_gen_movi_tl(cpu_SR[SR_PC], dest);
 141         tcg_gen_exit_tb((uintptr_t)tb + n);
 142     } else {
 143         tcg_gen_movi_tl(cpu_SR[SR_PC], dest);
 144         tcg_gen_exit_tb(0);
 145     }
 146 }
 147
 148 static void read_carry(DisasContext *dc, TCGv d)
 149 {
 150     tcg_gen_shri_tl(d, cpu_SR[SR_MSR], 31);
 151 }
 152
 153 /*
 154  * write_carry sets the carry bits in MSR based on bit 0 of v.
 155  * v[31:1] are ignored.
 156  */
 157 static void write_carry(DisasContext *dc, TCGv v)
 158 {
 159     TCGv t0 = tcg_temp_new();
 160     tcg_gen_shli_tl(t0, v, 31);
 161     tcg_gen_sari_tl(t0, t0, 31);
 162     tcg_gen_andi_tl(t0, t0, (MSR_C | MSR_CC));
 163     tcg_gen_andi_tl(cpu_SR[SR_MSR], cpu_SR[SR_MSR],
 164                     ~(MSR_C | MSR_CC));
 165     tcg_gen_or_tl(cpu_SR[SR_MSR], cpu_SR[SR_MSR], t0);
 166     tcg_temp_free(t0);
 167 }
 168
 169 static void write_carryi(DisasContext *dc, bool carry)
 170 {
 171     TCGv t0 = tcg_temp_new();
 172     tcg_gen_movi_tl(t0, carry);
 173     write_carry(dc, t0);
 174     tcg_temp_free(t0);
 175 }
 176
 177 /* True if ALU operand b is a small immediate that may deserve
 178    faster treatment.  */
 179 static inline int dec_alu_op_b_is_small_imm(DisasContext *dc)
 180 {
 181     /* Immediate insn without the imm prefix ?  */
 182     return dc->type_b && !(dc->tb_flags & IMM_FLAG);
 183 }
 184
 185 static inline TCGv *dec_alu_op_b(DisasContext *dc)
 186 {
 187     if (dc->type_b) {
 188         if (dc->tb_flags & IMM_FLAG)
 189             tcg_gen_ori_tl(env_imm, env_imm, dc->imm);
 190         else
 191             tcg_gen_movi_tl(env_imm, (int32_t)((int16_t)dc->imm));
 192         return &env_imm;
 193     } else
 194         return &cpu_R[dc->rb];
 195 }
 196
 197 static void dec_add(DisasContext *dc)
 198 {
 199     unsigned int k, c;
 200     TCGv cf;
 201
 202     k = dc->opcode & 4;
 203     c = dc->opcode & 2;
 204
 205     LOG_DIS("add%s%s%s r%d r%d r%d\n",
 206             dc->type_b ? "i" : "", k ? "k" : "", c ? "c" : "",
 207             dc->rd, dc->ra, dc->rb);
 208
 209     /* Take care of the easy cases first.  */
 210     if (k) {
 211         /* k - keep carry, no need to update MSR.  */
 212         /* If rd == r0, it's a nop.  */
 213         if (dc->rd) {
 214             tcg_gen_add_tl(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc)));
 215
 216             if (c) {
 217                 /* c - Add carry into the result.  */
 218                 cf = tcg_temp_new();
 219
 220                 read_carry(dc, cf);
 221                 tcg_gen_add_tl(cpu_R[dc->rd], cpu_R[dc->rd], cf);
 222                 tcg_temp_free(cf);
 223             }
 224         }
 225         return;
 226     }
 227
 228     /* From now on, we can assume k is zero.  So we need to update MSR.  */
 229     /* Extract carry.  */
 230     cf = tcg_temp_new();
 231     if (c) {
 232         read_carry(dc, cf);
 233     } else {
 234         tcg_gen_movi_tl(cf, 0);
 235     }
 236
 237     if (dc->rd) {
 238         TCGv ncf = tcg_temp_new();
 239         gen_helper_carry(ncf, cpu_R[dc->ra], *(dec_alu_op_b(dc)), cf);
 240         tcg_gen_add_tl(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc)));
 241         tcg_gen_add_tl(cpu_R[dc->rd], cpu_R[dc->rd], cf);
 242         write_carry(dc, ncf);
 243         tcg_temp_free(ncf);
 244     } else {
 245         gen_helper_carry(cf, cpu_R[dc->ra], *(dec_alu_op_b(dc)), cf);
 246         write_carry(dc, cf);
 247     }
 248     tcg_temp_free(cf);
 249 }
 250
 251 static void dec_sub(DisasContext *dc)
 252 {
 253     unsigned int u, cmp, k, c;
 254     TCGv cf, na;
 255
 256     u = dc->imm & 2;
 257     k = dc->opcode & 4;
 258     c = dc->opcode & 2;
 259     cmp = (dc->imm & 1) && (!dc->type_b) && k;
 260
 261     if (cmp) {
 262         LOG_DIS("cmp%s r%d, r%d ir=%x\n", u ? "u" : "", dc->rd, dc->ra, dc->ir);
 263         if (dc->rd) {
 264             if (u)
 265                 gen_helper_cmpu(cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]);
 266             else
 267                 gen_helper_cmp(cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]);
 268         }
 269         return;
 270     }
 271
 272     LOG_DIS("sub%s%s r%d, r%d r%d\n",
 273              k ? "k" : "",  c ? "c" : "", dc->rd, dc->ra, dc->rb);
 274
 275     /* Take care of the easy cases first.  */
 276     if (k) {
 277         /* k - keep carry, no need to update MSR.  */
 278         /* If rd == r0, it's a nop.  */
 279         if (dc->rd) {
 280             tcg_gen_sub_tl(cpu_R[dc->rd], *(dec_alu_op_b(dc)), cpu_R[dc->ra]);
 281
 282             if (c) {
 283                 /* c - Add carry into the result.  */
 284                 cf = tcg_temp_new();
 285
 286                 read_carry(dc, cf);
 287                 tcg_gen_add_tl(cpu_R[dc->rd], cpu_R[dc->rd], cf);
 288                 tcg_temp_free(cf);
 289             }
 290         }
 291         return;
 292     }
 293
 294     /* From now on, we can assume k is zero.  So we need to update MSR.  */
 295     /* Extract carry. And complement a into na.  */
 296     cf = tcg_temp_new();
 297     na = tcg_temp_new();
 298     if (c) {
 299         read_carry(dc, cf);
 300     } else {
 301         tcg_gen_movi_tl(cf, 1);
 302     }
 303
 304     /* d = b + ~a + c. carry defaults to 1.  */
 305     tcg_gen_not_tl(na, cpu_R[dc->ra]);
 306
 307     if (dc->rd) {
 308         TCGv ncf = tcg_temp_new();
 309         gen_helper_carry(ncf, na, *(dec_alu_op_b(dc)), cf);
 310         tcg_gen_add_tl(cpu_R[dc->rd], na, *(dec_alu_op_b(dc)));
 311         tcg_gen_add_tl(cpu_R[dc->rd], cpu_R[dc->rd], cf);
 312         write_carry(dc, ncf);
 313         tcg_temp_free(ncf);
 314     } else {
 315         gen_helper_carry(cf, na, *(dec_alu_op_b(dc)), cf);
 316         write_carry(dc, cf);
 317     }
 318     tcg_temp_free(cf);
 319     tcg_temp_free(na);
 320 }
 321
 322 static void dec_pattern(DisasContext *dc)
 323 {
 324     unsigned int mode;
 325     int l1;
 326
 327     if ((dc->tb_flags & MSR_EE_FLAG)
 328           && (dc->env->pvr.regs[2] & PVR2_ILL_OPCODE_EXC_MASK)
 329           && !((dc->env->pvr.regs[2] & PVR2_USE_PCMP_INSTR))) {
 330         tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_ILLEGAL_OP);
 331         t_gen_raise_exception(dc, EXCP_HW_EXCP);
 332     }
 333
 334     mode = dc->opcode & 3;
 335     switch (mode) {
 336         case 0:
 337             /* pcmpbf.  */
 338             LOG_DIS("pcmpbf r%d r%d r%d\n", dc->rd, dc->ra, dc->rb);
 339             if (dc->rd)
 340                 gen_helper_pcmpbf(cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]);
 341             break;
 342         case 2:
 343             LOG_DIS("pcmpeq r%d r%d r%d\n", dc->rd, dc->ra, dc->rb);
 344             if (dc->rd) {
 345                 TCGv t0 = tcg_temp_local_new();
 346                 l1 = gen_new_label();
 347                 tcg_gen_movi_tl(t0, 1);
 348                 tcg_gen_brcond_tl(TCG_COND_EQ,
 349                                   cpu_R[dc->ra], cpu_R[dc->rb], l1);
 350                 tcg_gen_movi_tl(t0, 0);
 351                 gen_set_label(l1);
 352                 tcg_gen_mov_tl(cpu_R[dc->rd], t0);
 353                 tcg_temp_free(t0);
 354             }
 355             break;
 356         case 3:
 357             LOG_DIS("pcmpne r%d r%d r%d\n", dc->rd, dc->ra, dc->rb);
 358             l1 = gen_new_label();
 359             if (dc->rd) {
 360                 TCGv t0 = tcg_temp_local_new();
 361                 tcg_gen_movi_tl(t0, 1);
 362                 tcg_gen_brcond_tl(TCG_COND_NE,
 363                                   cpu_R[dc->ra], cpu_R[dc->rb], l1);
 364                 tcg_gen_movi_tl(t0, 0);
 365                 gen_set_label(l1);
 366                 tcg_gen_mov_tl(cpu_R[dc->rd], t0);
 367                 tcg_temp_free(t0);
 368             }
 369             break;
 370         default:
 371             cpu_abort(dc->env,
 372                       "unsupported pattern insn opcode=%x\n", dc->opcode);
 373             break;
 374     }
 375 }
 376
 377 static void dec_and(DisasContext *dc)
 378 {
 379     unsigned int not;
 380
 381     if (!dc->type_b && (dc->imm & (1 << 10))) {
 382         dec_pattern(dc);
 383         return;
 384     }
 385
 386     not = dc->opcode & (1 << 1);
 387     LOG_DIS("and%s\n", not ? "n" : "");
 388
 389     if (!dc->rd)
 390         return;
 391
 392     if (not) {
 393         tcg_gen_andc_tl(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc)));
 394     } else
 395         tcg_gen_and_tl(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc)));
 396 }
 397
 398 static void dec_or(DisasContext *dc)
 399 {
 400     if (!dc->type_b && (dc->imm & (1 << 10))) {
 401         dec_pattern(dc);
 402         return;
 403     }
 404
 405     LOG_DIS("or r%d r%d r%d imm=%x\n", dc->rd, dc->ra, dc->rb, dc->imm);
 406     if (dc->rd)
 407         tcg_gen_or_tl(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc)));
 408 }
 409
 410 static void dec_xor(DisasContext *dc)
 411 {
 412     if (!dc->type_b && (dc->imm & (1 << 10))) {
 413         dec_pattern(dc);
 414         return;
 415     }
 416
 417     LOG_DIS("xor r%d\n", dc->rd);
 418     if (dc->rd)
 419         tcg_gen_xor_tl(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc)));
 420 }
 421
 422 static inline void msr_read(DisasContext *dc, TCGv d)
 423 {
 424     tcg_gen_mov_tl(d, cpu_SR[SR_MSR]);
 425 }
 426
 427 static inline void msr_write(DisasContext *dc, TCGv v)
 428 {
 429     TCGv t;
 430
 431     t = tcg_temp_new();
 432     dc->cpustate_changed = 1;
 433     /* PVR bit is not writable.  */
 434     tcg_gen_andi_tl(t, v, ~MSR_PVR);
 435     tcg_gen_andi_tl(cpu_SR[SR_MSR], cpu_SR[SR_MSR], MSR_PVR);
 436     tcg_gen_or_tl(cpu_SR[SR_MSR], cpu_SR[SR_MSR], v);
 437     tcg_temp_free(t);
 438 }
 439
 440 static void dec_msr(DisasContext *dc)
 441 {
 442     TCGv t0, t1;
 443     unsigned int sr, to, rn;
 444     int mem_index = cpu_mmu_index(dc->env);
 445
 446     sr = dc->imm & ((1 << 14) - 1);
 447     to = dc->imm & (1 << 14);
 448     dc->type_b = 1;
 449     if (to)
 450         dc->cpustate_changed = 1;
 451
 452     /* msrclr and msrset.  */
 453     if (!(dc->imm & (1 << 15))) {
 454         unsigned int clr = dc->ir & (1 << 16);
 455
 456         LOG_DIS("msr%s r%d imm=%x\n", clr ? "clr" : "set",
 457                 dc->rd, dc->imm);
 458
 459         if (!(dc->env->pvr.regs[2] & PVR2_USE_MSR_INSTR)) {
 460             /* nop??? */
 461             return;
 462         }
 463
 464         if ((dc->tb_flags & MSR_EE_FLAG)
 465             && mem_index == MMU_USER_IDX && (dc->imm != 4 && dc->imm != 0)) {
 466             tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_PRIVINSN);
 467             t_gen_raise_exception(dc, EXCP_HW_EXCP);
 468             return;
 469         }
 470
 471         if (dc->rd)
 472             msr_read(dc, cpu_R[dc->rd]);
 473
 474         t0 = tcg_temp_new();
 475         t1 = tcg_temp_new();
 476         msr_read(dc, t0);
 477         tcg_gen_mov_tl(t1, *(dec_alu_op_b(dc)));
 478
 479         if (clr) {
 480             tcg_gen_not_tl(t1, t1);
 481             tcg_gen_and_tl(t0, t0, t1);
 482         } else
 483             tcg_gen_or_tl(t0, t0, t1);
 484         msr_write(dc, t0);
 485         tcg_temp_free(t0);
 486         tcg_temp_free(t1);
 487         tcg_gen_movi_tl(cpu_SR[SR_PC], dc->pc + 4);
 488         dc->is_jmp = DISAS_UPDATE;
 489         return;
 490     }
 491
 492     if (to) {
 493         if ((dc->tb_flags & MSR_EE_FLAG)
 494              && mem_index == MMU_USER_IDX) {
 495             tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_PRIVINSN);
 496             t_gen_raise_exception(dc, EXCP_HW_EXCP);
 497             return;
 498         }
 499     }
 500
 501 #if !defined(CONFIG_USER_ONLY)
 502     /* Catch read/writes to the mmu block.  */
 503     if ((sr & ~0xff) == 0x1000) {
 504         sr &= 7;
 505         LOG_DIS("m%ss sr%d r%d imm=%x\n", to ? "t" : "f", sr, dc->ra, dc->imm);
 506         if (to)
 507             gen_helper_mmu_write(cpu_env, tcg_const_tl(sr), cpu_R[dc->ra]);
 508         else
 509             gen_helper_mmu_read(cpu_R[dc->rd], cpu_env, tcg_const_tl(sr));
 510         return;
 511     }
 512 #endif
 513
 514     if (to) {
 515         LOG_DIS("m%ss sr%x r%d imm=%x\n", to ? "t" : "f", sr, dc->ra, dc->imm);
 516         switch (sr) {
 517             case 0:
 518                 break;
 519             case 1:
 520                 msr_write(dc, cpu_R[dc->ra]);
 521                 break;
 522             case 0x3:
 523                 tcg_gen_mov_tl(cpu_SR[SR_EAR], cpu_R[dc->ra]);
 524                 break;
 525             case 0x5:
 526                 tcg_gen_mov_tl(cpu_SR[SR_ESR], cpu_R[dc->ra]);
 527                 break;
 528             case 0x7:
 529                 tcg_gen_andi_tl(cpu_SR[SR_FSR], cpu_R[dc->ra], 31);
 530                 break;
 531             case 0x800:
 532                 tcg_gen_st_tl(cpu_R[dc->ra], cpu_env, offsetof(CPUMBState, slr));
 533                 break;
 534             case 0x802:
 535                 tcg_gen_st_tl(cpu_R[dc->ra], cpu_env, offsetof(CPUMBState, shr));
 536                 break;
 537             default:
 538                 cpu_abort(dc->env, "unknown mts reg %x\n", sr);
 539                 break;
 540         }
 541     } else {
 542         LOG_DIS("m%ss r%d sr%x imm=%x\n", to ? "t" : "f", dc->rd, sr, dc->imm);
 543
 544         switch (sr) {
 545             case 0:
 546                 tcg_gen_movi_tl(cpu_R[dc->rd], dc->pc);
 547                 break;
 548             case 1:
 549                 msr_read(dc, cpu_R[dc->rd]);
 550                 break;
 551             case 0x3:
 552                 tcg_gen_mov_tl(cpu_R[dc->rd], cpu_SR[SR_EAR]);
 553                 break;
 554             case 0x5:
 555                 tcg_gen_mov_tl(cpu_R[dc->rd], cpu_SR[SR_ESR]);
 556                 break;
 557              case 0x7:
 558                 tcg_gen_mov_tl(cpu_R[dc->rd], cpu_SR[SR_FSR]);
 559                 break;
 560             case 0xb:
 561                 tcg_gen_mov_tl(cpu_R[dc->rd], cpu_SR[SR_BTR]);
 562                 break;
 563             case 0x800:
 564                 tcg_gen_ld_tl(cpu_R[dc->rd], cpu_env, offsetof(CPUMBState, slr));
 565                 break;
 566             case 0x802:
 567                 tcg_gen_ld_tl(cpu_R[dc->rd], cpu_env, offsetof(CPUMBState, shr));
 568                 break;
 569             case 0x2000:
 570             case 0x2001:
 571             case 0x2002:
 572             case 0x2003:
 573             case 0x2004:
 574             case 0x2005:
 575             case 0x2006:
 576             case 0x2007:
 577             case 0x2008:
 578             case 0x2009:
 579             case 0x200a:
 580             case 0x200b:
 581             case 0x200c:
 582                 rn = sr & 0xf;
 583                 tcg_gen_ld_tl(cpu_R[dc->rd],
 584                               cpu_env, offsetof(CPUMBState, pvr.regs[rn]));
 585                 break;
 586             default:
 587                 cpu_abort(dc->env, "unknown mfs reg %x\n", sr);
 588                 break;
 589         }
 590     }
 591
 592     if (dc->rd == 0) {
 593         tcg_gen_movi_tl(cpu_R[0], 0);
 594     }
 595 }
 596
 597 /* 64-bit signed mul, lower result in d and upper in d2.  */
 598 static void t_gen_muls(TCGv d, TCGv d2, TCGv a, TCGv b)
 599 {
 600     TCGv_i64 t0, t1;
 601
 602     t0 = tcg_temp_new_i64();
 603     t1 = tcg_temp_new_i64();
 604
 605     tcg_gen_ext_i32_i64(t0, a);
 606     tcg_gen_ext_i32_i64(t1, b);
 607     tcg_gen_mul_i64(t0, t0, t1);
 608
 609     tcg_gen_trunc_i64_i32(d, t0);
 610     tcg_gen_shri_i64(t0, t0, 32);
 611     tcg_gen_trunc_i64_i32(d2, t0);
 612
 613     tcg_temp_free_i64(t0);
 614     tcg_temp_free_i64(t1);
 615 }
 616
 617 /* 64-bit unsigned muls, lower result in d and upper in d2.  */
 618 static void t_gen_mulu(TCGv d, TCGv d2, TCGv a, TCGv b)
 619 {
 620     TCGv_i64 t0, t1;
 621
 622     t0 = tcg_temp_new_i64();
 623     t1 = tcg_temp_new_i64();
 624
 625     tcg_gen_extu_i32_i64(t0, a);
 626     tcg_gen_extu_i32_i64(t1, b);
 627     tcg_gen_mul_i64(t0, t0, t1);
 628
 629     tcg_gen_trunc_i64_i32(d, t0);
 630     tcg_gen_shri_i64(t0, t0, 32);
 631     tcg_gen_trunc_i64_i32(d2, t0);
 632
 633     tcg_temp_free_i64(t0);
 634     tcg_temp_free_i64(t1);
 635 }
 636
 637 /* Multiplier unit.  */
 638 static void dec_mul(DisasContext *dc)
 639 {
 640     TCGv d[2];
 641     unsigned int subcode;
 642
 643     if ((dc->tb_flags & MSR_EE_FLAG)
 644          && (dc->env->pvr.regs[2] & PVR2_ILL_OPCODE_EXC_MASK)
 645          && !(dc->env->pvr.regs[0] & PVR0_USE_HW_MUL_MASK)) {
 646         tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_ILLEGAL_OP);
 647         t_gen_raise_exception(dc, EXCP_HW_EXCP);
 648         return;
 649     }
 650
 651     subcode = dc->imm & 3;
 652     d[0] = tcg_temp_new();
 653     d[1] = tcg_temp_new();
 654
 655     if (dc->type_b) {
 656         LOG_DIS("muli r%d r%d %x\n", dc->rd, dc->ra, dc->imm);
 657         t_gen_mulu(cpu_R[dc->rd], d[1], cpu_R[dc->ra], *(dec_alu_op_b(dc)));
 658         goto done;
 659     }
 660
 661     /* mulh, mulhsu and mulhu are not available if C_USE_HW_MUL is < 2.  */
 662     if (subcode >= 1 && subcode <= 3
 663         && !((dc->env->pvr.regs[2] & PVR2_USE_MUL64_MASK))) {
 664         /* nop??? */
 665     }
 666
 667     switch (subcode) {
 668         case 0:
 669             LOG_DIS("mul r%d r%d r%d\n", dc->rd, dc->ra, dc->rb);
 670             t_gen_mulu(cpu_R[dc->rd], d[1], cpu_R[dc->ra], cpu_R[dc->rb]);
 671             break;
 672         case 1:
 673             LOG_DIS("mulh r%d r%d r%d\n", dc->rd, dc->ra, dc->rb);
 674             t_gen_muls(d[0], cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]);
 675             break;
 676         case 2:
 677             LOG_DIS("mulhsu r%d r%d r%d\n", dc->rd, dc->ra, dc->rb);
 678             t_gen_muls(d[0], cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]);
 679             break;
 680         case 3:
 681             LOG_DIS("mulhu r%d r%d r%d\n", dc->rd, dc->ra, dc->rb);
 682             t_gen_mulu(d[0], cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]);
 683             break;
 684         default:
 685             cpu_abort(dc->env, "unknown MUL insn %x\n", subcode);
 686             break;
 687     }
 688 done:
 689     tcg_temp_free(d[0]);
 690     tcg_temp_free(d[1]);
 691 }
 692
 693 /* Div unit.  */
 694 static void dec_div(DisasContext *dc)
 695 {
 696     unsigned int u;
 697
 698     u = dc->imm & 2;
 699     LOG_DIS("div\n");
 700
 701     if ((dc->env->pvr.regs[2] & PVR2_ILL_OPCODE_EXC_MASK)
 702           && !((dc->env->pvr.regs[0] & PVR0_USE_DIV_MASK))) {
 703         tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_ILLEGAL_OP);
 704         t_gen_raise_exception(dc, EXCP_HW_EXCP);
 705     }
 706
 707     if (u)
 708         gen_helper_divu(cpu_R[dc->rd], cpu_env, *(dec_alu_op_b(dc)),
 709                         cpu_R[dc->ra]);
 710     else
 711         gen_helper_divs(cpu_R[dc->rd], cpu_env, *(dec_alu_op_b(dc)),
 712                         cpu_R[dc->ra]);
 713     if (!dc->rd)
 714         tcg_gen_movi_tl(cpu_R[dc->rd], 0);
 715 }
 716
 717 static void dec_barrel(DisasContext *dc)
 718 {
 719     TCGv t0;
 720     unsigned int s, t;
 721
 722     if ((dc->tb_flags & MSR_EE_FLAG)
 723           && (dc->env->pvr.regs[2] & PVR2_ILL_OPCODE_EXC_MASK)
 724           && !(dc->env->pvr.regs[0] & PVR0_USE_BARREL_MASK)) {
 725         tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_ILLEGAL_OP);
 726         t_gen_raise_exception(dc, EXCP_HW_EXCP);
 727         return;
 728     }
 729
 730     s = dc->imm & (1 << 10);
 731     t = dc->imm & (1 << 9);
 732
 733     LOG_DIS("bs%s%s r%d r%d r%d\n",
 734             s ? "l" : "r", t ? "a" : "l", dc->rd, dc->ra, dc->rb);
 735
 736     t0 = tcg_temp_new();
 737
 738     tcg_gen_mov_tl(t0, *(dec_alu_op_b(dc)));
 739     tcg_gen_andi_tl(t0, t0, 31);
 740
 741     if (s)
 742         tcg_gen_shl_tl(cpu_R[dc->rd], cpu_R[dc->ra], t0);
 743     else {
 744         if (t)
 745             tcg_gen_sar_tl(cpu_R[dc->rd], cpu_R[dc->ra], t0);
 746         else
 747             tcg_gen_shr_tl(cpu_R[dc->rd], cpu_R[dc->ra], t0);
 748     }
 749 }
 750
 751 static void dec_bit(DisasContext *dc)
 752 {
 753     TCGv t0, t1;
 754     unsigned int op;
 755     int mem_index = cpu_mmu_index(dc->env);
 756
 757     op = dc->ir & ((1 << 9) - 1);
 758     switch (op) {
 759         case 0x21:
 760             /* src.  */
 761             t0 = tcg_temp_new();
 762
 763             LOG_DIS("src r%d r%d\n", dc->rd, dc->ra);
 764             tcg_gen_andi_tl(t0, cpu_R[dc->ra], 1);
 765             if (dc->rd) {
 766                 t1 = tcg_temp_new();
 767                 read_carry(dc, t1);
 768                 tcg_gen_shli_tl(t1, t1, 31);
 769
 770                 tcg_gen_shri_tl(cpu_R[dc->rd], cpu_R[dc->ra], 1);
 771                 tcg_gen_or_tl(cpu_R[dc->rd], cpu_R[dc->rd], t1);
 772                 tcg_temp_free(t1);
 773             }
 774
 775             /* Update carry.  */
 776             write_carry(dc, t0);
 777             tcg_temp_free(t0);
 778             break;
 779
 780         case 0x1:
 781         case 0x41:
 782             /* srl.  */
 783             t0 = tcg_temp_new();
 784             LOG_DIS("srl r%d r%d\n", dc->rd, dc->ra);
 785
 786             /* Update carry.  */
 787             tcg_gen_andi_tl(t0, cpu_R[dc->ra], 1);
 788             write_carry(dc, t0);
 789             tcg_temp_free(t0);
 790             if (dc->rd) {
 791                 if (op == 0x41)
 792                     tcg_gen_shri_tl(cpu_R[dc->rd], cpu_R[dc->ra], 1);
 793                 else
 794                     tcg_gen_sari_tl(cpu_R[dc->rd], cpu_R[dc->ra], 1);
 795             }
 796             break;
 797         case 0x60:
 798             LOG_DIS("ext8s r%d r%d\n", dc->rd, dc->ra);
 799             tcg_gen_ext8s_i32(cpu_R[dc->rd], cpu_R[dc->ra]);
 800             break;
 801         case 0x61:
 802             LOG_DIS("ext16s r%d r%d\n", dc->rd, dc->ra);
 803             tcg_gen_ext16s_i32(cpu_R[dc->rd], cpu_R[dc->ra]);
 804             break;
 805         case 0x64:
 806         case 0x66:
 807         case 0x74:
 808         case 0x76:
 809             /* wdc.  */
 810             LOG_DIS("wdc r%d\n", dc->ra);
 811             if ((dc->tb_flags & MSR_EE_FLAG)
 812                  && mem_index == MMU_USER_IDX) {
 813                 tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_PRIVINSN);
 814                 t_gen_raise_exception(dc, EXCP_HW_EXCP);
 815                 return;
 816             }
 817             break;
 818         case 0x68:
 819             /* wic.  */
 820             LOG_DIS("wic r%d\n", dc->ra);
 821             if ((dc->tb_flags & MSR_EE_FLAG)
 822                  && mem_index == MMU_USER_IDX) {
 823                 tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_PRIVINSN);
 824                 t_gen_raise_exception(dc, EXCP_HW_EXCP);
 825                 return;
 826             }
 827             break;
 828         case 0xe0:
 829             if ((dc->tb_flags & MSR_EE_FLAG)
 830                 && (dc->env->pvr.regs[2] & PVR2_ILL_OPCODE_EXC_MASK)
 831                 && !((dc->env->pvr.regs[2] & PVR2_USE_PCMP_INSTR))) {
 832                 tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_ILLEGAL_OP);
 833                 t_gen_raise_exception(dc, EXCP_HW_EXCP);
 834             }
 835             if (dc->env->pvr.regs[2] & PVR2_USE_PCMP_INSTR) {
 836                 gen_helper_clz(cpu_R[dc->rd], cpu_R[dc->ra]);
 837             }
 838             break;
 839         case 0x1e0:
 840             /* swapb */
 841             LOG_DIS("swapb r%d r%d\n", dc->rd, dc->ra);
 842             tcg_gen_bswap32_i32(cpu_R[dc->rd], cpu_R[dc->ra]);
 843             break;
 844         case 0x1e2:
 845             /*swaph */
 846             LOG_DIS("swaph r%d r%d\n", dc->rd, dc->ra);
 847             tcg_gen_rotri_i32(cpu_R[dc->rd], cpu_R[dc->ra], 16);
 848             break;
 849         default:
 850             cpu_abort(dc->env, "unknown bit oc=%x op=%x rd=%d ra=%d rb=%d\n",
 851                      dc->pc, op, dc->rd, dc->ra, dc->rb);
 852             break;
 853     }
 854 }
 855
 856 static inline void sync_jmpstate(DisasContext *dc)
 857 {
 858     if (dc->jmp == JMP_DIRECT || dc->jmp == JMP_DIRECT_CC) {
 859         if (dc->jmp == JMP_DIRECT) {
 860             tcg_gen_movi_tl(env_btaken, 1);
 861         }
 862         dc->jmp = JMP_INDIRECT;
 863         tcg_gen_movi_tl(env_btarget, dc->jmp_pc);
 864     }
 865 }
 866
 867 static void dec_imm(DisasContext *dc)
 868 {
 869     LOG_DIS("imm %x\n", dc->imm << 16);
 870     tcg_gen_movi_tl(env_imm, (dc->imm << 16));
 871     dc->tb_flags |= IMM_FLAG;
 872     dc->clear_imm = 0;
 873 }
 874
 875 static inline void gen_load(DisasContext *dc, TCGv dst, TCGv addr,
 876                             unsigned int size)
 877 {
 878     int mem_index = cpu_mmu_index(dc->env);
 879
 880     if (size == 1) {
 881         tcg_gen_qemu_ld8u(dst, addr, mem_index);
 882     } else if (size == 2) {
 883         tcg_gen_qemu_ld16u(dst, addr, mem_index);
 884     } else if (size == 4) {
 885         tcg_gen_qemu_ld32u(dst, addr, mem_index);
 886     } else
 887         cpu_abort(dc->env, "Incorrect load size %d\n", size);
 888 }
 889
 890 static inline TCGv *compute_ldst_addr(DisasContext *dc, TCGv *t)
 891 {
 892     unsigned int extimm = dc->tb_flags & IMM_FLAG;
 893     /* Should be set to one if r1 is used by loadstores.  */
 894     int stackprot = 0;
 895
 896     /* All load/stores use ra.  */
 897     if (dc->ra == 1) {
 898         stackprot = 1;
 899     }
 900
 901     /* Treat the common cases first.  */
 902     if (!dc->type_b) {
 903         /* If any of the regs is r0, return a ptr to the other.  */
 904         if (dc->ra == 0) {
 905             return &cpu_R[dc->rb];
 906         } else if (dc->rb == 0) {
 907             return &cpu_R[dc->ra];
 908         }
 909
 910         if (dc->rb == 1) {
 911             stackprot = 1;
 912         }
 913
 914         *t = tcg_temp_new();
 915         tcg_gen_add_tl(*t, cpu_R[dc->ra], cpu_R[dc->rb]);
 916
 917         if (stackprot) {
 918             gen_helper_stackprot(cpu_env, *t);
 919         }
 920         return t;
 921     }
 922     /* Immediate.  */
 923     if (!extimm) {
 924         if (dc->imm == 0) {
 925             return &cpu_R[dc->ra];
 926         }
 927         *t = tcg_temp_new();
 928         tcg_gen_movi_tl(*t, (int32_t)((int16_t)dc->imm));
 929         tcg_gen_add_tl(*t, cpu_R[dc->ra], *t);
 930     } else {
 931         *t = tcg_temp_new();
 932         tcg_gen_add_tl(*t, cpu_R[dc->ra], *(dec_alu_op_b(dc)));
 933     }
 934
 935     if (stackprot) {
 936         gen_helper_stackprot(cpu_env, *t);
 937     }
 938     return t;
 939 }
 940
 941 static inline void dec_byteswap(DisasContext *dc, TCGv dst, TCGv src, int size)
 942 {
 943     if (size == 4) {
 944         tcg_gen_bswap32_tl(dst, src);
 945     } else if (size == 2) {
 946         TCGv t = tcg_temp_new();
 947
 948         /* bswap16 assumes the high bits are zero.  */
 949         tcg_gen_andi_tl(t, src, 0xffff);
 950         tcg_gen_bswap16_tl(dst, t);
 951         tcg_temp_free(t);
 952     } else {
 953         /* Ignore.
 954         cpu_abort(dc->env, "Invalid ldst byteswap size %d\n", size);
 955         */
 956     }
 957 }
 958
 959 static void dec_load(DisasContext *dc)
 960 {
 961     TCGv t, *addr;
 962     unsigned int size, rev = 0, ex = 0;
 963
 964     size = 1 << (dc->opcode & 3);
 965
 966     if (!dc->type_b) {
 967         rev = (dc->ir >> 9) & 1;
 968         ex = (dc->ir >> 10) & 1;
 969     }
 970
 971     if (size > 4 && (dc->tb_flags & MSR_EE_FLAG)
 972           && (dc->env->pvr.regs[2] & PVR2_ILL_OPCODE_EXC_MASK)) {
 973         tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_ILLEGAL_OP);
 974         t_gen_raise_exception(dc, EXCP_HW_EXCP);
 975         return;
 976     }
 977
 978     LOG_DIS("l%d%s%s%s\n", size, dc->type_b ? "i" : "", rev ? "r" : "",
 979                                                         ex ? "x" : "");
 980
 981     t_sync_flags(dc);
 982     addr = compute_ldst_addr(dc, &t);
 983
 984     /*
 985      * When doing reverse accesses we need to do two things.
 986      *
 987      * 1. Reverse the address wrt endianness.
 988      * 2. Byteswap the data lanes on the way back into the CPU core.
 989      */
 990     if (rev && size != 4) {
 991         /* Endian reverse the address. t is addr.  */
 992         switch (size) {
 993             case 1:
 994             {
 995                 /* 00 -> 11
 996                    01 -> 10
 997                    10 -> 10
 998                    11 -> 00 */
 999                 TCGv low = tcg_temp_new();
1000
1001                 /* Force addr into the temp.  */
1002                 if (addr != &t) {
1003                     t = tcg_temp_new();
1004                     tcg_gen_mov_tl(t, *addr);
1005                     addr = &t;
1006                 }
1007
1008                 tcg_gen_andi_tl(low, t, 3);
1009                 tcg_gen_sub_tl(low, tcg_const_tl(3), low);
1010                 tcg_gen_andi_tl(t, t, ~3);
1011                 tcg_gen_or_tl(t, t, low);
1012                 tcg_gen_mov_tl(env_imm, t);
1013                 tcg_temp_free(low);
1014                 break;
1015             }
1016
1017             case 2:
1018                 /* 00 -> 10
1019                    10 -> 00.  */
1020                 /* Force addr into the temp.  */
1021                 if (addr != &t) {
1022                     t = tcg_temp_new();
1023                     tcg_gen_xori_tl(t, *addr, 2);
1024                     addr = &t;
1025                 } else {
1026                     tcg_gen_xori_tl(t, t, 2);
1027                 }
1028                 break;
1029             default:
1030                 cpu_abort(dc->env, "Invalid reverse size\n");
1031                 break;
1032         }
1033     }
1034
1035     /* lwx does not throw unaligned access errors, so force alignment */
1036     if (ex) {
1037         /* Force addr into the temp.  */
1038         if (addr != &t) {
1039             t = tcg_temp_new();
1040             tcg_gen_mov_tl(t, *addr);
1041             addr = &t;
1042         }
1043         tcg_gen_andi_tl(t, t, ~3);
1044     }
1045
1046     /* If we get a fault on a dslot, the jmpstate better be in sync.  */
1047     sync_jmpstate(dc);
1048
1049     /* Verify alignment if needed.  */
1050     if ((dc->env->pvr.regs[2] & PVR2_UNALIGNED_EXC_MASK) && size > 1) {
1051         TCGv v = tcg_temp_new();
1052
1053         /*
1054          * Microblaze gives MMU faults priority over faults due to
1055          * unaligned addresses. That's why we speculatively do the load
1056          * into v. If the load succeeds, we verify alignment of the
1057          * address and if that succeeds we write into the destination reg.
1058          */
1059         gen_load(dc, v, *addr, size);
1060
1061         tcg_gen_movi_tl(cpu_SR[SR_PC], dc->pc);
1062         gen_helper_memalign(cpu_env, *addr, tcg_const_tl(dc->rd),
1063                             tcg_const_tl(0), tcg_const_tl(size - 1));
1064         if (dc->rd) {
1065             if (rev) {
1066                 dec_byteswap(dc, cpu_R[dc->rd], v, size);
1067             } else {
1068                 tcg_gen_mov_tl(cpu_R[dc->rd], v);
1069             }
1070         }
1071         tcg_temp_free(v);
1072     } else {
1073         if (dc->rd) {
1074             gen_load(dc, cpu_R[dc->rd], *addr, size);
1075             if (rev) {
1076                 dec_byteswap(dc, cpu_R[dc->rd], cpu_R[dc->rd], size);
1077             }
1078         } else {
1079             /* We are loading into r0, no need to reverse.  */
1080             gen_load(dc, env_imm, *addr, size);
1081         }
1082     }
1083
1084     if (ex) { /* lwx */
1085         /* no support for for AXI exclusive so always clear C */
1086         write_carryi(dc, 0);
1087         tcg_gen_st_tl(*addr, cpu_env, offsetof(CPUMBState, res_addr));
1088     }
1089
1090     if (addr == &t)
1091         tcg_temp_free(t);
1092 }
1093
1094 static void gen_store(DisasContext *dc, TCGv addr, TCGv val,
1095                       unsigned int size)
1096 {
1097     int mem_index = cpu_mmu_index(dc->env);
1098
1099     if (size == 1)
1100         tcg_gen_qemu_st8(val, addr, mem_index);
1101     else if (size == 2) {
1102         tcg_gen_qemu_st16(val, addr, mem_index);
1103     } else if (size == 4) {
1104         tcg_gen_qemu_st32(val, addr, mem_index);
1105     } else
1106         cpu_abort(dc->env, "Incorrect store size %d\n", size);
1107 }
1108
1109 static void dec_store(DisasContext *dc)
1110 {
1111     TCGv t, *addr, swx_addr, r_check;
1112     int swx_skip = 0;
1113     unsigned int size, rev = 0, ex = 0;
1114
1115     size = 1 << (dc->opcode & 3);
1116     if (!dc->type_b) {
1117         rev = (dc->ir >> 9) & 1;
1118         ex = (dc->ir >> 10) & 1;
1119     }
1120
1121     if (size > 4 && (dc->tb_flags & MSR_EE_FLAG)
1122           && (dc->env->pvr.regs[2] & PVR2_ILL_OPCODE_EXC_MASK)) {
1123         tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_ILLEGAL_OP);
1124         t_gen_raise_exception(dc, EXCP_HW_EXCP);
1125         return;
1126     }
1127
1128     LOG_DIS("s%d%s%s%s\n", size, dc->type_b ? "i" : "", rev ? "r" : "",
1129                                                         ex ? "x" : "");
1130     t_sync_flags(dc);
1131     /* If we get a fault on a dslot, the jmpstate better be in sync.  */
1132     sync_jmpstate(dc);
1133     addr = compute_ldst_addr(dc, &t);
1134
1135     r_check = tcg_temp_new();
1136     swx_addr = tcg_temp_local_new();
1137     if (ex) { /* swx */
1138
1139         /* Force addr into the swx_addr. */
1140         tcg_gen_mov_tl(swx_addr, *addr);
1141         addr = &swx_addr;
1142         /* swx does not throw unaligned access errors, so force alignment */
1143         tcg_gen_andi_tl(swx_addr, swx_addr, ~3);
1144
1145         tcg_gen_ld_tl(r_check, cpu_env, offsetof(CPUMBState, res_addr));
1146         write_carryi(dc, 1);
1147         swx_skip = gen_new_label();
1148         tcg_gen_brcond_tl(TCG_COND_NE, r_check, swx_addr, swx_skip);
1149         write_carryi(dc, 0);
1150     }
1151
1152     if (rev && size != 4) {
1153         /* Endian reverse the address. t is addr.  */
1154         switch (size) {
1155             case 1:
1156             {
1157                 /* 00 -> 11
1158                    01 -> 10
1159                    10 -> 10
1160                    11 -> 00 */
1161                 TCGv low = tcg_temp_new();
1162
1163                 /* Force addr into the temp.  */
1164                 if (addr != &t) {
1165                     t = tcg_temp_new();
1166                     tcg_gen_mov_tl(t, *addr);
1167                     addr = &t;
1168                 }
1169
1170                 tcg_gen_andi_tl(low, t, 3);
1171                 tcg_gen_sub_tl(low, tcg_const_tl(3), low);
1172                 tcg_gen_andi_tl(t, t, ~3);
1173                 tcg_gen_or_tl(t, t, low);
1174                 tcg_gen_mov_tl(env_imm, t);
1175                 tcg_temp_free(low);
1176                 break;
1177             }
1178
1179             case 2:
1180                 /* 00 -> 10
1181                    10 -> 00.  */
1182                 /* Force addr into the temp.  */
1183                 if (addr != &t) {
1184                     t = tcg_temp_new();
1185                     tcg_gen_xori_tl(t, *addr, 2);
1186                     addr = &t;
1187                 } else {
1188                     tcg_gen_xori_tl(t, t, 2);
1189                 }
1190                 break;
1191             default:
1192                 cpu_abort(dc->env, "Invalid reverse size\n");
1193                 break;
1194         }
1195
1196         if (size != 1) {
1197             TCGv bs_data = tcg_temp_new();
1198             dec_byteswap(dc, bs_data, cpu_R[dc->rd], size);
1199             gen_store(dc, *addr, bs_data, size);
1200             tcg_temp_free(bs_data);
1201         } else {
1202             gen_store(dc, *addr, cpu_R[dc->rd], size);
1203         }
1204     } else {
1205         if (rev) {
1206             TCGv bs_data = tcg_temp_new();
1207             dec_byteswap(dc, bs_data, cpu_R[dc->rd], size);
1208             gen_store(dc, *addr, bs_data, size);
1209             tcg_temp_free(bs_data);
1210         } else {
1211             gen_store(dc, *addr, cpu_R[dc->rd], size);
1212         }
1213     }
1214
1215     /* Verify alignment if needed.  */
1216     if ((dc->env->pvr.regs[2] & PVR2_UNALIGNED_EXC_MASK) && size > 1) {
1217         tcg_gen_movi_tl(cpu_SR[SR_PC], dc->pc);
1218         /* FIXME: if the alignment is wrong, we should restore the value
1219          *        in memory. One possible way to achieve this is to probe
1220          *        the MMU prior to the memaccess, thay way we could put
1221          *        the alignment checks in between the probe and the mem
1222          *        access.
1223          */
1224         gen_helper_memalign(cpu_env, *addr, tcg_const_tl(dc->rd),
1225                             tcg_const_tl(1), tcg_const_tl(size - 1));
1226     }
1227
1228     if (ex) {
1229         gen_set_label(swx_skip);
1230     }
1231     tcg_temp_free(r_check);
1232     tcg_temp_free(swx_addr);
1233
1234     if (addr == &t)
1235         tcg_temp_free(t);
1236 }
1237
1238 static inline void eval_cc(DisasContext *dc, unsigned int cc,
1239                            TCGv d, TCGv a, TCGv b)
1240 {
1241     switch (cc) {
1242         case CC_EQ:
1243             tcg_gen_setcond_tl(TCG_COND_EQ, d, a, b);
1244             break;
1245         case CC_NE:
1246             tcg_gen_setcond_tl(TCG_COND_NE, d, a, b);
1247             break;
1248         case CC_LT:
1249             tcg_gen_setcond_tl(TCG_COND_LT, d, a, b);
1250             break;
1251         case CC_LE:
1252             tcg_gen_setcond_tl(TCG_COND_LE, d, a, b);
1253             break;
1254         case CC_GE:
1255             tcg_gen_setcond_tl(TCG_COND_GE, d, a, b);
1256             break;
1257         case CC_GT:
1258             tcg_gen_setcond_tl(TCG_COND_GT, d, a, b);
1259             break;
1260         default:
1261             cpu_abort(dc->env, "Unknown condition code %x.\n", cc);
1262             break;
1263     }
1264 }
1265
1266 static void eval_cond_jmp(DisasContext *dc, TCGv pc_true, TCGv pc_false)
1267 {
1268     int l1;
1269
1270     l1 = gen_new_label();
1271     /* Conditional jmp.  */
1272     tcg_gen_mov_tl(cpu_SR[SR_PC], pc_false);
1273     tcg_gen_brcondi_tl(TCG_COND_EQ, env_btaken, 0, l1);
1274     tcg_gen_mov_tl(cpu_SR[SR_PC], pc_true);
1275     gen_set_label(l1);
1276 }
1277
1278 static void dec_bcc(DisasContext *dc)
1279 {
1280     unsigned int cc;
1281     unsigned int dslot;
1282
1283     cc = EXTRACT_FIELD(dc->ir, 21, 23);
1284     dslot = dc->ir & (1 << 25);
1285     LOG_DIS("bcc%s r%d %x\n", dslot ? "d" : "", dc->ra, dc->imm);
1286
1287     dc->delayed_branch = 1;
1288     if (dslot) {
1289         dc->delayed_branch = 2;
1290         dc->tb_flags |= D_FLAG;
1291         tcg_gen_st_tl(tcg_const_tl(dc->type_b && (dc->tb_flags & IMM_FLAG)),
1292                       cpu_env, offsetof(CPUMBState, bimm));
1293     }
1294
1295     if (dec_alu_op_b_is_small_imm(dc)) {
1296         int32_t offset = (int32_t)((int16_t)dc->imm); /* sign-extend.  */
1297
1298         tcg_gen_movi_tl(env_btarget, dc->pc + offset);
1299         dc->jmp = JMP_DIRECT_CC;
1300         dc->jmp_pc = dc->pc + offset;
1301     } else {
1302         dc->jmp = JMP_INDIRECT;
1303         tcg_gen_movi_tl(env_btarget, dc->pc);
1304         tcg_gen_add_tl(env_btarget, env_btarget, *(dec_alu_op_b(dc)));
1305     }
1306     eval_cc(dc, cc, env_btaken, cpu_R[dc->ra], tcg_const_tl(0));
1307 }
1308
1309 static void dec_br(DisasContext *dc)
1310 {
1311     unsigned int dslot, link, abs, mbar;
1312     int mem_index = cpu_mmu_index(dc->env);
1313
1314     dslot = dc->ir & (1 << 20);
1315     abs = dc->ir & (1 << 19);
1316     link = dc->ir & (1 << 18);
1317
1318     /* Memory barrier.  */
1319     mbar = (dc->ir >> 16) & 31;
1320     if (mbar == 2 && dc->imm == 4) {
1321         /* mbar IMM & 16 decodes to sleep.  */
1322         if (dc->rd & 16) {
1323             TCGv_i32 tmp_hlt = tcg_const_i32(EXCP_HLT);
1324             TCGv_i32 tmp_1 = tcg_const_i32(1);
1325
1326             LOG_DIS("sleep\n");
1327
1328             t_sync_flags(dc);
1329             tcg_gen_st_i32(tmp_1, cpu_env,
1330                            -offsetof(MicroBlazeCPU, env)
1331                            +offsetof(CPUState, halted));
1332             tcg_gen_movi_tl(cpu_SR[SR_PC], dc->pc + 4);
1333             gen_helper_raise_exception(cpu_env, tmp_hlt);
1334             tcg_temp_free_i32(tmp_hlt);
1335             tcg_temp_free_i32(tmp_1);
1336             return;
1337         }
1338         LOG_DIS("mbar %d\n", dc->rd);
1339         /* Break the TB.  */
1340         dc->cpustate_changed = 1;
1341         return;
1342     }
1343
1344     LOG_DIS("br%s%s%s%s imm=%x\n",
1345              abs ? "a" : "", link ? "l" : "",
1346              dc->type_b ? "i" : "", dslot ? "d" : "",
1347              dc->imm);
1348
1349     dc->delayed_branch = 1;
1350     if (dslot) {
1351         dc->delayed_branch = 2;
1352         dc->tb_flags |= D_FLAG;
1353         tcg_gen_st_tl(tcg_const_tl(dc->type_b && (dc->tb_flags & IMM_FLAG)),
1354                       cpu_env, offsetof(CPUMBState, bimm));
1355     }
1356     if (link && dc->rd)
1357         tcg_gen_movi_tl(cpu_R[dc->rd], dc->pc);
1358
1359     dc->jmp = JMP_INDIRECT;
1360     if (abs) {
1361         tcg_gen_movi_tl(env_btaken, 1);
1362         tcg_gen_mov_tl(env_btarget, *(dec_alu_op_b(dc)));
1363         if (link && !dslot) {
1364             if (!(dc->tb_flags & IMM_FLAG) && (dc->imm == 8 || dc->imm == 0x18))
1365                 t_gen_raise_exception(dc, EXCP_BREAK);
1366             if (dc->imm == 0) {
1367                 if ((dc->tb_flags & MSR_EE_FLAG) && mem_index == MMU_USER_IDX) {
1368                     tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_PRIVINSN);
1369                     t_gen_raise_exception(dc, EXCP_HW_EXCP);
1370                     return;
1371                 }
1372
1373                 t_gen_raise_exception(dc, EXCP_DEBUG);
1374             }
1375         }
1376     } else {
1377         if (dec_alu_op_b_is_small_imm(dc)) {
1378             dc->jmp = JMP_DIRECT;
1379             dc->jmp_pc = dc->pc + (int32_t)((int16_t)dc->imm);
1380         } else {
1381             tcg_gen_movi_tl(env_btaken, 1);
1382             tcg_gen_movi_tl(env_btarget, dc->pc);
1383             tcg_gen_add_tl(env_btarget, env_btarget, *(dec_alu_op_b(dc)));
1384         }
1385     }
1386 }
1387
1388 static inline void do_rti(DisasContext *dc)
1389 {
1390     TCGv t0, t1;
1391     t0 = tcg_temp_new();
1392     t1 = tcg_temp_new();
1393     tcg_gen_shri_tl(t0, cpu_SR[SR_MSR], 1);
1394     tcg_gen_ori_tl(t1, cpu_SR[SR_MSR], MSR_IE);
1395     tcg_gen_andi_tl(t0, t0, (MSR_VM | MSR_UM));
1396
1397     tcg_gen_andi_tl(t1, t1, ~(MSR_VM | MSR_UM));
1398     tcg_gen_or_tl(t1, t1, t0);
1399     msr_write(dc, t1);
1400     tcg_temp_free(t1);
1401     tcg_temp_free(t0);
1402     dc->tb_flags &= ~DRTI_FLAG;
1403 }
1404
1405 static inline void do_rtb(DisasContext *dc)
1406 {
1407     TCGv t0, t1;
1408     t0 = tcg_temp_new();
1409     t1 = tcg_temp_new();
1410     tcg_gen_andi_tl(t1, cpu_SR[SR_MSR], ~MSR_BIP);
1411     tcg_gen_shri_tl(t0, t1, 1);
1412     tcg_gen_andi_tl(t0, t0, (MSR_VM | MSR_UM));
1413
1414     tcg_gen_andi_tl(t1, t1, ~(MSR_VM | MSR_UM));
1415     tcg_gen_or_tl(t1, t1, t0);
1416     msr_write(dc, t1);
1417     tcg_temp_free(t1);
1418     tcg_temp_free(t0);
1419     dc->tb_flags &= ~DRTB_FLAG;
1420 }
1421
1422 static inline void do_rte(DisasContext *dc)
1423 {
1424     TCGv t0, t1;
1425     t0 = tcg_temp_new();
1426     t1 = tcg_temp_new();
1427
1428     tcg_gen_ori_tl(t1, cpu_SR[SR_MSR], MSR_EE);
1429     tcg_gen_andi_tl(t1, t1, ~MSR_EIP);
1430     tcg_gen_shri_tl(t0, t1, 1);
1431     tcg_gen_andi_tl(t0, t0, (MSR_VM | MSR_UM));
1432
1433     tcg_gen_andi_tl(t1, t1, ~(MSR_VM | MSR_UM));
1434     tcg_gen_or_tl(t1, t1, t0);
1435     msr_write(dc, t1);
1436     tcg_temp_free(t1);
1437     tcg_temp_free(t0);
1438     dc->tb_flags &= ~DRTE_FLAG;
1439 }
1440
1441 static void dec_rts(DisasContext *dc)
1442 {
1443     unsigned int b_bit, i_bit, e_bit;
1444     int mem_index = cpu_mmu_index(dc->env);
1445
1446     i_bit = dc->ir & (1 << 21);
1447     b_bit = dc->ir & (1 << 22);
1448     e_bit = dc->ir & (1 << 23);
1449
1450     dc->delayed_branch = 2;
1451     dc->tb_flags |= D_FLAG;
1452     tcg_gen_st_tl(tcg_const_tl(dc->type_b && (dc->tb_flags & IMM_FLAG)),
1453                   cpu_env, offsetof(CPUMBState, bimm));
1454
1455     if (i_bit) {
1456         LOG_DIS("rtid ir=%x\n", dc->ir);
1457         if ((dc->tb_flags & MSR_EE_FLAG)
1458              && mem_index == MMU_USER_IDX) {
1459             tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_PRIVINSN);
1460             t_gen_raise_exception(dc, EXCP_HW_EXCP);
1461         }
1462         dc->tb_flags |= DRTI_FLAG;
1463     } else if (b_bit) {
1464         LOG_DIS("rtbd ir=%x\n", dc->ir);
1465         if ((dc->tb_flags & MSR_EE_FLAG)
1466              && mem_index == MMU_USER_IDX) {
1467             tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_PRIVINSN);
1468             t_gen_raise_exception(dc, EXCP_HW_EXCP);
1469         }
1470         dc->tb_flags |= DRTB_FLAG;
1471     } else if (e_bit) {
1472         LOG_DIS("rted ir=%x\n", dc->ir);
1473         if ((dc->tb_flags & MSR_EE_FLAG)
1474              && mem_index == MMU_USER_IDX) {
1475             tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_PRIVINSN);
1476             t_gen_raise_exception(dc, EXCP_HW_EXCP);
1477         }
1478         dc->tb_flags |= DRTE_FLAG;
1479     } else
1480         LOG_DIS("rts ir=%x\n", dc->ir);
1481
1482     dc->jmp = JMP_INDIRECT;
1483     tcg_gen_movi_tl(env_btaken, 1);
1484     tcg_gen_add_tl(env_btarget, cpu_R[dc->ra], *(dec_alu_op_b(dc)));
1485 }
1486
1487 static int dec_check_fpuv2(DisasContext *dc)
1488 {
1489     int r;
1490
1491     r = dc->env->pvr.regs[2] & PVR2_USE_FPU2_MASK;
1492
1493     if (!r && (dc->tb_flags & MSR_EE_FLAG)) {
1494         tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_FPU);
1495         t_gen_raise_exception(dc, EXCP_HW_EXCP);
1496     }
1497     return r;
1498 }
1499
1500 static void dec_fpu(DisasContext *dc)
1501 {
1502     unsigned int fpu_insn;
1503
1504     if ((dc->tb_flags & MSR_EE_FLAG)
1505           && (dc->env->pvr.regs[2] & PVR2_ILL_OPCODE_EXC_MASK)
1506           && !((dc->env->pvr.regs[2] & PVR2_USE_FPU_MASK))) {
1507         tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_ILLEGAL_OP);
1508         t_gen_raise_exception(dc, EXCP_HW_EXCP);
1509         return;
1510     }
1511
1512     fpu_insn = (dc->ir >> 7) & 7;
1513
1514     switch (fpu_insn) {
1515         case 0:
1516             gen_helper_fadd(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra],
1517                             cpu_R[dc->rb]);
1518             break;
1519
1520         case 1:
1521             gen_helper_frsub(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra],
1522                              cpu_R[dc->rb]);
1523             break;
1524
1525         case 2:
1526             gen_helper_fmul(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra],
1527                             cpu_R[dc->rb]);
1528             break;
1529
1530         case 3:
1531             gen_helper_fdiv(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra],
1532                             cpu_R[dc->rb]);
1533             break;
1534
1535         case 4:
1536             switch ((dc->ir >> 4) & 7) {
1537                 case 0:
1538                     gen_helper_fcmp_un(cpu_R[dc->rd], cpu_env,
1539                                        cpu_R[dc->ra], cpu_R[dc->rb]);
1540                     break;
1541                 case 1:
1542                     gen_helper_fcmp_lt(cpu_R[dc->rd], cpu_env,
1543                                        cpu_R[dc->ra], cpu_R[dc->rb]);
1544                     break;
1545                 case 2:
1546                     gen_helper_fcmp_eq(cpu_R[dc->rd], cpu_env,
1547                                        cpu_R[dc->ra], cpu_R[dc->rb]);
1548                     break;
1549                 case 3:
1550                     gen_helper_fcmp_le(cpu_R[dc->rd], cpu_env,
1551                                        cpu_R[dc->ra], cpu_R[dc->rb]);
1552                     break;
1553                 case 4:
1554                     gen_helper_fcmp_gt(cpu_R[dc->rd], cpu_env,
1555                                        cpu_R[dc->ra], cpu_R[dc->rb]);
1556                     break;
1557                 case 5:
1558                     gen_helper_fcmp_ne(cpu_R[dc->rd], cpu_env,
1559                                        cpu_R[dc->ra], cpu_R[dc->rb]);
1560                     break;
1561                 case 6:
1562                     gen_helper_fcmp_ge(cpu_R[dc->rd], cpu_env,
1563                                        cpu_R[dc->ra], cpu_R[dc->rb]);
1564                     break;
1565                 default:
1566                     qemu_log_mask(LOG_UNIMP,
1567                                   "unimplemented fcmp fpu_insn=%x pc=%x"
1568                                   " opc=%x\n",
1569                                   fpu_insn, dc->pc, dc->opcode);
1570                     dc->abort_at_next_insn = 1;
1571                     break;
1572             }
1573             break;
1574
1575         case 5:
1576             if (!dec_check_fpuv2(dc)) {
1577                 return;
1578             }
1579             gen_helper_flt(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra]);
1580             break;
1581
1582         case 6:
1583             if (!dec_check_fpuv2(dc)) {
1584                 return;
1585             }
1586             gen_helper_fint(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra]);
1587             break;
1588
1589         case 7:
1590             if (!dec_check_fpuv2(dc)) {
1591                 return;
1592             }
1593             gen_helper_fsqrt(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra]);
1594             break;
1595
1596         default:
1597             qemu_log_mask(LOG_UNIMP, "unimplemented FPU insn fpu_insn=%x pc=%x"
1598                           " opc=%x\n",
1599                           fpu_insn, dc->pc, dc->opcode);
1600             dc->abort_at_next_insn = 1;
1601             break;
1602     }
1603 }
1604
1605 static void dec_null(DisasContext *dc)
1606 {
1607     if ((dc->tb_flags & MSR_EE_FLAG)
1608           && (dc->env->pvr.regs[2] & PVR2_ILL_OPCODE_EXC_MASK)) {
1609         tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_ILLEGAL_OP);
1610         t_gen_raise_exception(dc, EXCP_HW_EXCP);
1611         return;
1612     }
1613     qemu_log ("unknown insn pc=%x opc=%x\n", dc->pc, dc->opcode);
1614     dc->abort_at_next_insn = 1;
1615 }
1616
1617 /* Insns connected to FSL or AXI stream attached devices.  */
1618 static void dec_stream(DisasContext *dc)
1619 {
1620     int mem_index = cpu_mmu_index(dc->env);
1621     TCGv_i32 t_id, t_ctrl;
1622     int ctrl;
1623
1624     LOG_DIS("%s%s imm=%x\n", dc->rd ? "get" : "put",
1625             dc->type_b ? "" : "d", dc->imm);
1626
1627     if ((dc->tb_flags & MSR_EE_FLAG) && (mem_index == MMU_USER_IDX)) {
1628         tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_PRIVINSN);
1629         t_gen_raise_exception(dc, EXCP_HW_EXCP);
1630         return;
1631     }
1632
1633     t_id = tcg_temp_new();
1634     if (dc->type_b) {
1635         tcg_gen_movi_tl(t_id, dc->imm & 0xf);
1636         ctrl = dc->imm >> 10;
1637     } else {
1638         tcg_gen_andi_tl(t_id, cpu_R[dc->rb], 0xf);
1639         ctrl = dc->imm >> 5;
1640     }
1641
1642     t_ctrl = tcg_const_tl(ctrl);
1643
1644     if (dc->rd == 0) {
1645         gen_helper_put(t_id, t_ctrl, cpu_R[dc->ra]);
1646     } else {
1647         gen_helper_get(cpu_R[dc->rd], t_id, t_ctrl);
1648     }
1649     tcg_temp_free(t_id);
1650     tcg_temp_free(t_ctrl);
1651 }
1652
1653 static struct decoder_info {
1654     struct {
1655         uint32_t bits;
1656         uint32_t mask;
1657     };
1658     void (*dec)(DisasContext *dc);
1659 } decinfo[] = {
1660     {DEC_ADD, dec_add},
1661     {DEC_SUB, dec_sub},
1662     {DEC_AND, dec_and},
1663     {DEC_XOR, dec_xor},
1664     {DEC_OR, dec_or},
1665     {DEC_BIT, dec_bit},
1666     {DEC_BARREL, dec_barrel},
1667     {DEC_LD, dec_load},
1668     {DEC_ST, dec_store},
1669     {DEC_IMM, dec_imm},
1670     {DEC_BR, dec_br},
1671     {DEC_BCC, dec_bcc},
1672     {DEC_RTS, dec_rts},
1673     {DEC_FPU, dec_fpu},
1674     {DEC_MUL, dec_mul},
1675     {DEC_DIV, dec_div},
1676     {DEC_MSR, dec_msr},
1677     {DEC_STREAM, dec_stream},
1678     {{0, 0}, dec_null}
1679 };
1680
1681 static inline void decode(DisasContext *dc, uint32_t ir)
1682 {
1683     int i;
1684
1685     if (unlikely(qemu_loglevel_mask(CPU_LOG_TB_OP | CPU_LOG_TB_OP_OPT))) {
1686         tcg_gen_debug_insn_start(dc->pc);
1687     }
1688
1689     dc->ir = ir;
1690     LOG_DIS("%8.8x\t", dc->ir);
1691
1692     if (dc->ir)
1693         dc->nr_nops = 0;
1694     else {
1695         if ((dc->tb_flags & MSR_EE_FLAG)
1696               && (dc->env->pvr.regs[2] & PVR2_ILL_OPCODE_EXC_MASK)
1697               && (dc->env->pvr.regs[2] & PVR2_OPCODE_0x0_ILL_MASK)) {
1698             tcg_gen_movi_tl(cpu_SR[SR_ESR], ESR_EC_ILLEGAL_OP);
1699             t_gen_raise_exception(dc, EXCP_HW_EXCP);
1700             return;
1701         }
1702
1703         LOG_DIS("nr_nops=%d\t", dc->nr_nops);
1704         dc->nr_nops++;
1705         if (dc->nr_nops > 4)
1706             cpu_abort(dc->env, "fetching nop sequence\n");
1707     }
1708     /* bit 2 seems to indicate insn type.  */
1709     dc->type_b = ir & (1 << 29);
1710
1711     dc->opcode = EXTRACT_FIELD(ir, 26, 31);
1712     dc->rd = EXTRACT_FIELD(ir, 21, 25);
1713     dc->ra = EXTRACT_FIELD(ir, 16, 20);
1714     dc->rb = EXTRACT_FIELD(ir, 11, 15);
1715     dc->imm = EXTRACT_FIELD(ir, 0, 15);
1716
1717     /* Large switch for all insns.  */
1718     for (i = 0; i < ARRAY_SIZE(decinfo); i++) {
1719         if ((dc->opcode & decinfo[i].mask) == decinfo[i].bits) {
1720             decinfo[i].dec(dc);
1721             break;
1722         }
1723     }
1724 }
1725
1726 static void check_breakpoint(CPUMBState *env, DisasContext *dc)
1727 {
1728     CPUBreakpoint *bp;
1729
1730     if (unlikely(!QTAILQ_EMPTY(&env->breakpoints))) {
1731         QTAILQ_FOREACH(bp, &env->breakpoints, entry) {
1732             if (bp->pc == dc->pc) {
1733                 t_gen_raise_exception(dc, EXCP_DEBUG);
1734                 dc->is_jmp = DISAS_UPDATE;
1735              }
1736         }
1737     }
1738 }
1739
1740 /* generate intermediate code for basic block 'tb'.  */
1741 static inline void
1742 gen_intermediate_code_internal(MicroBlazeCPU *cpu, TranslationBlock *tb,
1743                                bool search_pc)
1744 {
1745     CPUState *cs = CPU(cpu);
1746     CPUMBState *env = &cpu->env;
1747     uint16_t *gen_opc_end;
1748     uint32_t pc_start;
1749     int j, lj;
1750     struct DisasContext ctx;
1751     struct DisasContext *dc = &ctx;
1752     uint32_t next_page_start, org_flags;
1753     target_ulong npc;
1754     int num_insns;
1755     int max_insns;
1756
1757     pc_start = tb->pc;
1758     dc->env = env;
1759     dc->tb = tb;
1760     org_flags = dc->synced_flags = dc->tb_flags = tb->flags;
1761
1762     gen_opc_end = tcg_ctx.gen_opc_buf + OPC_MAX_SIZE;
1763
1764     dc->is_jmp = DISAS_NEXT;
1765     dc->jmp = 0;
1766     dc->delayed_branch = !!(dc->tb_flags & D_FLAG);
1767     if (dc->delayed_branch) {
1768         dc->jmp = JMP_INDIRECT;
1769     }
1770     dc->pc = pc_start;
1771     dc->singlestep_enabled = cs->singlestep_enabled;
1772     dc->cpustate_changed = 0;
1773     dc->abort_at_next_insn = 0;
1774     dc->nr_nops = 0;
1775
1776     if (pc_start & 3)
1777         cpu_abort(env, "Microblaze: unaligned PC=%x\n", pc_start);
1778
1779     if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM)) {
1780 #if !SIM_COMPAT
1781         qemu_log("--------------\n");
1782         log_cpu_state(CPU(cpu), 0);
1783 #endif
1784     }
1785
1786     next_page_start = (pc_start & TARGET_PAGE_MASK) + TARGET_PAGE_SIZE;
1787     lj = -1;
1788     num_insns = 0;
1789     max_insns = tb->cflags & CF_COUNT_MASK;
1790     if (max_insns == 0)
1791         max_insns = CF_COUNT_MASK;
1792
1793     gen_tb_start();
1794     do
1795     {
1796 #if SIM_COMPAT
1797         if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM)) {
1798             tcg_gen_movi_tl(cpu_SR[SR_PC], dc->pc);
1799             gen_helper_debug();
1800         }
1801 #endif
1802         check_breakpoint(env, dc);
1803
1804         if (search_pc) {
1805             j = tcg_ctx.gen_opc_ptr - tcg_ctx.gen_opc_buf;
1806             if (lj < j) {
1807                 lj++;
1808                 while (lj < j)
1809                     tcg_ctx.gen_opc_instr_start[lj++] = 0;
1810             }
1811             tcg_ctx.gen_opc_pc[lj] = dc->pc;
1812             tcg_ctx.gen_opc_instr_start[lj] = 1;
1813                         tcg_ctx.gen_opc_icount[lj] = num_insns;
1814         }
1815
1816         /* Pretty disas.  */
1817         LOG_DIS("%8.8x:\t", dc->pc);
1818
1819         if (num_insns + 1 == max_insns && (tb->cflags & CF_LAST_IO))
1820             gen_io_start();
1821
1822         dc->clear_imm = 1;
1823         decode(dc, cpu_ldl_code(env, dc->pc));
1824         if (dc->clear_imm)
1825             dc->tb_flags &= ~IMM_FLAG;
1826         dc->pc += 4;
1827         num_insns++;
1828
1829         if (dc->delayed_branch) {
1830             dc->delayed_branch--;
1831             if (!dc->delayed_branch) {
1832                 if (dc->tb_flags & DRTI_FLAG)
1833                     do_rti(dc);
1834                  if (dc->tb_flags & DRTB_FLAG)
1835                     do_rtb(dc);
1836                 if (dc->tb_flags & DRTE_FLAG)
1837                     do_rte(dc);
1838                 /* Clear the delay slot flag.  */
1839                 dc->tb_flags &= ~D_FLAG;
1840                 /* If it is a direct jump, try direct chaining.  */
1841                 if (dc->jmp == JMP_INDIRECT) {
1842                     eval_cond_jmp(dc, env_btarget, tcg_const_tl(dc->pc));
1843                     dc->is_jmp = DISAS_JUMP;
1844                 } else if (dc->jmp == JMP_DIRECT) {
1845                     t_sync_flags(dc);
1846                     gen_goto_tb(dc, 0, dc->jmp_pc);
1847                     dc->is_jmp = DISAS_TB_JUMP;
1848                 } else if (dc->jmp == JMP_DIRECT_CC) {
1849                     int l1;
1850
1851                     t_sync_flags(dc);
1852                     l1 = gen_new_label();
1853                     /* Conditional jmp.  */
1854                     tcg_gen_brcondi_tl(TCG_COND_NE, env_btaken, 0, l1);
1855                     gen_goto_tb(dc, 1, dc->pc);
1856                     gen_set_label(l1);
1857                     gen_goto_tb(dc, 0, dc->jmp_pc);
1858
1859                     dc->is_jmp = DISAS_TB_JUMP;
1860                 }
1861                 break;
1862             }
1863         }
1864         if (cs->singlestep_enabled) {
1865             break;
1866         }
1867     } while (!dc->is_jmp && !dc->cpustate_changed
1868          && tcg_ctx.gen_opc_ptr < gen_opc_end
1869                  && !singlestep
1870          && (dc->pc < next_page_start)
1871                  && num_insns < max_insns);
1872
1873     npc = dc->pc;
1874     if (dc->jmp == JMP_DIRECT || dc->jmp == JMP_DIRECT_CC) {
1875         if (dc->tb_flags & D_FLAG) {
1876             dc->is_jmp = DISAS_UPDATE;
1877             tcg_gen_movi_tl(cpu_SR[SR_PC], npc);
1878             sync_jmpstate(dc);
1879         } else
1880             npc = dc->jmp_pc;
1881     }
1882
1883     if (tb->cflags & CF_LAST_IO)
1884         gen_io_end();
1885     /* Force an update if the per-tb cpu state has changed.  */
1886     if (dc->is_jmp == DISAS_NEXT
1887         && (dc->cpustate_changed || org_flags != dc->tb_flags)) {
1888         dc->is_jmp = DISAS_UPDATE;
1889         tcg_gen_movi_tl(cpu_SR[SR_PC], npc);
1890     }
1891     t_sync_flags(dc);
1892
1893     if (unlikely(cs->singlestep_enabled)) {
1894         TCGv_i32 tmp = tcg_const_i32(EXCP_DEBUG);
1895
1896         if (dc->is_jmp != DISAS_JUMP) {
1897             tcg_gen_movi_tl(cpu_SR[SR_PC], npc);
1898         }
1899         gen_helper_raise_exception(cpu_env, tmp);
1900         tcg_temp_free_i32(tmp);
1901     } else {
1902         switch(dc->is_jmp) {
1903             case DISAS_NEXT:
1904                 gen_goto_tb(dc, 1, npc);
1905                 break;
1906             default:
1907             case DISAS_JUMP:
1908             case DISAS_UPDATE:
1909                 /* indicate that the hash table must be used
1910                    to find the next TB */
1911                 tcg_gen_exit_tb(0);
1912                 break;
1913             case DISAS_TB_JUMP:
1914                 /* nothing more to generate */
1915                 break;
1916         }
1917     }
1918     gen_tb_end(tb, num_insns);
1919     *tcg_ctx.gen_opc_ptr = INDEX_op_end;
1920     if (search_pc) {
1921         j = tcg_ctx.gen_opc_ptr - tcg_ctx.gen_opc_buf;
1922         lj++;
1923         while (lj <= j)
1924             tcg_ctx.gen_opc_instr_start[lj++] = 0;
1925     } else {
1926         tb->size = dc->pc - pc_start;
1927                 tb->icount = num_insns;
1928     }
1929
1930 #ifdef DEBUG_DISAS
1931 #if !SIM_COMPAT
1932     if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM)) {
1933         qemu_log("\n");
1934 #if DISAS_GNU
1935         log_target_disas(env, pc_start, dc->pc - pc_start, 0);
1936 #endif
1937         qemu_log("\nisize=%d osize=%td\n",
1938             dc->pc - pc_start, tcg_ctx.gen_opc_ptr -
1939             tcg_ctx.gen_opc_buf);
1940     }
1941 #endif
1942 #endif
1943     assert(!dc->abort_at_next_insn);
1944 }
1945
1946 void gen_intermediate_code (CPUMBState *env, struct TranslationBlock *tb)
1947 {
1948     gen_intermediate_code_internal(mb_env_get_cpu(env), tb, false);
1949 }
1950
1951 void gen_intermediate_code_pc (CPUMBState *env, struct TranslationBlock *tb)
1952 {
1953     gen_intermediate_code_internal(mb_env_get_cpu(env), tb, true);
1954 }
1955
1956 void mb_cpu_dump_state(CPUState *cs, FILE *f, fprintf_function cpu_fprintf,
1957                        int flags)
1958 {
1959     MicroBlazeCPU *cpu = MICROBLAZE_CPU(cs);
1960     CPUMBState *env = &cpu->env;
1961     int i;
1962
1963     if (!env || !f)
1964         return;
1965
1966     cpu_fprintf(f, "IN: PC=%x %s\n",
1967                 env->sregs[SR_PC], lookup_symbol(env->sregs[SR_PC]));
1968     cpu_fprintf(f, "rmsr=%x resr=%x rear=%x debug=%x imm=%x iflags=%x fsr=%x\n",
1969              env->sregs[SR_MSR], env->sregs[SR_ESR], env->sregs[SR_EAR],
1970              env->debug, env->imm, env->iflags, env->sregs[SR_FSR]);
1971     cpu_fprintf(f, "btaken=%d btarget=%x mode=%s(saved=%s) eip=%d ie=%d\n",
1972              env->btaken, env->btarget,
1973              (env->sregs[SR_MSR] & MSR_UM) ? "user" : "kernel",
1974              (env->sregs[SR_MSR] & MSR_UMS) ? "user" : "kernel",
1975              (env->sregs[SR_MSR] & MSR_EIP),
1976              (env->sregs[SR_MSR] & MSR_IE));
1977
1978     for (i = 0; i < 32; i++) {
1979         cpu_fprintf(f, "r%2.2d=%8.8x ", i, env->regs[i]);
1980         if ((i + 1) % 4 == 0)
1981             cpu_fprintf(f, "\n");
1982         }
1983     cpu_fprintf(f, "\n\n");
1984 }
1985
1986 MicroBlazeCPU *cpu_mb_init(const char *cpu_model)
1987 {
1988     MicroBlazeCPU *cpu;
1989
1990     cpu = MICROBLAZE_CPU(object_new(TYPE_MICROBLAZE_CPU));
1991
1992     object_property_set_bool(OBJECT(cpu), true, "realized", NULL);
1993
1994     return cpu;
1995 }
1996
1997 void mb_tcg_init(void)
1998 {
1999     int i;
2000
2001     cpu_env = tcg_global_reg_new_ptr(TCG_AREG0, "env");
2002
2003     env_debug = tcg_global_mem_new(TCG_AREG0,
2004                     offsetof(CPUMBState, debug),
2005                     "debug0");
2006     env_iflags = tcg_global_mem_new(TCG_AREG0,
2007                     offsetof(CPUMBState, iflags),
2008                     "iflags");
2009     env_imm = tcg_global_mem_new(TCG_AREG0,
2010                     offsetof(CPUMBState, imm),
2011                     "imm");
2012     env_btarget = tcg_global_mem_new(TCG_AREG0,
2013                      offsetof(CPUMBState, btarget),
2014                      "btarget");
2015     env_btaken = tcg_global_mem_new(TCG_AREG0,
2016                      offsetof(CPUMBState, btaken),
2017                      "btaken");
2018     for (i = 0; i < ARRAY_SIZE(cpu_R); i++) {
2019         cpu_R[i] = tcg_global_mem_new(TCG_AREG0,
2020                           offsetof(CPUMBState, regs[i]),
2021                           regnames[i]);
2022     }
2023     for (i = 0; i < ARRAY_SIZE(cpu_SR); i++) {
2024         cpu_SR[i] = tcg_global_mem_new(TCG_AREG0,
2025                           offsetof(CPUMBState, sregs[i]),
2026                           special_regnames[i]);
2027     }
2028 }
2029
2030 void restore_state_to_opc(CPUMBState *env, TranslationBlock *tb, int pc_pos)
2031 {
2032     env->sregs[SR_PC] = tcg_ctx.gen_opc_pc[pc_pos];
2033 }