/* * m68k translation * * Copyright (c) 2005-2007 CodeSourcery * Written by Paul Brook * * This library is free software; you can redistribute it and/or * modify it under the terms of the GNU Lesser General Public * License as published by the Free Software Foundation; either * version 2.1 of the License, or (at your option) any later version. * * This library is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * Lesser General Public License for more details. * * You should have received a copy of the GNU Lesser General Public * License along with this library; if not, see . */ #include "qemu/osdep.h" #include "cpu.h" #include "disas/disas.h" #include "exec/exec-all.h" #include "tcg/tcg-op.h" #include "qemu/log.h" #include "qemu/qemu-print.h" #include "exec/cpu_ldst.h" #include "exec/translator.h" #include "exec/helper-proto.h" #include "exec/helper-gen.h" #include "exec/log.h" #include "fpu/softfloat.h" //#define DEBUG_DISPATCH 1 #define DEFO32(name, offset) static TCGv QREG_##name; #define DEFO64(name, offset) static TCGv_i64 QREG_##name; #include "qregs.def" #undef DEFO32 #undef DEFO64 static TCGv_i32 cpu_halted; static TCGv_i32 cpu_exception_index; static char cpu_reg_names[2 * 8 * 3 + 5 * 4]; static TCGv cpu_dregs[8]; static TCGv cpu_aregs[8]; static TCGv_i64 cpu_macc[4]; #define REG(insn, pos) (((insn) >> (pos)) & 7) #define DREG(insn, pos) cpu_dregs[REG(insn, pos)] #define AREG(insn, pos) get_areg(s, REG(insn, pos)) #define MACREG(acc) cpu_macc[acc] #define QREG_SP get_areg(s, 7) static TCGv NULL_QREG; #define IS_NULL_QREG(t) (t == NULL_QREG) /* Used to distinguish stores from bad addressing modes. */ static TCGv store_dummy; #include "exec/gen-icount.h" void m68k_tcg_init(void) { char *p; int i; #define DEFO32(name, offset) \ QREG_##name = tcg_global_mem_new_i32(cpu_env, \ offsetof(CPUM68KState, offset), #name); #define DEFO64(name, offset) \ QREG_##name = tcg_global_mem_new_i64(cpu_env, \ offsetof(CPUM68KState, offset), #name); #include "qregs.def" #undef DEFO32 #undef DEFO64 cpu_halted = tcg_global_mem_new_i32(cpu_env, -offsetof(M68kCPU, env) + offsetof(CPUState, halted), "HALTED"); cpu_exception_index = tcg_global_mem_new_i32(cpu_env, -offsetof(M68kCPU, env) + offsetof(CPUState, exception_index), "EXCEPTION"); p = cpu_reg_names; for (i = 0; i < 8; i++) { sprintf(p, "D%d", i); cpu_dregs[i] = tcg_global_mem_new(cpu_env, offsetof(CPUM68KState, dregs[i]), p); p += 3; sprintf(p, "A%d", i); cpu_aregs[i] = tcg_global_mem_new(cpu_env, offsetof(CPUM68KState, aregs[i]), p); p += 3; } for (i = 0; i < 4; i++) { sprintf(p, "ACC%d", i); cpu_macc[i] = tcg_global_mem_new_i64(cpu_env, offsetof(CPUM68KState, macc[i]), p); p += 5; } NULL_QREG = tcg_global_mem_new(cpu_env, -4, "NULL"); store_dummy = tcg_global_mem_new(cpu_env, -8, "NULL"); } /* internal defines */ typedef struct DisasContext { DisasContextBase base; CPUM68KState *env; target_ulong pc; target_ulong pc_prev; CCOp cc_op; /* Current CC operation */ int cc_op_synced; TCGv_i64 mactmp; int done_mac; int writeback_mask; TCGv writeback[8]; #define MAX_TO_RELEASE 8 int release_count; TCGv release[MAX_TO_RELEASE]; bool ss_active; } DisasContext; static void init_release_array(DisasContext *s) { #ifdef CONFIG_DEBUG_TCG memset(s->release, 0, sizeof(s->release)); #endif s->release_count = 0; } static void do_release(DisasContext *s) { int i; for (i = 0; i < s->release_count; i++) { tcg_temp_free(s->release[i]); } init_release_array(s); } static TCGv mark_to_release(DisasContext *s, TCGv tmp) { g_assert(s->release_count < MAX_TO_RELEASE); return s->release[s->release_count++] = tmp; } static TCGv get_areg(DisasContext *s, unsigned regno) { if (s->writeback_mask & (1 << regno)) { return s->writeback[regno]; } else { return cpu_aregs[regno]; } } static void delay_set_areg(DisasContext *s, unsigned regno, TCGv val, bool give_temp) { if (s->writeback_mask & (1 << regno)) { if (give_temp) { tcg_temp_free(s->writeback[regno]); s->writeback[regno] = val; } else { tcg_gen_mov_i32(s->writeback[regno], val); } } else { s->writeback_mask |= 1 << regno; if (give_temp) { s->writeback[regno] = val; } else { TCGv tmp = tcg_temp_new(); s->writeback[regno] = tmp; tcg_gen_mov_i32(tmp, val); } } } static void do_writebacks(DisasContext *s) { unsigned mask = s->writeback_mask; if (mask) { s->writeback_mask = 0; do { unsigned regno = ctz32(mask); tcg_gen_mov_i32(cpu_aregs[regno], s->writeback[regno]); tcg_temp_free(s->writeback[regno]); mask &= mask - 1; } while (mask); } } /* is_jmp field values */ #define DISAS_JUMP DISAS_TARGET_0 /* only pc was modified dynamically */ #define DISAS_EXIT DISAS_TARGET_1 /* cpu state was modified dynamically */ #if defined(CONFIG_USER_ONLY) #define IS_USER(s) 1 #else #define IS_USER(s) (!(s->base.tb->flags & TB_FLAGS_MSR_S)) #define SFC_INDEX(s) ((s->base.tb->flags & TB_FLAGS_SFC_S) ? \ MMU_KERNEL_IDX : MMU_USER_IDX) #define DFC_INDEX(s) ((s->base.tb->flags & TB_FLAGS_DFC_S) ? \ MMU_KERNEL_IDX : MMU_USER_IDX) #endif typedef void (*disas_proc)(CPUM68KState *env, DisasContext *s, uint16_t insn); #ifdef DEBUG_DISPATCH #define DISAS_INSN(name) \ static void real_disas_##name(CPUM68KState *env, DisasContext *s, \ uint16_t insn); \ static void disas_##name(CPUM68KState *env, DisasContext *s, \ uint16_t insn) \ { \ qemu_log("Dispatch " #name "\n"); \ real_disas_##name(env, s, insn); \ } \ static void real_disas_##name(CPUM68KState *env, DisasContext *s, \ uint16_t insn) #else #define DISAS_INSN(name) \ static void disas_##name(CPUM68KState *env, DisasContext *s, \ uint16_t insn) #endif static const uint8_t cc_op_live[CC_OP_NB] = { [CC_OP_DYNAMIC] = CCF_C | CCF_V | CCF_Z | CCF_N | CCF_X, [CC_OP_FLAGS] = CCF_C | CCF_V | CCF_Z | CCF_N | CCF_X, [CC_OP_ADDB ... CC_OP_ADDL] = CCF_X | CCF_N | CCF_V, [CC_OP_SUBB ... CC_OP_SUBL] = CCF_X | CCF_N | CCF_V, [CC_OP_CMPB ... CC_OP_CMPL] = CCF_X | CCF_N | CCF_V, [CC_OP_LOGIC] = CCF_X | CCF_N }; static void set_cc_op(DisasContext *s, CCOp op) { CCOp old_op = s->cc_op; int dead; if (old_op == op) { return; } s->cc_op = op; s->cc_op_synced = 0; /* * Discard CC computation that will no longer be used. * Note that X and N are never dead. */ dead = cc_op_live[old_op] & ~cc_op_live[op]; if (dead & CCF_C) { tcg_gen_discard_i32(QREG_CC_C); } if (dead & CCF_Z) { tcg_gen_discard_i32(QREG_CC_Z); } if (dead & CCF_V) { tcg_gen_discard_i32(QREG_CC_V); } } /* Update the CPU env CC_OP state. */ static void update_cc_op(DisasContext *s) { if (!s->cc_op_synced) { s->cc_op_synced = 1; tcg_gen_movi_i32(QREG_CC_OP, s->cc_op); } } /* Generate a jump to an immediate address. */ static void gen_jmp_im(DisasContext *s, uint32_t dest) { update_cc_op(s); tcg_gen_movi_i32(QREG_PC, dest); s->base.is_jmp = DISAS_JUMP; } /* Generate a jump to the address in qreg DEST. */ static void gen_jmp(DisasContext *s, TCGv dest) { update_cc_op(s); tcg_gen_mov_i32(QREG_PC, dest); s->base.is_jmp = DISAS_JUMP; } static void gen_raise_exception(int nr) { TCGv_i32 tmp; tmp = tcg_const_i32(nr); gen_helper_raise_exception(cpu_env, tmp); tcg_temp_free_i32(tmp); } static void gen_raise_exception_format2(DisasContext *s, int nr, target_ulong this_pc) { /* * Pass the address of the insn to the exception handler, * for recording in the Format $2 (6-word) stack frame. * Re-use mmu.ar for the purpose, since that's only valid * after tlb_fill. */ tcg_gen_st_i32(tcg_constant_i32(this_pc), cpu_env, offsetof(CPUM68KState, mmu.ar)); gen_raise_exception(nr); s->base.is_jmp = DISAS_NORETURN; } static void gen_exception(DisasContext *s, uint32_t dest, int nr) { update_cc_op(s); tcg_gen_movi_i32(QREG_PC, dest); gen_raise_exception(nr); s->base.is_jmp = DISAS_NORETURN; } static inline void gen_addr_fault(DisasContext *s) { gen_exception(s, s->base.pc_next, EXCP_ADDRESS); } /* * Generate a load from the specified address. Narrow values are * sign extended to full register width. */ static inline TCGv gen_load(DisasContext *s, int opsize, TCGv addr, int sign, int index) { TCGv tmp; tmp = tcg_temp_new_i32(); switch(opsize) { case OS_BYTE: if (sign) tcg_gen_qemu_ld8s(tmp, addr, index); else tcg_gen_qemu_ld8u(tmp, addr, index); break; case OS_WORD: if (sign) tcg_gen_qemu_ld16s(tmp, addr, index); else tcg_gen_qemu_ld16u(tmp, addr, index); break; case OS_LONG: tcg_gen_qemu_ld32u(tmp, addr, index); break; default: g_assert_not_reached(); } return tmp; } /* Generate a store. */ static inline void gen_store(DisasContext *s, int opsize, TCGv addr, TCGv val, int index) { switch(opsize) { case OS_BYTE: tcg_gen_qemu_st8(val, addr, index); break; case OS_WORD: tcg_gen_qemu_st16(val, addr, index); break; case OS_LONG: tcg_gen_qemu_st32(val, addr, index); break; default: g_assert_not_reached(); } } typedef enum { EA_STORE, EA_LOADU, EA_LOADS } ea_what; /* * Generate an unsigned load if VAL is 0 a signed load if val is -1, * otherwise generate a store. */ static TCGv gen_ldst(DisasContext *s, int opsize, TCGv addr, TCGv val, ea_what what, int index) { if (what == EA_STORE) { gen_store(s, opsize, addr, val, index); return store_dummy; } else { return mark_to_release(s, gen_load(s, opsize, addr, what == EA_LOADS, index)); } } /* Read a 16-bit immediate constant */ static inline uint16_t read_im16(CPUM68KState *env, DisasContext *s) { uint16_t im; im = translator_lduw(env, &s->base, s->pc); s->pc += 2; return im; } /* Read an 8-bit immediate constant */ static inline uint8_t read_im8(CPUM68KState *env, DisasContext *s) { return read_im16(env, s); } /* Read a 32-bit immediate constant. */ static inline uint32_t read_im32(CPUM68KState *env, DisasContext *s) { uint32_t im; im = read_im16(env, s) << 16; im |= 0xffff & read_im16(env, s); return im; } /* Read a 64-bit immediate constant. */ static inline uint64_t read_im64(CPUM68KState *env, DisasContext *s) { uint64_t im; im = (uint64_t)read_im32(env, s) << 32; im |= (uint64_t)read_im32(env, s); return im; } /* Calculate and address index. */ static TCGv gen_addr_index(DisasContext *s, uint16_t ext, TCGv tmp) { TCGv add; int scale; add = (ext & 0x8000) ? AREG(ext, 12) : DREG(ext, 12); if ((ext & 0x800) == 0) { tcg_gen_ext16s_i32(tmp, add); add = tmp; } scale = (ext >> 9) & 3; if (scale != 0) { tcg_gen_shli_i32(tmp, add, scale); add = tmp; } return add; } /* * Handle a base + index + displacement effective address. * A NULL_QREG base means pc-relative. */ static TCGv gen_lea_indexed(CPUM68KState *env, DisasContext *s, TCGv base) { uint32_t offset; uint16_t ext; TCGv add; TCGv tmp; uint32_t bd, od; offset = s->pc; ext = read_im16(env, s); if ((ext & 0x800) == 0 && !m68k_feature(s->env, M68K_FEATURE_WORD_INDEX)) return NULL_QREG; if (m68k_feature(s->env, M68K_FEATURE_M68K) && !m68k_feature(s->env, M68K_FEATURE_SCALED_INDEX)) { ext &= ~(3 << 9); } if (ext & 0x100) { /* full extension word format */ if (!m68k_feature(s->env, M68K_FEATURE_EXT_FULL)) return NULL_QREG; if ((ext & 0x30) > 0x10) { /* base displacement */ if ((ext & 0x30) == 0x20) { bd = (int16_t)read_im16(env, s); } else { bd = read_im32(env, s); } } else { bd = 0; } tmp = mark_to_release(s, tcg_temp_new()); if ((ext & 0x44) == 0) { /* pre-index */ add = gen_addr_index(s, ext, tmp); } else { add = NULL_QREG; } if ((ext & 0x80) == 0) { /* base not suppressed */ if (IS_NULL_QREG(base)) { base = mark_to_release(s, tcg_const_i32(offset + bd)); bd = 0; } if (!IS_NULL_QREG(add)) { tcg_gen_add_i32(tmp, add, base); add = tmp; } else { add = base; } } if (!IS_NULL_QREG(add)) { if (bd != 0) { tcg_gen_addi_i32(tmp, add, bd); add = tmp; } } else { add = mark_to_release(s, tcg_const_i32(bd)); } if ((ext & 3) != 0) { /* memory indirect */ base = mark_to_release(s, gen_load(s, OS_LONG, add, 0, IS_USER(s))); if ((ext & 0x44) == 4) { add = gen_addr_index(s, ext, tmp); tcg_gen_add_i32(tmp, add, base); add = tmp; } else { add = base; } if ((ext & 3) > 1) { /* outer displacement */ if ((ext & 3) == 2) { od = (int16_t)read_im16(env, s); } else { od = read_im32(env, s); } } else { od = 0; } if (od != 0) { tcg_gen_addi_i32(tmp, add, od); add = tmp; } } } else { /* brief extension word format */ tmp = mark_to_release(s, tcg_temp_new()); add = gen_addr_index(s, ext, tmp); if (!IS_NULL_QREG(base)) { tcg_gen_add_i32(tmp, add, base); if ((int8_t)ext) tcg_gen_addi_i32(tmp, tmp, (int8_t)ext); } else { tcg_gen_addi_i32(tmp, add, offset + (int8_t)ext); } add = tmp; } return add; } /* Sign or zero extend a value. */ static inline void gen_ext(TCGv res, TCGv val, int opsize, int sign) { switch (opsize) { case OS_BYTE: if (sign) { tcg_gen_ext8s_i32(res, val); } else { tcg_gen_ext8u_i32(res, val); } break; case OS_WORD: if (sign) { tcg_gen_ext16s_i32(res, val); } else { tcg_gen_ext16u_i32(res, val); } break; case OS_LONG: tcg_gen_mov_i32(res, val); break; default: g_assert_not_reached(); } } /* Evaluate all the CC flags. */ static void gen_flush_flags(DisasContext *s) { TCGv t0, t1; switch (s->cc_op) { case CC_OP_FLAGS: return; case CC_OP_ADDB: case CC_OP_ADDW: case CC_OP_ADDL: tcg_gen_mov_i32(QREG_CC_C, QREG_CC_X); tcg_gen_mov_i32(QREG_CC_Z, QREG_CC_N); /* Compute signed overflow for addition. */ t0 = tcg_temp_new(); t1 = tcg_temp_new(); tcg_gen_sub_i32(t0, QREG_CC_N, QREG_CC_V); gen_ext(t0, t0, s->cc_op - CC_OP_ADDB, 1); tcg_gen_xor_i32(t1, QREG_CC_N, QREG_CC_V); tcg_gen_xor_i32(QREG_CC_V, QREG_CC_V, t0); tcg_temp_free(t0); tcg_gen_andc_i32(QREG_CC_V, t1, QREG_CC_V); tcg_temp_free(t1); break; case CC_OP_SUBB: case CC_OP_SUBW: case CC_OP_SUBL: tcg_gen_mov_i32(QREG_CC_C, QREG_CC_X); tcg_gen_mov_i32(QREG_CC_Z, QREG_CC_N); /* Compute signed overflow for subtraction. */ t0 = tcg_temp_new(); t1 = tcg_temp_new(); tcg_gen_add_i32(t0, QREG_CC_N, QREG_CC_V); gen_ext(t0, t0, s->cc_op - CC_OP_SUBB, 1); tcg_gen_xor_i32(t1, QREG_CC_N, t0); tcg_gen_xor_i32(QREG_CC_V, QREG_CC_V, t0); tcg_temp_free(t0); tcg_gen_and_i32(QREG_CC_V, QREG_CC_V, t1); tcg_temp_free(t1); break; case CC_OP_CMPB: case CC_OP_CMPW: case CC_OP_CMPL: tcg_gen_setcond_i32(TCG_COND_LTU, QREG_CC_C, QREG_CC_N, QREG_CC_V); tcg_gen_sub_i32(QREG_CC_Z, QREG_CC_N, QREG_CC_V); gen_ext(QREG_CC_Z, QREG_CC_Z, s->cc_op - CC_OP_CMPB, 1); /* Compute signed overflow for subtraction. */ t0 = tcg_temp_new(); tcg_gen_xor_i32(t0, QREG_CC_Z, QREG_CC_N); tcg_gen_xor_i32(QREG_CC_V, QREG_CC_V, QREG_CC_N); tcg_gen_and_i32(QREG_CC_V, QREG_CC_V, t0); tcg_temp_free(t0); tcg_gen_mov_i32(QREG_CC_N, QREG_CC_Z); break; case CC_OP_LOGIC: tcg_gen_mov_i32(QREG_CC_Z, QREG_CC_N); tcg_gen_movi_i32(QREG_CC_C, 0); tcg_gen_movi_i32(QREG_CC_V, 0); break; case CC_OP_DYNAMIC: gen_helper_flush_flags(cpu_env, QREG_CC_OP); s->cc_op_synced = 1; break; default: t0 = tcg_const_i32(s->cc_op); gen_helper_flush_flags(cpu_env, t0); tcg_temp_free(t0); s->cc_op_synced = 1; break; } /* Note that flush_flags also assigned to env->cc_op. */ s->cc_op = CC_OP_FLAGS; } static inline TCGv gen_extend(DisasContext *s, TCGv val, int opsize, int sign) { TCGv tmp; if (opsize == OS_LONG) { tmp = val; } else { tmp = mark_to_release(s, tcg_temp_new()); gen_ext(tmp, val, opsize, sign); } return tmp; } static void gen_logic_cc(DisasContext *s, TCGv val, int opsize) { gen_ext(QREG_CC_N, val, opsize, 1); set_cc_op(s, CC_OP_LOGIC); } static void gen_update_cc_cmp(DisasContext *s, TCGv dest, TCGv src, int opsize) { tcg_gen_mov_i32(QREG_CC_N, dest); tcg_gen_mov_i32(QREG_CC_V, src); set_cc_op(s, CC_OP_CMPB + opsize); } static void gen_update_cc_add(TCGv dest, TCGv src, int opsize) { gen_ext(QREG_CC_N, dest, opsize, 1); tcg_gen_mov_i32(QREG_CC_V, src); } static inline int opsize_bytes(int opsize) { switch (opsize) { case OS_BYTE: return 1; case OS_WORD: return 2; case OS_LONG: return 4; case OS_SINGLE: return 4; case OS_DOUBLE: return 8; case OS_EXTENDED: return 12; case OS_PACKED: return 12; default: g_assert_not_reached(); } } static inline int insn_opsize(int insn) { switch ((insn >> 6) & 3) { case 0: return OS_BYTE; case 1: return OS_WORD; case 2: return OS_LONG; default: g_assert_not_reached(); } } static inline int ext_opsize(int ext, int pos) { switch ((ext >> pos) & 7) { case 0: return OS_LONG; case 1: return OS_SINGLE; case 2: return OS_EXTENDED; case 3: return OS_PACKED; case 4: return OS_WORD; case 5: return OS_DOUBLE; case 6: return OS_BYTE; default: g_assert_not_reached(); } } /* * Assign value to a register. If the width is less than the register width * only the low part of the register is set. */ static void gen_partset_reg(int opsize, TCGv reg, TCGv val) { TCGv tmp; switch (opsize) { case OS_BYTE: tcg_gen_andi_i32(reg, reg, 0xffffff00); tmp = tcg_temp_new(); tcg_gen_ext8u_i32(tmp, val); tcg_gen_or_i32(reg, reg, tmp); tcg_temp_free(tmp); break; case OS_WORD: tcg_gen_andi_i32(reg, reg, 0xffff0000); tmp = tcg_temp_new(); tcg_gen_ext16u_i32(tmp, val); tcg_gen_or_i32(reg, reg, tmp); tcg_temp_free(tmp); break; case OS_LONG: case OS_SINGLE: tcg_gen_mov_i32(reg, val); break; default: g_assert_not_reached(); } } /* * Generate code for an "effective address". Does not adjust the base * register for autoincrement addressing modes. */ static TCGv gen_lea_mode(CPUM68KState *env, DisasContext *s, int mode, int reg0, int opsize) { TCGv reg; TCGv tmp; uint16_t ext; uint32_t offset; switch (mode) { case 0: /* Data register direct. */ case 1: /* Address register direct. */ return NULL_QREG; case 3: /* Indirect postincrement. */ if (opsize == OS_UNSIZED) { return NULL_QREG; } /* fallthru */ case 2: /* Indirect register */ return get_areg(s, reg0); case 4: /* Indirect predecrememnt. */ if (opsize == OS_UNSIZED) { return NULL_QREG; } reg = get_areg(s, reg0); tmp = mark_to_release(s, tcg_temp_new()); if (reg0 == 7 && opsize == OS_BYTE && m68k_feature(s->env, M68K_FEATURE_M68K)) { tcg_gen_subi_i32(tmp, reg, 2); } else { tcg_gen_subi_i32(tmp, reg, opsize_bytes(opsize)); } return tmp; case 5: /* Indirect displacement. */ reg = get_areg(s, reg0); tmp = mark_to_release(s, tcg_temp_new()); ext = read_im16(env, s); tcg_gen_addi_i32(tmp, reg, (int16_t)ext); return tmp; case 6: /* Indirect index + displacement. */ reg = get_areg(s, reg0); return gen_lea_indexed(env, s, reg); case 7: /* Other */ switch (reg0) { case 0: /* Absolute short. */ offset = (int16_t)read_im16(env, s); return mark_to_release(s, tcg_const_i32(offset)); case 1: /* Absolute long. */ offset = read_im32(env, s); return mark_to_release(s, tcg_const_i32(offset)); case 2: /* pc displacement */ offset = s->pc; offset += (int16_t)read_im16(env, s); return mark_to_release(s, tcg_const_i32(offset)); case 3: /* pc index+displacement. */ return gen_lea_indexed(env, s, NULL_QREG); case 4: /* Immediate. */ default: return NULL_QREG; } } /* Should never happen. */ return NULL_QREG; } static TCGv gen_lea(CPUM68KState *env, DisasContext *s, uint16_t insn, int opsize) { int mode = extract32(insn, 3, 3); int reg0 = REG(insn, 0); return gen_lea_mode(env, s, mode, reg0, opsize); } /* * Generate code to load/store a value from/into an EA. If WHAT > 0 this is * a write otherwise it is a read (0 == sign extend, -1 == zero extend). * ADDRP is non-null for readwrite operands. */ static TCGv gen_ea_mode(CPUM68KState *env, DisasContext *s, int mode, int reg0, int opsize, TCGv val, TCGv *addrp, ea_what what, int index) { TCGv reg, tmp, result; int32_t offset; switch (mode) { case 0: /* Data register direct. */ reg = cpu_dregs[reg0]; if (what == EA_STORE) { gen_partset_reg(opsize, reg, val); return store_dummy; } else { return gen_extend(s, reg, opsize, what == EA_LOADS); } case 1: /* Address register direct. */ reg = get_areg(s, reg0); if (what == EA_STORE) { tcg_gen_mov_i32(reg, val); return store_dummy; } else { return gen_extend(s, reg, opsize, what == EA_LOADS); } case 2: /* Indirect register */ reg = get_areg(s, reg0); return gen_ldst(s, opsize, reg, val, what, index); case 3: /* Indirect postincrement. */ reg = get_areg(s, reg0); result = gen_ldst(s, opsize, reg, val, what, index); if (what == EA_STORE || !addrp) { TCGv tmp = tcg_temp_new(); if (reg0 == 7 && opsize == OS_BYTE && m68k_feature(s->env, M68K_FEATURE_M68K)) { tcg_gen_addi_i32(tmp, reg, 2); } else { tcg_gen_addi_i32(tmp, reg, opsize_bytes(opsize)); } delay_set_areg(s, reg0, tmp, true); } return result; case 4: /* Indirect predecrememnt. */ if (addrp && what == EA_STORE) { tmp = *addrp; } else { tmp = gen_lea_mode(env, s, mode, reg0, opsize); if (IS_NULL_QREG(tmp)) { return tmp; } if (addrp) { *addrp = tmp; } } result = gen_ldst(s, opsize, tmp, val, what, index); if (what == EA_STORE || !addrp) { delay_set_areg(s, reg0, tmp, false); } return result; case 5: /* Indirect displacement. */ case 6: /* Indirect index + displacement. */ do_indirect: if (addrp && what == EA_STORE) { tmp = *addrp; } else { tmp = gen_lea_mode(env, s, mode, reg0, opsize); if (IS_NULL_QREG(tmp)) { return tmp; } if (addrp) { *addrp = tmp; } } return gen_ldst(s, opsize, tmp, val, what, index); case 7: /* Other */ switch (reg0) { case 0: /* Absolute short. */ case 1: /* Absolute long. */ case 2: /* pc displacement */ case 3: /* pc index+displacement. */ goto do_indirect; case 4: /* Immediate. */ /* Sign extend values for consistency. */ switch (opsize) { case OS_BYTE: if (what == EA_LOADS) { offset = (int8_t)read_im8(env, s); } else { offset = read_im8(env, s); } break; case OS_WORD: if (what == EA_LOADS) { offset = (int16_t)read_im16(env, s); } else { offset = read_im16(env, s); } break; case OS_LONG: offset = read_im32(env, s); break; default: g_assert_not_reached(); } return mark_to_release(s, tcg_const_i32(offset)); default: return NULL_QREG; } } /* Should never happen. */ return NULL_QREG; } static TCGv gen_ea(CPUM68KState *env, DisasContext *s, uint16_t insn, int opsize, TCGv val, TCGv *addrp, ea_what what, int index) { int mode = extract32(insn, 3, 3); int reg0 = REG(insn, 0); return gen_ea_mode(env, s, mode, reg0, opsize, val, addrp, what, index); } static TCGv_ptr gen_fp_ptr(int freg) { TCGv_ptr fp = tcg_temp_new_ptr(); tcg_gen_addi_ptr(fp, cpu_env, offsetof(CPUM68KState, fregs[freg])); return fp; } static TCGv_ptr gen_fp_result_ptr(void) { TCGv_ptr fp = tcg_temp_new_ptr(); tcg_gen_addi_ptr(fp, cpu_env, offsetof(CPUM68KState, fp_result)); return fp; } static void gen_fp_move(TCGv_ptr dest, TCGv_ptr src) { TCGv t32; TCGv_i64 t64; t32 = tcg_temp_new(); tcg_gen_ld16u_i32(t32, src, offsetof(FPReg, l.upper)); tcg_gen_st16_i32(t32, dest, offsetof(FPReg, l.upper)); tcg_temp_free(t32); t64 = tcg_temp_new_i64(); tcg_gen_ld_i64(t64, src, offsetof(FPReg, l.lower)); tcg_gen_st_i64(t64, dest, offsetof(FPReg, l.lower)); tcg_temp_free_i64(t64); } static void gen_load_fp(DisasContext *s, int opsize, TCGv addr, TCGv_ptr fp, int index) { TCGv tmp; TCGv_i64 t64; t64 = tcg_temp_new_i64(); tmp = tcg_temp_new(); switch (opsize) { case OS_BYTE: tcg_gen_qemu_ld8s(tmp, addr, index); gen_helper_exts32(cpu_env, fp, tmp); break; case OS_WORD: tcg_gen_qemu_ld16s(tmp, addr, index); gen_helper_exts32(cpu_env, fp, tmp); break; case OS_LONG: tcg_gen_qemu_ld32u(tmp, addr, index); gen_helper_exts32(cpu_env, fp, tmp); break; case OS_SINGLE: tcg_gen_qemu_ld32u(tmp, addr, index); gen_helper_extf32(cpu_env, fp, tmp); break; case OS_DOUBLE: tcg_gen_qemu_ld64(t64, addr, index); gen_helper_extf64(cpu_env, fp, t64); break; case OS_EXTENDED: if (m68k_feature(s->env, M68K_FEATURE_CF_FPU)) { gen_exception(s, s->base.pc_next, EXCP_FP_UNIMP); break; } tcg_gen_qemu_ld32u(tmp, addr, index); tcg_gen_shri_i32(tmp, tmp, 16); tcg_gen_st16_i32(tmp, fp, offsetof(FPReg, l.upper)); tcg_gen_addi_i32(tmp, addr, 4); tcg_gen_qemu_ld64(t64, tmp, index); tcg_gen_st_i64(t64, fp, offsetof(FPReg, l.lower)); break; case OS_PACKED: /* * unimplemented data type on 68040/ColdFire * FIXME if needed for another FPU */ gen_exception(s, s->base.pc_next, EXCP_FP_UNIMP); break; default: g_assert_not_reached(); } tcg_temp_free(tmp); tcg_temp_free_i64(t64); } static void gen_store_fp(DisasContext *s, int opsize, TCGv addr, TCGv_ptr fp, int index) { TCGv tmp; TCGv_i64 t64; t64 = tcg_temp_new_i64(); tmp = tcg_temp_new(); switch (opsize) { case OS_BYTE: gen_helper_reds32(tmp, cpu_env, fp); tcg_gen_qemu_st8(tmp, addr, index); break; case OS_WORD: gen_helper_reds32(tmp, cpu_env, fp); tcg_gen_qemu_st16(tmp, addr, index); break; case OS_LONG: gen_helper_reds32(tmp, cpu_env, fp); tcg_gen_qemu_st32(tmp, addr, index); break; case OS_SINGLE: gen_helper_redf32(tmp, cpu_env, fp); tcg_gen_qemu_st32(tmp, addr, index); break; case OS_DOUBLE: gen_helper_redf64(t64, cpu_env, fp); tcg_gen_qemu_st64(t64, addr, index); break; case OS_EXTENDED: if (m68k_feature(s->env, M68K_FEATURE_CF_FPU)) { gen_exception(s, s->base.pc_next, EXCP_FP_UNIMP); break; } tcg_gen_ld16u_i32(tmp, fp, offsetof(FPReg, l.upper)); tcg_gen_shli_i32(tmp, tmp, 16); tcg_gen_qemu_st32(tmp, addr, index); tcg_gen_addi_i32(tmp, addr, 4); tcg_gen_ld_i64(t64, fp, offsetof(FPReg, l.lower)); tcg_gen_qemu_st64(t64, tmp, index); break; case OS_PACKED: /* * unimplemented data type on 68040/ColdFire * FIXME if needed for another FPU */ gen_exception(s, s->base.pc_next, EXCP_FP_UNIMP); break; default: g_assert_not_reached(); } tcg_temp_free(tmp); tcg_temp_free_i64(t64); } static void gen_ldst_fp(DisasContext *s, int opsize, TCGv addr, TCGv_ptr fp, ea_what what, int index) { if (what == EA_STORE) { gen_store_fp(s, opsize, addr, fp, index); } else { gen_load_fp(s, opsize, addr, fp, index); } } static int gen_ea_mode_fp(CPUM68KState *env, DisasContext *s, int mode, int reg0, int opsize, TCGv_ptr fp, ea_what what, int index) { TCGv reg, addr, tmp; TCGv_i64 t64; switch (mode) { case 0: /* Data register direct. */ reg = cpu_dregs[reg0]; if (what == EA_STORE) { switch (opsize) { case OS_BYTE: case OS_WORD: case OS_LONG: gen_helper_reds32(reg, cpu_env, fp); break; case OS_SINGLE: gen_helper_redf32(reg, cpu_env, fp); break; default: g_assert_not_reached(); } } else { tmp = tcg_temp_new(); switch (opsize) { case OS_BYTE: tcg_gen_ext8s_i32(tmp, reg); gen_helper_exts32(cpu_env, fp, tmp); break; case OS_WORD: tcg_gen_ext16s_i32(tmp, reg); gen_helper_exts32(cpu_env, fp, tmp); break; case OS_LONG: gen_helper_exts32(cpu_env, fp, reg); break; case OS_SINGLE: gen_helper_extf32(cpu_env, fp, reg); break; default: g_assert_not_reached(); } tcg_temp_free(tmp); } return 0; case 1: /* Address register direct. */ return -1; case 2: /* Indirect register */ addr = get_areg(s, reg0); gen_ldst_fp(s, opsize, addr, fp, what, index); return 0; case 3: /* Indirect postincrement. */ addr = cpu_aregs[reg0]; gen_ldst_fp(s, opsize, addr, fp, what, index); tcg_gen_addi_i32(addr, addr, opsize_bytes(opsize)); return 0; case 4: /* Indirect predecrememnt. */ addr = gen_lea_mode(env, s, mode, reg0, opsize); if (IS_NULL_QREG(addr)) { return -1; } gen_ldst_fp(s, opsize, addr, fp, what, index); tcg_gen_mov_i32(cpu_aregs[reg0], addr); return 0; case 5: /* Indirect displacement. */ case 6: /* Indirect index + displacement. */ do_indirect: addr = gen_lea_mode(env, s, mode, reg0, opsize); if (IS_NULL_QREG(addr)) { return -1; } gen_ldst_fp(s, opsize, addr, fp, what, index); return 0; case 7: /* Other */ switch (reg0) { case 0: /* Absolute short. */ case 1: /* Absolute long. */ case 2: /* pc displacement */ case 3: /* pc index+displacement. */ goto do_indirect; case 4: /* Immediate. */ if (what == EA_STORE) { return -1; } switch (opsize) { case OS_BYTE: tmp = tcg_const_i32((int8_t)read_im8(env, s)); gen_helper_exts32(cpu_env, fp, tmp); tcg_temp_free(tmp); break; case OS_WORD: tmp = tcg_const_i32((int16_t)read_im16(env, s)); gen_helper_exts32(cpu_env, fp, tmp); tcg_temp_free(tmp); break; case OS_LONG: tmp = tcg_const_i32(read_im32(env, s)); gen_helper_exts32(cpu_env, fp, tmp); tcg_temp_free(tmp); break; case OS_SINGLE: tmp = tcg_const_i32(read_im32(env, s)); gen_helper_extf32(cpu_env, fp, tmp); tcg_temp_free(tmp); break; case OS_DOUBLE: t64 = tcg_const_i64(read_im64(env, s)); gen_helper_extf64(cpu_env, fp, t64); tcg_temp_free_i64(t64); break; case OS_EXTENDED: if (m68k_feature(s->env, M68K_FEATURE_CF_FPU)) { gen_exception(s, s->base.pc_next, EXCP_FP_UNIMP); break; } tmp = tcg_const_i32(read_im32(env, s) >> 16); tcg_gen_st16_i32(tmp, fp, offsetof(FPReg, l.upper)); tcg_temp_free(tmp); t64 = tcg_const_i64(read_im64(env, s)); tcg_gen_st_i64(t64, fp, offsetof(FPReg, l.lower)); tcg_temp_free_i64(t64); break; case OS_PACKED: /* * unimplemented data type on 68040/ColdFire * FIXME if needed for another FPU */ gen_exception(s, s->base.pc_next, EXCP_FP_UNIMP); break; default: g_assert_not_reached(); } return 0; default: return -1; } } return -1; } static int gen_ea_fp(CPUM68KState *env, DisasContext *s, uint16_t insn, int opsize, TCGv_ptr fp, ea_what what, int index) { int mode = extract32(insn, 3, 3); int reg0 = REG(insn, 0); return gen_ea_mode_fp(env, s, mode, reg0, opsize, fp, what, index); } typedef struct { TCGCond tcond; bool g1; bool g2; TCGv v1; TCGv v2; } DisasCompare; static void gen_cc_cond(DisasCompare *c, DisasContext *s, int cond) { TCGv tmp, tmp2; TCGCond tcond; CCOp op = s->cc_op; /* The CC_OP_CMP form can handle most normal comparisons directly. */ if (op == CC_OP_CMPB || op == CC_OP_CMPW || op == CC_OP_CMPL) { c->g1 = c->g2 = 1; c->v1 = QREG_CC_N; c->v2 = QREG_CC_V; switch (cond) { case 2: /* HI */ case 3: /* LS */ tcond = TCG_COND_LEU; goto done; case 4: /* CC */ case 5: /* CS */ tcond = TCG_COND_LTU; goto done; case 6: /* NE */ case 7: /* EQ */ tcond = TCG_COND_EQ; goto done; case 10: /* PL */ case 11: /* MI */ c->g1 = c->g2 = 0; c->v2 = tcg_const_i32(0); c->v1 = tmp = tcg_temp_new(); tcg_gen_sub_i32(tmp, QREG_CC_N, QREG_CC_V); gen_ext(tmp, tmp, op - CC_OP_CMPB, 1); /* fallthru */ case 12: /* GE */ case 13: /* LT */ tcond = TCG_COND_LT; goto done; case 14: /* GT */ case 15: /* LE */ tcond = TCG_COND_LE; goto done; } } c->g1 = 1; c->g2 = 0; c->v2 = tcg_const_i32(0); switch (cond) { case 0: /* T */ case 1: /* F */ c->v1 = c->v2; tcond = TCG_COND_NEVER; goto done; case 14: /* GT (!(Z || (N ^ V))) */ case 15: /* LE (Z || (N ^ V)) */ /* * Logic operations clear V, which simplifies LE to (Z || N), * and since Z and N are co-located, this becomes a normal * comparison vs N. */ if (op == CC_OP_LOGIC) { c->v1 = QREG_CC_N; tcond = TCG_COND_LE; goto done; } break; case 12: /* GE (!(N ^ V)) */ case 13: /* LT (N ^ V) */ /* Logic operations clear V, which simplifies this to N. */ if (op != CC_OP_LOGIC) { break; } /* fallthru */ case 10: /* PL (!N) */ case 11: /* MI (N) */ /* Several cases represent N normally. */ if (op == CC_OP_ADDB || op == CC_OP_ADDW || op == CC_OP_ADDL || op == CC_OP_SUBB || op == CC_OP_SUBW || op == CC_OP_SUBL || op == CC_OP_LOGIC) { c->v1 = QREG_CC_N; tcond = TCG_COND_LT; goto done; } break; case 6: /* NE (!Z) */ case 7: /* EQ (Z) */ /* Some cases fold Z into N. */ if (op == CC_OP_ADDB || op == CC_OP_ADDW || op == CC_OP_ADDL || op == CC_OP_SUBB || op == CC_OP_SUBW || op == CC_OP_SUBL || op == CC_OP_LOGIC) { tcond = TCG_COND_EQ; c->v1 = QREG_CC_N; goto done; } break; case 4: /* CC (!C) */ case 5: /* CS (C) */ /* Some cases fold C into X. */ if (op == CC_OP_ADDB || op == CC_OP_ADDW || op == CC_OP_ADDL || op == CC_OP_SUBB || op == CC_OP_SUBW || op == CC_OP_SUBL) { tcond = TCG_COND_NE; c->v1 = QREG_CC_X; goto done; } /* fallthru */ case 8: /* VC (!V) */ case 9: /* VS (V) */ /* Logic operations clear V and C. */ if (op == CC_OP_LOGIC) { tcond = TCG_COND_NEVER; c->v1 = c->v2; goto done; } break; } /* Otherwise, flush flag state to CC_OP_FLAGS. */ gen_flush_flags(s); switch (cond) { case 0: /* T */ case 1: /* F */ default: /* Invalid, or handled above. */ abort(); case 2: /* HI (!C && !Z) -> !(C || Z)*/ case 3: /* LS (C || Z) */ c->v1 = tmp = tcg_temp_new(); c->g1 = 0; tcg_gen_setcond_i32(TCG_COND_EQ, tmp, QREG_CC_Z, c->v2); tcg_gen_or_i32(tmp, tmp, QREG_CC_C); tcond = TCG_COND_NE; break; case 4: /* CC (!C) */ case 5: /* CS (C) */ c->v1 = QREG_CC_C; tcond = TCG_COND_NE; break; case 6: /* NE (!Z) */ case 7: /* EQ (Z) */ c->v1 = QREG_CC_Z; tcond = TCG_COND_EQ; break; case 8: /* VC (!V) */ case 9: /* VS (V) */ c->v1 = QREG_CC_V; tcond = TCG_COND_LT; break; case 10: /* PL (!N) */ case 11: /* MI (N) */ c->v1 = QREG_CC_N; tcond = TCG_COND_LT; break; case 12: /* GE (!(N ^ V)) */ case 13: /* LT (N ^ V) */ c->v1 = tmp = tcg_temp_new(); c->g1 = 0; tcg_gen_xor_i32(tmp, QREG_CC_N, QREG_CC_V); tcond = TCG_COND_LT; break; case 14: /* GT (!(Z || (N ^ V))) */ case 15: /* LE (Z || (N ^ V)) */ c->v1 = tmp = tcg_temp_new(); c->g1 = 0; tcg_gen_setcond_i32(TCG_COND_EQ, tmp, QREG_CC_Z, c->v2); tcg_gen_neg_i32(tmp, tmp); tmp2 = tcg_temp_new(); tcg_gen_xor_i32(tmp2, QREG_CC_N, QREG_CC_V); tcg_gen_or_i32(tmp, tmp, tmp2); tcg_temp_free(tmp2); tcond = TCG_COND_LT; break; } done: if ((cond & 1) == 0) { tcond = tcg_invert_cond(tcond); } c->tcond = tcond; } static void free_cond(DisasCompare *c) { if (!c->g1) { tcg_temp_free(c->v1); } if (!c->g2) { tcg_temp_free(c->v2); } } static void gen_jmpcc(DisasContext *s, int cond, TCGLabel *l1) { DisasCompare c; gen_cc_cond(&c, s, cond); update_cc_op(s); tcg_gen_brcond_i32(c.tcond, c.v1, c.v2, l1); free_cond(&c); } /* Force a TB lookup after an instruction that changes the CPU state. */ static void gen_exit_tb(DisasContext *s) { update_cc_op(s); tcg_gen_movi_i32(QREG_PC, s->pc); s->base.is_jmp = DISAS_EXIT; } #define SRC_EA(env, result, opsize, op_sign, addrp) do { \ result = gen_ea(env, s, insn, opsize, NULL_QREG, addrp, \ op_sign ? EA_LOADS : EA_LOADU, IS_USER(s)); \ if (IS_NULL_QREG(result)) { \ gen_addr_fault(s); \ return; \ } \ } while (0) #define DEST_EA(env, insn, opsize, val, addrp) do { \ TCGv ea_result = gen_ea(env, s, insn, opsize, val, addrp, \ EA_STORE, IS_USER(s)); \ if (IS_NULL_QREG(ea_result)) { \ gen_addr_fault(s); \ return; \ } \ } while (0) /* Generate a jump to an immediate address. */ static void gen_jmp_tb(DisasContext *s, int n, target_ulong dest, target_ulong src) { if (unlikely(s->ss_active)) { update_cc_op(s); tcg_gen_movi_i32(QREG_PC, dest); gen_raise_exception_format2(s, EXCP_TRACE, src); } else if (translator_use_goto_tb(&s->base, dest)) { tcg_gen_goto_tb(n); tcg_gen_movi_i32(QREG_PC, dest); tcg_gen_exit_tb(s->base.tb, n); } else { gen_jmp_im(s, dest); tcg_gen_exit_tb(NULL, 0); } s->base.is_jmp = DISAS_NORETURN; } DISAS_INSN(scc) { DisasCompare c; int cond; TCGv tmp; cond = (insn >> 8) & 0xf; gen_cc_cond(&c, s, cond); tmp = tcg_temp_new(); tcg_gen_setcond_i32(c.tcond, tmp, c.v1, c.v2); free_cond(&c); tcg_gen_neg_i32(tmp, tmp); DEST_EA(env, insn, OS_BYTE, tmp, NULL); tcg_temp_free(tmp); } DISAS_INSN(dbcc) { TCGLabel *l1; TCGv reg; TCGv tmp; int16_t offset; uint32_t base; reg = DREG(insn, 0); base = s->pc; offset = (int16_t)read_im16(env, s); l1 = gen_new_label(); gen_jmpcc(s, (insn >> 8) & 0xf, l1); tmp = tcg_temp_new(); tcg_gen_ext16s_i32(tmp, reg); tcg_gen_addi_i32(tmp, tmp, -1); gen_partset_reg(OS_WORD, reg, tmp); tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, -1, l1); gen_jmp_tb(s, 1, base + offset, s->base.pc_next); gen_set_label(l1); gen_jmp_tb(s, 0, s->pc, s->base.pc_next); } DISAS_INSN(undef_mac) { gen_exception(s, s->base.pc_next, EXCP_LINEA); } DISAS_INSN(undef_fpu) { gen_exception(s, s->base.pc_next, EXCP_LINEF); } DISAS_INSN(undef) { /* * ??? This is both instructions that are as yet unimplemented * for the 680x0 series, as well as those that are implemented * but actually illegal for CPU32 or pre-68020. */ qemu_log_mask(LOG_UNIMP, "Illegal instruction: %04x @ %08x\n", insn, s->base.pc_next); gen_exception(s, s->base.pc_next, EXCP_ILLEGAL); } DISAS_INSN(mulw) { TCGv reg; TCGv tmp; TCGv src; int sign; sign = (insn & 0x100) != 0; reg = DREG(insn, 9); tmp = tcg_temp_new(); if (sign) tcg_gen_ext16s_i32(tmp, reg); else tcg_gen_ext16u_i32(tmp, reg); SRC_EA(env, src, OS_WORD, sign, NULL); tcg_gen_mul_i32(tmp, tmp, src); tcg_gen_mov_i32(reg, tmp); gen_logic_cc(s, tmp, OS_LONG); tcg_temp_free(tmp); } DISAS_INSN(divw) { int sign; TCGv src; TCGv destr; TCGv ilen; /* divX.w ,Dn 32/16 -> 16r:16q */ sign = (insn & 0x100) != 0; /* dest.l / src.w */ SRC_EA(env, src, OS_WORD, sign, NULL); destr = tcg_constant_i32(REG(insn, 9)); ilen = tcg_constant_i32(s->pc - s->base.pc_next); if (sign) { gen_helper_divsw(cpu_env, destr, src, ilen); } else { gen_helper_divuw(cpu_env, destr, src, ilen); } set_cc_op(s, CC_OP_FLAGS); } DISAS_INSN(divl) { TCGv num, reg, den, ilen; int sign; uint16_t ext; ext = read_im16(env, s); sign = (ext & 0x0800) != 0; if (ext & 0x400) { if (!m68k_feature(s->env, M68K_FEATURE_QUAD_MULDIV)) { gen_exception(s, s->base.pc_next, EXCP_ILLEGAL); return; } /* divX.l , Dr:Dq 64/32 -> 32r:32q */ SRC_EA(env, den, OS_LONG, 0, NULL); num = tcg_constant_i32(REG(ext, 12)); reg = tcg_constant_i32(REG(ext, 0)); ilen = tcg_constant_i32(s->pc - s->base.pc_next); if (sign) { gen_helper_divsll(cpu_env, num, reg, den, ilen); } else { gen_helper_divull(cpu_env, num, reg, den, ilen); } set_cc_op(s, CC_OP_FLAGS); return; } /* divX.l , Dq 32/32 -> 32q */ /* divXl.l , Dr:Dq 32/32 -> 32r:32q */ SRC_EA(env, den, OS_LONG, 0, NULL); num = tcg_constant_i32(REG(ext, 12)); reg = tcg_constant_i32(REG(ext, 0)); ilen = tcg_constant_i32(s->pc - s->base.pc_next); if (sign) { gen_helper_divsl(cpu_env, num, reg, den, ilen); } else { gen_helper_divul(cpu_env, num, reg, den, ilen); } set_cc_op(s, CC_OP_FLAGS); } static void bcd_add(TCGv dest, TCGv src) { TCGv t0, t1; /* * dest10 = dest10 + src10 + X * * t1 = src * t2 = t1 + 0x066 * t3 = t2 + dest + X * t4 = t2 ^ dest * t5 = t3 ^ t4 * t6 = ~t5 & 0x110 * t7 = (t6 >> 2) | (t6 >> 3) * return t3 - t7 */ /* * t1 = (src + 0x066) + dest + X * = result with some possible exceeding 0x6 */ t0 = tcg_const_i32(0x066); tcg_gen_add_i32(t0, t0, src); t1 = tcg_temp_new(); tcg_gen_add_i32(t1, t0, dest); tcg_gen_add_i32(t1, t1, QREG_CC_X); /* we will remove exceeding 0x6 where there is no carry */ /* * t0 = (src + 0x0066) ^ dest * = t1 without carries */ tcg_gen_xor_i32(t0, t0, dest); /* * extract the carries * t0 = t0 ^ t1 * = only the carries */ tcg_gen_xor_i32(t0, t0, t1); /* * generate 0x1 where there is no carry * and for each 0x10, generate a 0x6 */ tcg_gen_shri_i32(t0, t0, 3); tcg_gen_not_i32(t0, t0); tcg_gen_andi_i32(t0, t0, 0x22); tcg_gen_add_i32(dest, t0, t0); tcg_gen_add_i32(dest, dest, t0); tcg_temp_free(t0); /* * remove the exceeding 0x6 * for digits that have not generated a carry */ tcg_gen_sub_i32(dest, t1, dest); tcg_temp_free(t1); } static void bcd_sub(TCGv dest, TCGv src) { TCGv t0, t1, t2; /* * dest10 = dest10 - src10 - X * = bcd_add(dest + 1 - X, 0x199 - src) */ /* t0 = 0x066 + (0x199 - src) */ t0 = tcg_temp_new(); tcg_gen_subfi_i32(t0, 0x1ff, src); /* t1 = t0 + dest + 1 - X*/ t1 = tcg_temp_new(); tcg_gen_add_i32(t1, t0, dest); tcg_gen_addi_i32(t1, t1, 1); tcg_gen_sub_i32(t1, t1, QREG_CC_X); /* t2 = t0 ^ dest */ t2 = tcg_temp_new(); tcg_gen_xor_i32(t2, t0, dest); /* t0 = t1 ^ t2 */ tcg_gen_xor_i32(t0, t1, t2); /* * t2 = ~t0 & 0x110 * t0 = (t2 >> 2) | (t2 >> 3) * * to fit on 8bit operands, changed in: * * t2 = ~(t0 >> 3) & 0x22 * t0 = t2 + t2 * t0 = t0 + t2 */ tcg_gen_shri_i32(t2, t0, 3); tcg_gen_not_i32(t2, t2); tcg_gen_andi_i32(t2, t2, 0x22); tcg_gen_add_i32(t0, t2, t2); tcg_gen_add_i32(t0, t0, t2); tcg_temp_free(t2); /* return t1 - t0 */ tcg_gen_sub_i32(dest, t1, t0); tcg_temp_free(t0); tcg_temp_free(t1); } static void bcd_flags(TCGv val) { tcg_gen_andi_i32(QREG_CC_C, val, 0x0ff); tcg_gen_or_i32(QREG_CC_Z, QREG_CC_Z, QREG_CC_C); tcg_gen_extract_i32(QREG_CC_C, val, 8, 1); tcg_gen_mov_i32(QREG_CC_X, QREG_CC_C); } DISAS_INSN(abcd_reg) { TCGv src; TCGv dest; gen_flush_flags(s); /* !Z is sticky */ src = gen_extend(s, DREG(insn, 0), OS_BYTE, 0); dest = gen_extend(s, DREG(insn, 9), OS_BYTE, 0); bcd_add(dest, src); gen_partset_reg(OS_BYTE, DREG(insn, 9), dest); bcd_flags(dest); } DISAS_INSN(abcd_mem) { TCGv src, dest, addr; gen_flush_flags(s); /* !Z is sticky */ /* Indirect pre-decrement load (mode 4) */ src = gen_ea_mode(env, s, 4, REG(insn, 0), OS_BYTE, NULL_QREG, NULL, EA_LOADU, IS_USER(s)); dest = gen_ea_mode(env, s, 4, REG(insn, 9), OS_BYTE, NULL_QREG, &addr, EA_LOADU, IS_USER(s)); bcd_add(dest, src); gen_ea_mode(env, s, 4, REG(insn, 9), OS_BYTE, dest, &addr, EA_STORE, IS_USER(s)); bcd_flags(dest); } DISAS_INSN(sbcd_reg) { TCGv src, dest; gen_flush_flags(s); /* !Z is sticky */ src = gen_extend(s, DREG(insn, 0), OS_BYTE, 0); dest = gen_extend(s, DREG(insn, 9), OS_BYTE, 0); bcd_sub(dest, src); gen_partset_reg(OS_BYTE, DREG(insn, 9), dest); bcd_flags(dest); } DISAS_INSN(sbcd_mem) { TCGv src, dest, addr; gen_flush_flags(s); /* !Z is sticky */ /* Indirect pre-decrement load (mode 4) */ src = gen_ea_mode(env, s, 4, REG(insn, 0), OS_BYTE, NULL_QREG, NULL, EA_LOADU, IS_USER(s)); dest = gen_ea_mode(env, s, 4, REG(insn, 9), OS_BYTE, NULL_QREG, &addr, EA_LOADU, IS_USER(s)); bcd_sub(dest, src); gen_ea_mode(env, s, 4, REG(insn, 9), OS_BYTE, dest, &addr, EA_STORE, IS_USER(s)); bcd_flags(dest); } DISAS_INSN(nbcd) { TCGv src, dest; TCGv addr; gen_flush_flags(s); /* !Z is sticky */ SRC_EA(env, src, OS_BYTE, 0, &addr); dest = tcg_const_i32(0); bcd_sub(dest, src); DEST_EA(env, insn, OS_BYTE, dest, &addr); bcd_flags(dest); tcg_temp_free(dest); } DISAS_INSN(addsub) { TCGv reg; TCGv dest; TCGv src; TCGv tmp; TCGv addr; int add; int opsize; add = (insn & 0x4000) != 0; opsize = insn_opsize(insn); reg = gen_extend(s, DREG(insn, 9), opsize, 1); dest = tcg_temp_new(); if (insn & 0x100) { SRC_EA(env, tmp, opsize, 1, &addr); src = reg; } else { tmp = reg; SRC_EA(env, src, opsize, 1, NULL); } if (add) { tcg_gen_add_i32(dest, tmp, src); tcg_gen_setcond_i32(TCG_COND_LTU, QREG_CC_X, dest, src); set_cc_op(s, CC_OP_ADDB + opsize); } else { tcg_gen_setcond_i32(TCG_COND_LTU, QREG_CC_X, tmp, src); tcg_gen_sub_i32(dest, tmp, src); set_cc_op(s, CC_OP_SUBB + opsize); } gen_update_cc_add(dest, src, opsize); if (insn & 0x100) { DEST_EA(env, insn, opsize, dest, &addr); } else { gen_partset_reg(opsize, DREG(insn, 9), dest); } tcg_temp_free(dest); } /* Reverse the order of the bits in REG. */ DISAS_INSN(bitrev) { TCGv reg; reg = DREG(insn, 0); gen_helper_bitrev(reg, reg); } DISAS_INSN(bitop_reg) { int opsize; int op; TCGv src1; TCGv src2; TCGv tmp; TCGv addr; TCGv dest; if ((insn & 0x38) != 0) opsize = OS_BYTE; else opsize = OS_LONG; op = (insn >> 6) & 3; SRC_EA(env, src1, opsize, 0, op ? &addr: NULL); gen_flush_flags(s); src2 = tcg_temp_new(); if (opsize == OS_BYTE) tcg_gen_andi_i32(src2, DREG(insn, 9), 7); else tcg_gen_andi_i32(src2, DREG(insn, 9), 31); tmp = tcg_const_i32(1); tcg_gen_shl_i32(tmp, tmp, src2); tcg_temp_free(src2); tcg_gen_and_i32(QREG_CC_Z, src1, tmp); dest = tcg_temp_new(); switch (op) { case 1: /* bchg */ tcg_gen_xor_i32(dest, src1, tmp); break; case 2: /* bclr */ tcg_gen_andc_i32(dest, src1, tmp); break; case 3: /* bset */ tcg_gen_or_i32(dest, src1, tmp); break; default: /* btst */ break; } tcg_temp_free(tmp); if (op) { DEST_EA(env, insn, opsize, dest, &addr); } tcg_temp_free(dest); } DISAS_INSN(sats) { TCGv reg; reg = DREG(insn, 0); gen_flush_flags(s); gen_helper_sats(reg, reg, QREG_CC_V); gen_logic_cc(s, reg, OS_LONG); } static void gen_push(DisasContext *s, TCGv val) { TCGv tmp; tmp = tcg_temp_new(); tcg_gen_subi_i32(tmp, QREG_SP, 4); gen_store(s, OS_LONG, tmp, val, IS_USER(s)); tcg_gen_mov_i32(QREG_SP, tmp); tcg_temp_free(tmp); } static TCGv mreg(int reg) { if (reg < 8) { /* Dx */ return cpu_dregs[reg]; } /* Ax */ return cpu_aregs[reg & 7]; } DISAS_INSN(movem) { TCGv addr, incr, tmp, r[16]; int is_load = (insn & 0x0400) != 0; int opsize = (insn & 0x40) != 0 ? OS_LONG : OS_WORD; uint16_t mask = read_im16(env, s); int mode = extract32(insn, 3, 3); int reg0 = REG(insn, 0); int i; tmp = cpu_aregs[reg0]; switch (mode) { case 0: /* data register direct */ case 1: /* addr register direct */ do_addr_fault: gen_addr_fault(s); return; case 2: /* indirect */ break; case 3: /* indirect post-increment */ if (!is_load) { /* post-increment is not allowed */ goto do_addr_fault; } break; case 4: /* indirect pre-decrement */ if (is_load) { /* pre-decrement is not allowed */ goto do_addr_fault; } /* * We want a bare copy of the address reg, without any pre-decrement * adjustment, as gen_lea would provide. */ break; default: tmp = gen_lea_mode(env, s, mode, reg0, opsize); if (IS_NULL_QREG(tmp)) { goto do_addr_fault; } break; } addr = tcg_temp_new(); tcg_gen_mov_i32(addr, tmp); incr = tcg_const_i32(opsize_bytes(opsize)); if (is_load) { /* memory to register */ for (i = 0; i < 16; i++) { if (mask & (1 << i)) { r[i] = gen_load(s, opsize, addr, 1, IS_USER(s)); tcg_gen_add_i32(addr, addr, incr); } } for (i = 0; i < 16; i++) { if (mask & (1 << i)) { tcg_gen_mov_i32(mreg(i), r[i]); tcg_temp_free(r[i]); } } if (mode == 3) { /* post-increment: movem (An)+,X */ tcg_gen_mov_i32(cpu_aregs[reg0], addr); } } else { /* register to memory */ if (mode == 4) { /* pre-decrement: movem X,-(An) */ for (i = 15; i >= 0; i--) { if ((mask << i) & 0x8000) { tcg_gen_sub_i32(addr, addr, incr); if (reg0 + 8 == i && m68k_feature(s->env, M68K_FEATURE_EXT_FULL)) { /* * M68020+: if the addressing register is the * register moved to memory, the value written * is the initial value decremented by the size of * the operation, regardless of how many actual * stores have been performed until this point. * M68000/M68010: the value is the initial value. */ tmp = tcg_temp_new(); tcg_gen_sub_i32(tmp, cpu_aregs[reg0], incr); gen_store(s, opsize, addr, tmp, IS_USER(s)); tcg_temp_free(tmp); } else { gen_store(s, opsize, addr, mreg(i), IS_USER(s)); } } } tcg_gen_mov_i32(cpu_aregs[reg0], addr); } else { for (i = 0; i < 16; i++) { if (mask & (1 << i)) { gen_store(s, opsize, addr, mreg(i), IS_USER(s)); tcg_gen_add_i32(addr, addr, incr); } } } } tcg_temp_free(incr); tcg_temp_free(addr); } DISAS_INSN(movep) { uint8_t i; int16_t displ; TCGv reg; TCGv addr; TCGv abuf; TCGv dbuf; displ = read_im16(env, s); addr = AREG(insn, 0); reg = DREG(insn, 9); abuf = tcg_temp_new(); tcg_gen_addi_i32(abuf, addr, displ); dbuf = tcg_temp_new(); if (insn & 0x40) { i = 4; } else { i = 2; } if (insn & 0x80) { for ( ; i > 0 ; i--) { tcg_gen_shri_i32(dbuf, reg, (i - 1) * 8); tcg_gen_qemu_st8(dbuf, abuf, IS_USER(s)); if (i > 1) { tcg_gen_addi_i32(abuf, abuf, 2); } } } else { for ( ; i > 0 ; i--) { tcg_gen_qemu_ld8u(dbuf, abuf, IS_USER(s)); tcg_gen_deposit_i32(reg, reg, dbuf, (i - 1) * 8, 8); if (i > 1) { tcg_gen_addi_i32(abuf, abuf, 2); } } } tcg_temp_free(abuf); tcg_temp_free(dbuf); } DISAS_INSN(bitop_im) { int opsize; int op; TCGv src1; uint32_t mask; int bitnum; TCGv tmp; TCGv addr; if ((insn & 0x38) != 0) opsize = OS_BYTE; else opsize = OS_LONG; op = (insn >> 6) & 3; bitnum = read_im16(env, s); if (m68k_feature(s->env, M68K_FEATURE_M68K)) { if (bitnum & 0xfe00) { disas_undef(env, s, insn); return; } } else { if (bitnum & 0xff00) { disas_undef(env, s, insn); return; } } SRC_EA(env, src1, opsize, 0, op ? &addr: NULL); gen_flush_flags(s); if (opsize == OS_BYTE) bitnum &= 7; else bitnum &= 31; mask = 1 << bitnum; tcg_gen_andi_i32(QREG_CC_Z, src1, mask); if (op) { tmp = tcg_temp_new(); switch (op) { case 1: /* bchg */ tcg_gen_xori_i32(tmp, src1, mask); break; case 2: /* bclr */ tcg_gen_andi_i32(tmp, src1, ~mask); break; case 3: /* bset */ tcg_gen_ori_i32(tmp, src1, mask); break; default: /* btst */ break; } DEST_EA(env, insn, opsize, tmp, &addr); tcg_temp_free(tmp); } } static TCGv gen_get_ccr(DisasContext *s) { TCGv dest; update_cc_op(s); dest = tcg_temp_new(); gen_helper_get_ccr(dest, cpu_env); return dest; } static TCGv gen_get_sr(DisasContext *s) { TCGv ccr; TCGv sr; ccr = gen_get_ccr(s); sr = tcg_temp_new(); tcg_gen_andi_i32(sr, QREG_SR, 0xffe0); tcg_gen_or_i32(sr, sr, ccr); tcg_temp_free(ccr); return sr; } static void gen_set_sr_im(DisasContext *s, uint16_t val, int ccr_only) { if (ccr_only) { tcg_gen_movi_i32(QREG_CC_C, val & CCF_C ? 1 : 0); tcg_gen_movi_i32(QREG_CC_V, val & CCF_V ? -1 : 0); tcg_gen_movi_i32(QREG_CC_Z, val & CCF_Z ? 0 : 1); tcg_gen_movi_i32(QREG_CC_N, val & CCF_N ? -1 : 0); tcg_gen_movi_i32(QREG_CC_X, val & CCF_X ? 1 : 0); } else { /* Must writeback before changing security state. */ do_writebacks(s); gen_helper_set_sr(cpu_env, tcg_constant_i32(val)); } set_cc_op(s, CC_OP_FLAGS); } static void gen_set_sr(DisasContext *s, TCGv val, int ccr_only) { if (ccr_only) { gen_helper_set_ccr(cpu_env, val); } else { /* Must writeback before changing security state. */ do_writebacks(s); gen_helper_set_sr(cpu_env, val); } set_cc_op(s, CC_OP_FLAGS); } static void gen_move_to_sr(CPUM68KState *env, DisasContext *s, uint16_t insn, bool ccr_only) { if ((insn & 0x3f) == 0x3c) { uint16_t val; val = read_im16(env, s); gen_set_sr_im(s, val, ccr_only); } else { TCGv src; SRC_EA(env, src, OS_WORD, 0, NULL); gen_set_sr(s, src, ccr_only); } } DISAS_INSN(arith_im) { int op; TCGv im; TCGv src1; TCGv dest; TCGv addr; int opsize; bool with_SR = ((insn & 0x3f) == 0x3c); op = (insn >> 9) & 7; opsize = insn_opsize(insn); switch (opsize) { case OS_BYTE: im = tcg_const_i32((int8_t)read_im8(env, s)); break; case OS_WORD: im = tcg_const_i32((int16_t)read_im16(env, s)); break; case OS_LONG: im = tcg_const_i32(read_im32(env, s)); break; default: g_assert_not_reached(); } if (with_SR) { /* SR/CCR can only be used with andi/eori/ori */ if (op == 2 || op == 3 || op == 6) { disas_undef(env, s, insn); return; } switch (opsize) { case OS_BYTE: src1 = gen_get_ccr(s); break; case OS_WORD: if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } src1 = gen_get_sr(s); break; default: /* OS_LONG; others already g_assert_not_reached. */ disas_undef(env, s, insn); return; } } else { SRC_EA(env, src1, opsize, 1, (op == 6) ? NULL : &addr); } dest = tcg_temp_new(); switch (op) { case 0: /* ori */ tcg_gen_or_i32(dest, src1, im); if (with_SR) { gen_set_sr(s, dest, opsize == OS_BYTE); gen_exit_tb(s); } else { DEST_EA(env, insn, opsize, dest, &addr); gen_logic_cc(s, dest, opsize); } break; case 1: /* andi */ tcg_gen_and_i32(dest, src1, im); if (with_SR) { gen_set_sr(s, dest, opsize == OS_BYTE); gen_exit_tb(s); } else { DEST_EA(env, insn, opsize, dest, &addr); gen_logic_cc(s, dest, opsize); } break; case 2: /* subi */ tcg_gen_setcond_i32(TCG_COND_LTU, QREG_CC_X, src1, im); tcg_gen_sub_i32(dest, src1, im); gen_update_cc_add(dest, im, opsize); set_cc_op(s, CC_OP_SUBB + opsize); DEST_EA(env, insn, opsize, dest, &addr); break; case 3: /* addi */ tcg_gen_add_i32(dest, src1, im); gen_update_cc_add(dest, im, opsize); tcg_gen_setcond_i32(TCG_COND_LTU, QREG_CC_X, dest, im); set_cc_op(s, CC_OP_ADDB + opsize); DEST_EA(env, insn, opsize, dest, &addr); break; case 5: /* eori */ tcg_gen_xor_i32(dest, src1, im); if (with_SR) { gen_set_sr(s, dest, opsize == OS_BYTE); gen_exit_tb(s); } else { DEST_EA(env, insn, opsize, dest, &addr); gen_logic_cc(s, dest, opsize); } break; case 6: /* cmpi */ gen_update_cc_cmp(s, src1, im, opsize); break; default: abort(); } tcg_temp_free(im); tcg_temp_free(dest); } DISAS_INSN(cas) { int opsize; TCGv addr; uint16_t ext; TCGv load; TCGv cmp; MemOp opc; switch ((insn >> 9) & 3) { case 1: opsize = OS_BYTE; opc = MO_SB; break; case 2: opsize = OS_WORD; opc = MO_TESW; break; case 3: opsize = OS_LONG; opc = MO_TESL; break; default: g_assert_not_reached(); } ext = read_im16(env, s); /* cas Dc,Du, */ addr = gen_lea(env, s, insn, opsize); if (IS_NULL_QREG(addr)) { gen_addr_fault(s); return; } cmp = gen_extend(s, DREG(ext, 0), opsize, 1); /* * if == Dc then * = Du * Dc = (because == Dc) * else * Dc = */ load = tcg_temp_new(); tcg_gen_atomic_cmpxchg_i32(load, addr, cmp, DREG(ext, 6), IS_USER(s), opc); /* update flags before setting cmp to load */ gen_update_cc_cmp(s, load, cmp, opsize); gen_partset_reg(opsize, DREG(ext, 0), load); tcg_temp_free(load); switch (extract32(insn, 3, 3)) { case 3: /* Indirect postincrement. */ tcg_gen_addi_i32(AREG(insn, 0), addr, opsize_bytes(opsize)); break; case 4: /* Indirect predecrememnt. */ tcg_gen_mov_i32(AREG(insn, 0), addr); break; } } DISAS_INSN(cas2w) { uint16_t ext1, ext2; TCGv addr1, addr2; TCGv regs; /* cas2 Dc1:Dc2,Du1:Du2,(Rn1):(Rn2) */ ext1 = read_im16(env, s); if (ext1 & 0x8000) { /* Address Register */ addr1 = AREG(ext1, 12); } else { /* Data Register */ addr1 = DREG(ext1, 12); } ext2 = read_im16(env, s); if (ext2 & 0x8000) { /* Address Register */ addr2 = AREG(ext2, 12); } else { /* Data Register */ addr2 = DREG(ext2, 12); } /* * if (R1) == Dc1 && (R2) == Dc2 then * (R1) = Du1 * (R2) = Du2 * else * Dc1 = (R1) * Dc2 = (R2) */ regs = tcg_const_i32(REG(ext2, 6) | (REG(ext1, 6) << 3) | (REG(ext2, 0) << 6) | (REG(ext1, 0) << 9)); if (tb_cflags(s->base.tb) & CF_PARALLEL) { gen_helper_exit_atomic(cpu_env); } else { gen_helper_cas2w(cpu_env, regs, addr1, addr2); } tcg_temp_free(regs); /* Note that cas2w also assigned to env->cc_op. */ s->cc_op = CC_OP_CMPW; s->cc_op_synced = 1; } DISAS_INSN(cas2l) { uint16_t ext1, ext2; TCGv addr1, addr2, regs; /* cas2 Dc1:Dc2,Du1:Du2,(Rn1):(Rn2) */ ext1 = read_im16(env, s); if (ext1 & 0x8000) { /* Address Register */ addr1 = AREG(ext1, 12); } else { /* Data Register */ addr1 = DREG(ext1, 12); } ext2 = read_im16(env, s); if (ext2 & 0x8000) { /* Address Register */ addr2 = AREG(ext2, 12); } else { /* Data Register */ addr2 = DREG(ext2, 12); } /* * if (R1) == Dc1 && (R2) == Dc2 then * (R1) = Du1 * (R2) = Du2 * else * Dc1 = (R1) * Dc2 = (R2) */ regs = tcg_const_i32(REG(ext2, 6) | (REG(ext1, 6) << 3) | (REG(ext2, 0) << 6) | (REG(ext1, 0) << 9)); if (tb_cflags(s->base.tb) & CF_PARALLEL) { gen_helper_cas2l_parallel(cpu_env, regs, addr1, addr2); } else { gen_helper_cas2l(cpu_env, regs, addr1, addr2); } tcg_temp_free(regs); /* Note that cas2l also assigned to env->cc_op. */ s->cc_op = CC_OP_CMPL; s->cc_op_synced = 1; } DISAS_INSN(byterev) { TCGv reg; reg = DREG(insn, 0); tcg_gen_bswap32_i32(reg, reg); } DISAS_INSN(move) { TCGv src; TCGv dest; int op; int opsize; switch (insn >> 12) { case 1: /* move.b */ opsize = OS_BYTE; break; case 2: /* move.l */ opsize = OS_LONG; break; case 3: /* move.w */ opsize = OS_WORD; break; default: abort(); } SRC_EA(env, src, opsize, 1, NULL); op = (insn >> 6) & 7; if (op == 1) { /* movea */ /* The value will already have been sign extended. */ dest = AREG(insn, 9); tcg_gen_mov_i32(dest, src); } else { /* normal move */ uint16_t dest_ea; dest_ea = ((insn >> 9) & 7) | (op << 3); DEST_EA(env, dest_ea, opsize, src, NULL); /* This will be correct because loads sign extend. */ gen_logic_cc(s, src, opsize); } } DISAS_INSN(negx) { TCGv z; TCGv src; TCGv addr; int opsize; opsize = insn_opsize(insn); SRC_EA(env, src, opsize, 1, &addr); gen_flush_flags(s); /* compute old Z */ /* * Perform subtract with borrow. * (X, N) = -(src + X); */ z = tcg_const_i32(0); tcg_gen_add2_i32(QREG_CC_N, QREG_CC_X, src, z, QREG_CC_X, z); tcg_gen_sub2_i32(QREG_CC_N, QREG_CC_X, z, z, QREG_CC_N, QREG_CC_X); tcg_temp_free(z); gen_ext(QREG_CC_N, QREG_CC_N, opsize, 1); tcg_gen_andi_i32(QREG_CC_X, QREG_CC_X, 1); /* * Compute signed-overflow for negation. The normal formula for * subtraction is (res ^ src) & (src ^ dest), but with dest==0 * this simplifies to res & src. */ tcg_gen_and_i32(QREG_CC_V, QREG_CC_N, src); /* Copy the rest of the results into place. */ tcg_gen_or_i32(QREG_CC_Z, QREG_CC_Z, QREG_CC_N); /* !Z is sticky */ tcg_gen_mov_i32(QREG_CC_C, QREG_CC_X); set_cc_op(s, CC_OP_FLAGS); /* result is in QREG_CC_N */ DEST_EA(env, insn, opsize, QREG_CC_N, &addr); } DISAS_INSN(lea) { TCGv reg; TCGv tmp; reg = AREG(insn, 9); tmp = gen_lea(env, s, insn, OS_LONG); if (IS_NULL_QREG(tmp)) { gen_addr_fault(s); return; } tcg_gen_mov_i32(reg, tmp); } DISAS_INSN(clr) { int opsize; TCGv zero; zero = tcg_const_i32(0); opsize = insn_opsize(insn); DEST_EA(env, insn, opsize, zero, NULL); gen_logic_cc(s, zero, opsize); tcg_temp_free(zero); } DISAS_INSN(move_from_ccr) { TCGv ccr; ccr = gen_get_ccr(s); DEST_EA(env, insn, OS_WORD, ccr, NULL); } DISAS_INSN(neg) { TCGv src1; TCGv dest; TCGv addr; int opsize; opsize = insn_opsize(insn); SRC_EA(env, src1, opsize, 1, &addr); dest = tcg_temp_new(); tcg_gen_neg_i32(dest, src1); set_cc_op(s, CC_OP_SUBB + opsize); gen_update_cc_add(dest, src1, opsize); tcg_gen_setcondi_i32(TCG_COND_NE, QREG_CC_X, dest, 0); DEST_EA(env, insn, opsize, dest, &addr); tcg_temp_free(dest); } DISAS_INSN(move_to_ccr) { gen_move_to_sr(env, s, insn, true); } DISAS_INSN(not) { TCGv src1; TCGv dest; TCGv addr; int opsize; opsize = insn_opsize(insn); SRC_EA(env, src1, opsize, 1, &addr); dest = tcg_temp_new(); tcg_gen_not_i32(dest, src1); DEST_EA(env, insn, opsize, dest, &addr); gen_logic_cc(s, dest, opsize); } DISAS_INSN(swap) { TCGv src1; TCGv src2; TCGv reg; src1 = tcg_temp_new(); src2 = tcg_temp_new(); reg = DREG(insn, 0); tcg_gen_shli_i32(src1, reg, 16); tcg_gen_shri_i32(src2, reg, 16); tcg_gen_or_i32(reg, src1, src2); tcg_temp_free(src2); tcg_temp_free(src1); gen_logic_cc(s, reg, OS_LONG); } DISAS_INSN(bkpt) { gen_exception(s, s->base.pc_next, EXCP_DEBUG); } DISAS_INSN(pea) { TCGv tmp; tmp = gen_lea(env, s, insn, OS_LONG); if (IS_NULL_QREG(tmp)) { gen_addr_fault(s); return; } gen_push(s, tmp); } DISAS_INSN(ext) { int op; TCGv reg; TCGv tmp; reg = DREG(insn, 0); op = (insn >> 6) & 7; tmp = tcg_temp_new(); if (op == 3) tcg_gen_ext16s_i32(tmp, reg); else tcg_gen_ext8s_i32(tmp, reg); if (op == 2) gen_partset_reg(OS_WORD, reg, tmp); else tcg_gen_mov_i32(reg, tmp); gen_logic_cc(s, tmp, OS_LONG); tcg_temp_free(tmp); } DISAS_INSN(tst) { int opsize; TCGv tmp; opsize = insn_opsize(insn); SRC_EA(env, tmp, opsize, 1, NULL); gen_logic_cc(s, tmp, opsize); } DISAS_INSN(pulse) { /* Implemented as a NOP. */ } DISAS_INSN(illegal) { gen_exception(s, s->base.pc_next, EXCP_ILLEGAL); } DISAS_INSN(tas) { int mode = extract32(insn, 3, 3); int reg0 = REG(insn, 0); if (mode == 0) { /* data register direct */ TCGv dest = cpu_dregs[reg0]; gen_logic_cc(s, dest, OS_BYTE); tcg_gen_ori_tl(dest, dest, 0x80); } else { TCGv src1, addr; addr = gen_lea_mode(env, s, mode, reg0, OS_BYTE); if (IS_NULL_QREG(addr)) { gen_addr_fault(s); return; } src1 = tcg_temp_new(); tcg_gen_atomic_fetch_or_tl(src1, addr, tcg_constant_tl(0x80), IS_USER(s), MO_SB); gen_logic_cc(s, src1, OS_BYTE); tcg_temp_free(src1); switch (mode) { case 3: /* Indirect postincrement. */ tcg_gen_addi_i32(AREG(insn, 0), addr, 1); break; case 4: /* Indirect predecrememnt. */ tcg_gen_mov_i32(AREG(insn, 0), addr); break; } } } DISAS_INSN(mull) { uint16_t ext; TCGv src1; int sign; ext = read_im16(env, s); sign = ext & 0x800; if (ext & 0x400) { if (!m68k_feature(s->env, M68K_FEATURE_QUAD_MULDIV)) { gen_exception(s, s->base.pc_next, EXCP_ILLEGAL); return; } SRC_EA(env, src1, OS_LONG, 0, NULL); if (sign) { tcg_gen_muls2_i32(QREG_CC_Z, QREG_CC_N, src1, DREG(ext, 12)); } else { tcg_gen_mulu2_i32(QREG_CC_Z, QREG_CC_N, src1, DREG(ext, 12)); } /* if Dl == Dh, 68040 returns low word */ tcg_gen_mov_i32(DREG(ext, 0), QREG_CC_N); tcg_gen_mov_i32(DREG(ext, 12), QREG_CC_Z); tcg_gen_or_i32(QREG_CC_Z, QREG_CC_Z, QREG_CC_N); tcg_gen_movi_i32(QREG_CC_V, 0); tcg_gen_movi_i32(QREG_CC_C, 0); set_cc_op(s, CC_OP_FLAGS); return; } SRC_EA(env, src1, OS_LONG, 0, NULL); if (m68k_feature(s->env, M68K_FEATURE_M68K)) { tcg_gen_movi_i32(QREG_CC_C, 0); if (sign) { tcg_gen_muls2_i32(QREG_CC_N, QREG_CC_V, src1, DREG(ext, 12)); /* QREG_CC_V is -(QREG_CC_V != (QREG_CC_N >> 31)) */ tcg_gen_sari_i32(QREG_CC_Z, QREG_CC_N, 31); tcg_gen_setcond_i32(TCG_COND_NE, QREG_CC_V, QREG_CC_V, QREG_CC_Z); } else { tcg_gen_mulu2_i32(QREG_CC_N, QREG_CC_V, src1, DREG(ext, 12)); /* QREG_CC_V is -(QREG_CC_V != 0), use QREG_CC_C as 0 */ tcg_gen_setcond_i32(TCG_COND_NE, QREG_CC_V, QREG_CC_V, QREG_CC_C); } tcg_gen_neg_i32(QREG_CC_V, QREG_CC_V); tcg_gen_mov_i32(DREG(ext, 12), QREG_CC_N); tcg_gen_mov_i32(QREG_CC_Z, QREG_CC_N); set_cc_op(s, CC_OP_FLAGS); } else { /* * The upper 32 bits of the product are discarded, so * muls.l and mulu.l are functionally equivalent. */ tcg_gen_mul_i32(DREG(ext, 12), src1, DREG(ext, 12)); gen_logic_cc(s, DREG(ext, 12), OS_LONG); } } static void gen_link(DisasContext *s, uint16_t insn, int32_t offset) { TCGv reg; TCGv tmp; reg = AREG(insn, 0); tmp = tcg_temp_new(); tcg_gen_subi_i32(tmp, QREG_SP, 4); gen_store(s, OS_LONG, tmp, reg, IS_USER(s)); if ((insn & 7) != 7) { tcg_gen_mov_i32(reg, tmp); } tcg_gen_addi_i32(QREG_SP, tmp, offset); tcg_temp_free(tmp); } DISAS_INSN(link) { int16_t offset; offset = read_im16(env, s); gen_link(s, insn, offset); } DISAS_INSN(linkl) { int32_t offset; offset = read_im32(env, s); gen_link(s, insn, offset); } DISAS_INSN(unlk) { TCGv src; TCGv reg; TCGv tmp; src = tcg_temp_new(); reg = AREG(insn, 0); tcg_gen_mov_i32(src, reg); tmp = gen_load(s, OS_LONG, src, 0, IS_USER(s)); tcg_gen_mov_i32(reg, tmp); tcg_gen_addi_i32(QREG_SP, src, 4); tcg_temp_free(src); tcg_temp_free(tmp); } #if defined(CONFIG_SOFTMMU) DISAS_INSN(reset) { if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } gen_helper_reset(cpu_env); } #endif DISAS_INSN(nop) { } DISAS_INSN(rtd) { TCGv tmp; int16_t offset = read_im16(env, s); tmp = gen_load(s, OS_LONG, QREG_SP, 0, IS_USER(s)); tcg_gen_addi_i32(QREG_SP, QREG_SP, offset + 4); gen_jmp(s, tmp); } DISAS_INSN(rtr) { TCGv tmp; TCGv ccr; TCGv sp; sp = tcg_temp_new(); ccr = gen_load(s, OS_WORD, QREG_SP, 0, IS_USER(s)); tcg_gen_addi_i32(sp, QREG_SP, 2); tmp = gen_load(s, OS_LONG, sp, 0, IS_USER(s)); tcg_gen_addi_i32(QREG_SP, sp, 4); tcg_temp_free(sp); gen_set_sr(s, ccr, true); tcg_temp_free(ccr); gen_jmp(s, tmp); } DISAS_INSN(rts) { TCGv tmp; tmp = gen_load(s, OS_LONG, QREG_SP, 0, IS_USER(s)); tcg_gen_addi_i32(QREG_SP, QREG_SP, 4); gen_jmp(s, tmp); } DISAS_INSN(jump) { TCGv tmp; /* * Load the target address first to ensure correct exception * behavior. */ tmp = gen_lea(env, s, insn, OS_LONG); if (IS_NULL_QREG(tmp)) { gen_addr_fault(s); return; } if ((insn & 0x40) == 0) { /* jsr */ gen_push(s, tcg_const_i32(s->pc)); } gen_jmp(s, tmp); } DISAS_INSN(addsubq) { TCGv src; TCGv dest; TCGv val; int imm; TCGv addr; int opsize; if ((insn & 070) == 010) { /* Operation on address register is always long. */ opsize = OS_LONG; } else { opsize = insn_opsize(insn); } SRC_EA(env, src, opsize, 1, &addr); imm = (insn >> 9) & 7; if (imm == 0) { imm = 8; } val = tcg_const_i32(imm); dest = tcg_temp_new(); tcg_gen_mov_i32(dest, src); if ((insn & 0x38) == 0x08) { /* * Don't update condition codes if the destination is an * address register. */ if (insn & 0x0100) { tcg_gen_sub_i32(dest, dest, val); } else { tcg_gen_add_i32(dest, dest, val); } } else { if (insn & 0x0100) { tcg_gen_setcond_i32(TCG_COND_LTU, QREG_CC_X, dest, val); tcg_gen_sub_i32(dest, dest, val); set_cc_op(s, CC_OP_SUBB + opsize); } else { tcg_gen_add_i32(dest, dest, val); tcg_gen_setcond_i32(TCG_COND_LTU, QREG_CC_X, dest, val); set_cc_op(s, CC_OP_ADDB + opsize); } gen_update_cc_add(dest, val, opsize); } tcg_temp_free(val); DEST_EA(env, insn, opsize, dest, &addr); tcg_temp_free(dest); } DISAS_INSN(branch) { int32_t offset; uint32_t base; int op; base = s->pc; op = (insn >> 8) & 0xf; offset = (int8_t)insn; if (offset == 0) { offset = (int16_t)read_im16(env, s); } else if (offset == -1) { offset = read_im32(env, s); } if (op == 1) { /* bsr */ gen_push(s, tcg_const_i32(s->pc)); } if (op > 1) { /* Bcc */ TCGLabel *l1 = gen_new_label(); gen_jmpcc(s, ((insn >> 8) & 0xf) ^ 1, l1); gen_jmp_tb(s, 1, base + offset, s->base.pc_next); gen_set_label(l1); gen_jmp_tb(s, 0, s->pc, s->base.pc_next); } else { /* Unconditional branch. */ update_cc_op(s); gen_jmp_tb(s, 0, base + offset, s->base.pc_next); } } DISAS_INSN(moveq) { tcg_gen_movi_i32(DREG(insn, 9), (int8_t)insn); gen_logic_cc(s, DREG(insn, 9), OS_LONG); } DISAS_INSN(mvzs) { int opsize; TCGv src; TCGv reg; if (insn & 0x40) opsize = OS_WORD; else opsize = OS_BYTE; SRC_EA(env, src, opsize, (insn & 0x80) == 0, NULL); reg = DREG(insn, 9); tcg_gen_mov_i32(reg, src); gen_logic_cc(s, src, opsize); } DISAS_INSN(or) { TCGv reg; TCGv dest; TCGv src; TCGv addr; int opsize; opsize = insn_opsize(insn); reg = gen_extend(s, DREG(insn, 9), opsize, 0); dest = tcg_temp_new(); if (insn & 0x100) { SRC_EA(env, src, opsize, 0, &addr); tcg_gen_or_i32(dest, src, reg); DEST_EA(env, insn, opsize, dest, &addr); } else { SRC_EA(env, src, opsize, 0, NULL); tcg_gen_or_i32(dest, src, reg); gen_partset_reg(opsize, DREG(insn, 9), dest); } gen_logic_cc(s, dest, opsize); tcg_temp_free(dest); } DISAS_INSN(suba) { TCGv src; TCGv reg; SRC_EA(env, src, (insn & 0x100) ? OS_LONG : OS_WORD, 1, NULL); reg = AREG(insn, 9); tcg_gen_sub_i32(reg, reg, src); } static inline void gen_subx(DisasContext *s, TCGv src, TCGv dest, int opsize) { TCGv tmp; gen_flush_flags(s); /* compute old Z */ /* * Perform subtract with borrow. * (X, N) = dest - (src + X); */ tmp = tcg_const_i32(0); tcg_gen_add2_i32(QREG_CC_N, QREG_CC_X, src, tmp, QREG_CC_X, tmp); tcg_gen_sub2_i32(QREG_CC_N, QREG_CC_X, dest, tmp, QREG_CC_N, QREG_CC_X); gen_ext(QREG_CC_N, QREG_CC_N, opsize, 1); tcg_gen_andi_i32(QREG_CC_X, QREG_CC_X, 1); /* Compute signed-overflow for subtract. */ tcg_gen_xor_i32(QREG_CC_V, QREG_CC_N, dest); tcg_gen_xor_i32(tmp, dest, src); tcg_gen_and_i32(QREG_CC_V, QREG_CC_V, tmp); tcg_temp_free(tmp); /* Copy the rest of the results into place. */ tcg_gen_or_i32(QREG_CC_Z, QREG_CC_Z, QREG_CC_N); /* !Z is sticky */ tcg_gen_mov_i32(QREG_CC_C, QREG_CC_X); set_cc_op(s, CC_OP_FLAGS); /* result is in QREG_CC_N */ } DISAS_INSN(subx_reg) { TCGv dest; TCGv src; int opsize; opsize = insn_opsize(insn); src = gen_extend(s, DREG(insn, 0), opsize, 1); dest = gen_extend(s, DREG(insn, 9), opsize, 1); gen_subx(s, src, dest, opsize); gen_partset_reg(opsize, DREG(insn, 9), QREG_CC_N); } DISAS_INSN(subx_mem) { TCGv src; TCGv addr_src; TCGv dest; TCGv addr_dest; int opsize; opsize = insn_opsize(insn); addr_src = AREG(insn, 0); tcg_gen_subi_i32(addr_src, addr_src, opsize_bytes(opsize)); src = gen_load(s, opsize, addr_src, 1, IS_USER(s)); addr_dest = AREG(insn, 9); tcg_gen_subi_i32(addr_dest, addr_dest, opsize_bytes(opsize)); dest = gen_load(s, opsize, addr_dest, 1, IS_USER(s)); gen_subx(s, src, dest, opsize); gen_store(s, opsize, addr_dest, QREG_CC_N, IS_USER(s)); tcg_temp_free(dest); tcg_temp_free(src); } DISAS_INSN(mov3q) { TCGv src; int val; val = (insn >> 9) & 7; if (val == 0) val = -1; src = tcg_const_i32(val); gen_logic_cc(s, src, OS_LONG); DEST_EA(env, insn, OS_LONG, src, NULL); tcg_temp_free(src); } DISAS_INSN(cmp) { TCGv src; TCGv reg; int opsize; opsize = insn_opsize(insn); SRC_EA(env, src, opsize, 1, NULL); reg = gen_extend(s, DREG(insn, 9), opsize, 1); gen_update_cc_cmp(s, reg, src, opsize); } DISAS_INSN(cmpa) { int opsize; TCGv src; TCGv reg; if (insn & 0x100) { opsize = OS_LONG; } else { opsize = OS_WORD; } SRC_EA(env, src, opsize, 1, NULL); reg = AREG(insn, 9); gen_update_cc_cmp(s, reg, src, OS_LONG); } DISAS_INSN(cmpm) { int opsize = insn_opsize(insn); TCGv src, dst; /* Post-increment load (mode 3) from Ay. */ src = gen_ea_mode(env, s, 3, REG(insn, 0), opsize, NULL_QREG, NULL, EA_LOADS, IS_USER(s)); /* Post-increment load (mode 3) from Ax. */ dst = gen_ea_mode(env, s, 3, REG(insn, 9), opsize, NULL_QREG, NULL, EA_LOADS, IS_USER(s)); gen_update_cc_cmp(s, dst, src, opsize); } DISAS_INSN(eor) { TCGv src; TCGv dest; TCGv addr; int opsize; opsize = insn_opsize(insn); SRC_EA(env, src, opsize, 0, &addr); dest = tcg_temp_new(); tcg_gen_xor_i32(dest, src, DREG(insn, 9)); gen_logic_cc(s, dest, opsize); DEST_EA(env, insn, opsize, dest, &addr); tcg_temp_free(dest); } static void do_exg(TCGv reg1, TCGv reg2) { TCGv temp = tcg_temp_new(); tcg_gen_mov_i32(temp, reg1); tcg_gen_mov_i32(reg1, reg2); tcg_gen_mov_i32(reg2, temp); tcg_temp_free(temp); } DISAS_INSN(exg_dd) { /* exchange Dx and Dy */ do_exg(DREG(insn, 9), DREG(insn, 0)); } DISAS_INSN(exg_aa) { /* exchange Ax and Ay */ do_exg(AREG(insn, 9), AREG(insn, 0)); } DISAS_INSN(exg_da) { /* exchange Dx and Ay */ do_exg(DREG(insn, 9), AREG(insn, 0)); } DISAS_INSN(and) { TCGv src; TCGv reg; TCGv dest; TCGv addr; int opsize; dest = tcg_temp_new(); opsize = insn_opsize(insn); reg = DREG(insn, 9); if (insn & 0x100) { SRC_EA(env, src, opsize, 0, &addr); tcg_gen_and_i32(dest, src, reg); DEST_EA(env, insn, opsize, dest, &addr); } else { SRC_EA(env, src, opsize, 0, NULL); tcg_gen_and_i32(dest, src, reg); gen_partset_reg(opsize, reg, dest); } gen_logic_cc(s, dest, opsize); tcg_temp_free(dest); } DISAS_INSN(adda) { TCGv src; TCGv reg; SRC_EA(env, src, (insn & 0x100) ? OS_LONG : OS_WORD, 1, NULL); reg = AREG(insn, 9); tcg_gen_add_i32(reg, reg, src); } static inline void gen_addx(DisasContext *s, TCGv src, TCGv dest, int opsize) { TCGv tmp; gen_flush_flags(s); /* compute old Z */ /* * Perform addition with carry. * (X, N) = src + dest + X; */ tmp = tcg_const_i32(0); tcg_gen_add2_i32(QREG_CC_N, QREG_CC_X, QREG_CC_X, tmp, dest, tmp); tcg_gen_add2_i32(QREG_CC_N, QREG_CC_X, QREG_CC_N, QREG_CC_X, src, tmp); gen_ext(QREG_CC_N, QREG_CC_N, opsize, 1); /* Compute signed-overflow for addition. */ tcg_gen_xor_i32(QREG_CC_V, QREG_CC_N, src); tcg_gen_xor_i32(tmp, dest, src); tcg_gen_andc_i32(QREG_CC_V, QREG_CC_V, tmp); tcg_temp_free(tmp); /* Copy the rest of the results into place. */ tcg_gen_or_i32(QREG_CC_Z, QREG_CC_Z, QREG_CC_N); /* !Z is sticky */ tcg_gen_mov_i32(QREG_CC_C, QREG_CC_X); set_cc_op(s, CC_OP_FLAGS); /* result is in QREG_CC_N */ } DISAS_INSN(addx_reg) { TCGv dest; TCGv src; int opsize; opsize = insn_opsize(insn); dest = gen_extend(s, DREG(insn, 9), opsize, 1); src = gen_extend(s, DREG(insn, 0), opsize, 1); gen_addx(s, src, dest, opsize); gen_partset_reg(opsize, DREG(insn, 9), QREG_CC_N); } DISAS_INSN(addx_mem) { TCGv src; TCGv addr_src; TCGv dest; TCGv addr_dest; int opsize; opsize = insn_opsize(insn); addr_src = AREG(insn, 0); tcg_gen_subi_i32(addr_src, addr_src, opsize_bytes(opsize)); src = gen_load(s, opsize, addr_src, 1, IS_USER(s)); addr_dest = AREG(insn, 9); tcg_gen_subi_i32(addr_dest, addr_dest, opsize_bytes(opsize)); dest = gen_load(s, opsize, addr_dest, 1, IS_USER(s)); gen_addx(s, src, dest, opsize); gen_store(s, opsize, addr_dest, QREG_CC_N, IS_USER(s)); tcg_temp_free(dest); tcg_temp_free(src); } static inline void shift_im(DisasContext *s, uint16_t insn, int opsize) { int count = (insn >> 9) & 7; int logical = insn & 8; int left = insn & 0x100; int bits = opsize_bytes(opsize) * 8; TCGv reg = gen_extend(s, DREG(insn, 0), opsize, !logical); if (count == 0) { count = 8; } tcg_gen_movi_i32(QREG_CC_V, 0); if (left) { tcg_gen_shri_i32(QREG_CC_C, reg, bits - count); tcg_gen_shli_i32(QREG_CC_N, reg, count); /* * Note that ColdFire always clears V (done above), * while M68000 sets if the most significant bit is changed at * any time during the shift operation. */ if (!logical && m68k_feature(s->env, M68K_FEATURE_M68K)) { /* if shift count >= bits, V is (reg != 0) */ if (count >= bits) { tcg_gen_setcond_i32(TCG_COND_NE, QREG_CC_V, reg, QREG_CC_V); } else { TCGv t0 = tcg_temp_new(); tcg_gen_sari_i32(QREG_CC_V, reg, bits - 1); tcg_gen_sari_i32(t0, reg, bits - count - 1); tcg_gen_setcond_i32(TCG_COND_NE, QREG_CC_V, QREG_CC_V, t0); tcg_temp_free(t0); } tcg_gen_neg_i32(QREG_CC_V, QREG_CC_V); } } else { tcg_gen_shri_i32(QREG_CC_C, reg, count - 1); if (logical) { tcg_gen_shri_i32(QREG_CC_N, reg, count); } else { tcg_gen_sari_i32(QREG_CC_N, reg, count); } } gen_ext(QREG_CC_N, QREG_CC_N, opsize, 1); tcg_gen_andi_i32(QREG_CC_C, QREG_CC_C, 1); tcg_gen_mov_i32(QREG_CC_Z, QREG_CC_N); tcg_gen_mov_i32(QREG_CC_X, QREG_CC_C); gen_partset_reg(opsize, DREG(insn, 0), QREG_CC_N); set_cc_op(s, CC_OP_FLAGS); } static inline void shift_reg(DisasContext *s, uint16_t insn, int opsize) { int logical = insn & 8; int left = insn & 0x100; int bits = opsize_bytes(opsize) * 8; TCGv reg = gen_extend(s, DREG(insn, 0), opsize, !logical); TCGv s32; TCGv_i64 t64, s64; t64 = tcg_temp_new_i64(); s64 = tcg_temp_new_i64(); s32 = tcg_temp_new(); /* * Note that m68k truncates the shift count modulo 64, not 32. * In addition, a 64-bit shift makes it easy to find "the last * bit shifted out", for the carry flag. */ tcg_gen_andi_i32(s32, DREG(insn, 9), 63); tcg_gen_extu_i32_i64(s64, s32); tcg_gen_extu_i32_i64(t64, reg); /* Optimistically set V=0. Also used as a zero source below. */ tcg_gen_movi_i32(QREG_CC_V, 0); if (left) { tcg_gen_shl_i64(t64, t64, s64); if (opsize == OS_LONG) { tcg_gen_extr_i64_i32(QREG_CC_N, QREG_CC_C, t64); /* Note that C=0 if shift count is 0, and we get that for free. */ } else { TCGv zero = tcg_const_i32(0); tcg_gen_extrl_i64_i32(QREG_CC_N, t64); tcg_gen_shri_i32(QREG_CC_C, QREG_CC_N, bits); tcg_gen_movcond_i32(TCG_COND_EQ, QREG_CC_C, s32, zero, zero, QREG_CC_C); tcg_temp_free(zero); } tcg_gen_andi_i32(QREG_CC_C, QREG_CC_C, 1); /* X = C, but only if the shift count was non-zero. */ tcg_gen_movcond_i32(TCG_COND_NE, QREG_CC_X, s32, QREG_CC_V, QREG_CC_C, QREG_CC_X); /* * M68000 sets V if the most significant bit is changed at * any time during the shift operation. Do this via creating * an extension of the sign bit, comparing, and discarding * the bits below the sign bit. I.e. * int64_t s = (intN_t)reg; * int64_t t = (int64_t)(intN_t)reg << count; * V = ((s ^ t) & (-1 << (bits - 1))) != 0 */ if (!logical && m68k_feature(s->env, M68K_FEATURE_M68K)) { TCGv_i64 tt = tcg_const_i64(32); /* if shift is greater than 32, use 32 */ tcg_gen_movcond_i64(TCG_COND_GT, s64, s64, tt, tt, s64); tcg_temp_free_i64(tt); /* Sign extend the input to 64 bits; re-do the shift. */ tcg_gen_ext_i32_i64(t64, reg); tcg_gen_shl_i64(s64, t64, s64); /* Clear all bits that are unchanged. */ tcg_gen_xor_i64(t64, t64, s64); /* Ignore the bits below the sign bit. */ tcg_gen_andi_i64(t64, t64, -1ULL << (bits - 1)); /* If any bits remain set, we have overflow. */ tcg_gen_setcondi_i64(TCG_COND_NE, t64, t64, 0); tcg_gen_extrl_i64_i32(QREG_CC_V, t64); tcg_gen_neg_i32(QREG_CC_V, QREG_CC_V); } } else { tcg_gen_shli_i64(t64, t64, 32); if (logical) { tcg_gen_shr_i64(t64, t64, s64); } else { tcg_gen_sar_i64(t64, t64, s64); } tcg_gen_extr_i64_i32(QREG_CC_C, QREG_CC_N, t64); /* Note that C=0 if shift count is 0, and we get that for free. */ tcg_gen_shri_i32(QREG_CC_C, QREG_CC_C, 31); /* X = C, but only if the shift count was non-zero. */ tcg_gen_movcond_i32(TCG_COND_NE, QREG_CC_X, s32, QREG_CC_V, QREG_CC_C, QREG_CC_X); } gen_ext(QREG_CC_N, QREG_CC_N, opsize, 1); tcg_gen_mov_i32(QREG_CC_Z, QREG_CC_N); tcg_temp_free(s32); tcg_temp_free_i64(s64); tcg_temp_free_i64(t64); /* Write back the result. */ gen_partset_reg(opsize, DREG(insn, 0), QREG_CC_N); set_cc_op(s, CC_OP_FLAGS); } DISAS_INSN(shift8_im) { shift_im(s, insn, OS_BYTE); } DISAS_INSN(shift16_im) { shift_im(s, insn, OS_WORD); } DISAS_INSN(shift_im) { shift_im(s, insn, OS_LONG); } DISAS_INSN(shift8_reg) { shift_reg(s, insn, OS_BYTE); } DISAS_INSN(shift16_reg) { shift_reg(s, insn, OS_WORD); } DISAS_INSN(shift_reg) { shift_reg(s, insn, OS_LONG); } DISAS_INSN(shift_mem) { int logical = insn & 8; int left = insn & 0x100; TCGv src; TCGv addr; SRC_EA(env, src, OS_WORD, !logical, &addr); tcg_gen_movi_i32(QREG_CC_V, 0); if (left) { tcg_gen_shri_i32(QREG_CC_C, src, 15); tcg_gen_shli_i32(QREG_CC_N, src, 1); /* * Note that ColdFire always clears V, * while M68000 sets if the most significant bit is changed at * any time during the shift operation */ if (!logical && m68k_feature(s->env, M68K_FEATURE_M68K)) { src = gen_extend(s, src, OS_WORD, 1); tcg_gen_xor_i32(QREG_CC_V, QREG_CC_N, src); } } else { tcg_gen_mov_i32(QREG_CC_C, src); if (logical) { tcg_gen_shri_i32(QREG_CC_N, src, 1); } else { tcg_gen_sari_i32(QREG_CC_N, src, 1); } } gen_ext(QREG_CC_N, QREG_CC_N, OS_WORD, 1); tcg_gen_andi_i32(QREG_CC_C, QREG_CC_C, 1); tcg_gen_mov_i32(QREG_CC_Z, QREG_CC_N); tcg_gen_mov_i32(QREG_CC_X, QREG_CC_C); DEST_EA(env, insn, OS_WORD, QREG_CC_N, &addr); set_cc_op(s, CC_OP_FLAGS); } static void rotate(TCGv reg, TCGv shift, int left, int size) { switch (size) { case 8: /* Replicate the 8-bit input so that a 32-bit rotate works. */ tcg_gen_ext8u_i32(reg, reg); tcg_gen_muli_i32(reg, reg, 0x01010101); goto do_long; case 16: /* Replicate the 16-bit input so that a 32-bit rotate works. */ tcg_gen_deposit_i32(reg, reg, reg, 16, 16); goto do_long; do_long: default: if (left) { tcg_gen_rotl_i32(reg, reg, shift); } else { tcg_gen_rotr_i32(reg, reg, shift); } } /* compute flags */ switch (size) { case 8: tcg_gen_ext8s_i32(reg, reg); break; case 16: tcg_gen_ext16s_i32(reg, reg); break; default: break; } /* QREG_CC_X is not affected */ tcg_gen_mov_i32(QREG_CC_N, reg); tcg_gen_mov_i32(QREG_CC_Z, reg); if (left) { tcg_gen_andi_i32(QREG_CC_C, reg, 1); } else { tcg_gen_shri_i32(QREG_CC_C, reg, 31); } tcg_gen_movi_i32(QREG_CC_V, 0); /* always cleared */ } static void rotate_x_flags(TCGv reg, TCGv X, int size) { switch (size) { case 8: tcg_gen_ext8s_i32(reg, reg); break; case 16: tcg_gen_ext16s_i32(reg, reg); break; default: break; } tcg_gen_mov_i32(QREG_CC_N, reg); tcg_gen_mov_i32(QREG_CC_Z, reg); tcg_gen_mov_i32(QREG_CC_X, X); tcg_gen_mov_i32(QREG_CC_C, X); tcg_gen_movi_i32(QREG_CC_V, 0); } /* Result of rotate_x() is valid if 0 <= shift <= size */ static TCGv rotate_x(TCGv reg, TCGv shift, int left, int size) { TCGv X, shl, shr, shx, sz, zero; sz = tcg_const_i32(size); shr = tcg_temp_new(); shl = tcg_temp_new(); shx = tcg_temp_new(); if (left) { tcg_gen_mov_i32(shl, shift); /* shl = shift */ tcg_gen_movi_i32(shr, size + 1); tcg_gen_sub_i32(shr, shr, shift); /* shr = size + 1 - shift */ tcg_gen_subi_i32(shx, shift, 1); /* shx = shift - 1 */ /* shx = shx < 0 ? size : shx; */ zero = tcg_const_i32(0); tcg_gen_movcond_i32(TCG_COND_LT, shx, shx, zero, sz, shx); tcg_temp_free(zero); } else { tcg_gen_mov_i32(shr, shift); /* shr = shift */ tcg_gen_movi_i32(shl, size + 1); tcg_gen_sub_i32(shl, shl, shift); /* shl = size + 1 - shift */ tcg_gen_sub_i32(shx, sz, shift); /* shx = size - shift */ } tcg_temp_free_i32(sz); /* reg = (reg << shl) | (reg >> shr) | (x << shx); */ tcg_gen_shl_i32(shl, reg, shl); tcg_gen_shr_i32(shr, reg, shr); tcg_gen_or_i32(reg, shl, shr); tcg_temp_free(shl); tcg_temp_free(shr); tcg_gen_shl_i32(shx, QREG_CC_X, shx); tcg_gen_or_i32(reg, reg, shx); tcg_temp_free(shx); /* X = (reg >> size) & 1 */ X = tcg_temp_new(); tcg_gen_extract_i32(X, reg, size, 1); return X; } /* Result of rotate32_x() is valid if 0 <= shift < 33 */ static TCGv rotate32_x(TCGv reg, TCGv shift, int left) { TCGv_i64 t0, shift64; TCGv X, lo, hi, zero; shift64 = tcg_temp_new_i64(); tcg_gen_extu_i32_i64(shift64, shift); t0 = tcg_temp_new_i64(); X = tcg_temp_new(); lo = tcg_temp_new(); hi = tcg_temp_new(); if (left) { /* create [reg:X:..] */ tcg_gen_shli_i32(lo, QREG_CC_X, 31); tcg_gen_concat_i32_i64(t0, lo, reg); /* rotate */ tcg_gen_rotl_i64(t0, t0, shift64); tcg_temp_free_i64(shift64); /* result is [reg:..:reg:X] */ tcg_gen_extr_i64_i32(lo, hi, t0); tcg_gen_andi_i32(X, lo, 1); tcg_gen_shri_i32(lo, lo, 1); } else { /* create [..:X:reg] */ tcg_gen_concat_i32_i64(t0, reg, QREG_CC_X); tcg_gen_rotr_i64(t0, t0, shift64); tcg_temp_free_i64(shift64); /* result is value: [X:reg:..:reg] */ tcg_gen_extr_i64_i32(lo, hi, t0); /* extract X */ tcg_gen_shri_i32(X, hi, 31); /* extract result */ tcg_gen_shli_i32(hi, hi, 1); } tcg_temp_free_i64(t0); tcg_gen_or_i32(lo, lo, hi); tcg_temp_free(hi); /* if shift == 0, register and X are not affected */ zero = tcg_const_i32(0); tcg_gen_movcond_i32(TCG_COND_EQ, X, shift, zero, QREG_CC_X, X); tcg_gen_movcond_i32(TCG_COND_EQ, reg, shift, zero, reg, lo); tcg_temp_free(zero); tcg_temp_free(lo); return X; } DISAS_INSN(rotate_im) { TCGv shift; int tmp; int left = (insn & 0x100); tmp = (insn >> 9) & 7; if (tmp == 0) { tmp = 8; } shift = tcg_const_i32(tmp); if (insn & 8) { rotate(DREG(insn, 0), shift, left, 32); } else { TCGv X = rotate32_x(DREG(insn, 0), shift, left); rotate_x_flags(DREG(insn, 0), X, 32); tcg_temp_free(X); } tcg_temp_free(shift); set_cc_op(s, CC_OP_FLAGS); } DISAS_INSN(rotate8_im) { int left = (insn & 0x100); TCGv reg; TCGv shift; int tmp; reg = gen_extend(s, DREG(insn, 0), OS_BYTE, 0); tmp = (insn >> 9) & 7; if (tmp == 0) { tmp = 8; } shift = tcg_const_i32(tmp); if (insn & 8) { rotate(reg, shift, left, 8); } else { TCGv X = rotate_x(reg, shift, left, 8); rotate_x_flags(reg, X, 8); tcg_temp_free(X); } tcg_temp_free(shift); gen_partset_reg(OS_BYTE, DREG(insn, 0), reg); set_cc_op(s, CC_OP_FLAGS); } DISAS_INSN(rotate16_im) { int left = (insn & 0x100); TCGv reg; TCGv shift; int tmp; reg = gen_extend(s, DREG(insn, 0), OS_WORD, 0); tmp = (insn >> 9) & 7; if (tmp == 0) { tmp = 8; } shift = tcg_const_i32(tmp); if (insn & 8) { rotate(reg, shift, left, 16); } else { TCGv X = rotate_x(reg, shift, left, 16); rotate_x_flags(reg, X, 16); tcg_temp_free(X); } tcg_temp_free(shift); gen_partset_reg(OS_WORD, DREG(insn, 0), reg); set_cc_op(s, CC_OP_FLAGS); } DISAS_INSN(rotate_reg) { TCGv reg; TCGv src; TCGv t0, t1; int left = (insn & 0x100); reg = DREG(insn, 0); src = DREG(insn, 9); /* shift in [0..63] */ t0 = tcg_temp_new(); tcg_gen_andi_i32(t0, src, 63); t1 = tcg_temp_new_i32(); if (insn & 8) { tcg_gen_andi_i32(t1, src, 31); rotate(reg, t1, left, 32); /* if shift == 0, clear C */ tcg_gen_movcond_i32(TCG_COND_EQ, QREG_CC_C, t0, QREG_CC_V /* 0 */, QREG_CC_V /* 0 */, QREG_CC_C); } else { TCGv X; /* modulo 33 */ tcg_gen_movi_i32(t1, 33); tcg_gen_remu_i32(t1, t0, t1); X = rotate32_x(DREG(insn, 0), t1, left); rotate_x_flags(DREG(insn, 0), X, 32); tcg_temp_free(X); } tcg_temp_free(t1); tcg_temp_free(t0); set_cc_op(s, CC_OP_FLAGS); } DISAS_INSN(rotate8_reg) { TCGv reg; TCGv src; TCGv t0, t1; int left = (insn & 0x100); reg = gen_extend(s, DREG(insn, 0), OS_BYTE, 0); src = DREG(insn, 9); /* shift in [0..63] */ t0 = tcg_temp_new_i32(); tcg_gen_andi_i32(t0, src, 63); t1 = tcg_temp_new_i32(); if (insn & 8) { tcg_gen_andi_i32(t1, src, 7); rotate(reg, t1, left, 8); /* if shift == 0, clear C */ tcg_gen_movcond_i32(TCG_COND_EQ, QREG_CC_C, t0, QREG_CC_V /* 0 */, QREG_CC_V /* 0 */, QREG_CC_C); } else { TCGv X; /* modulo 9 */ tcg_gen_movi_i32(t1, 9); tcg_gen_remu_i32(t1, t0, t1); X = rotate_x(reg, t1, left, 8); rotate_x_flags(reg, X, 8); tcg_temp_free(X); } tcg_temp_free(t1); tcg_temp_free(t0); gen_partset_reg(OS_BYTE, DREG(insn, 0), reg); set_cc_op(s, CC_OP_FLAGS); } DISAS_INSN(rotate16_reg) { TCGv reg; TCGv src; TCGv t0, t1; int left = (insn & 0x100); reg = gen_extend(s, DREG(insn, 0), OS_WORD, 0); src = DREG(insn, 9); /* shift in [0..63] */ t0 = tcg_temp_new_i32(); tcg_gen_andi_i32(t0, src, 63); t1 = tcg_temp_new_i32(); if (insn & 8) { tcg_gen_andi_i32(t1, src, 15); rotate(reg, t1, left, 16); /* if shift == 0, clear C */ tcg_gen_movcond_i32(TCG_COND_EQ, QREG_CC_C, t0, QREG_CC_V /* 0 */, QREG_CC_V /* 0 */, QREG_CC_C); } else { TCGv X; /* modulo 17 */ tcg_gen_movi_i32(t1, 17); tcg_gen_remu_i32(t1, t0, t1); X = rotate_x(reg, t1, left, 16); rotate_x_flags(reg, X, 16); tcg_temp_free(X); } tcg_temp_free(t1); tcg_temp_free(t0); gen_partset_reg(OS_WORD, DREG(insn, 0), reg); set_cc_op(s, CC_OP_FLAGS); } DISAS_INSN(rotate_mem) { TCGv src; TCGv addr; TCGv shift; int left = (insn & 0x100); SRC_EA(env, src, OS_WORD, 0, &addr); shift = tcg_const_i32(1); if (insn & 0x0200) { rotate(src, shift, left, 16); } else { TCGv X = rotate_x(src, shift, left, 16); rotate_x_flags(src, X, 16); tcg_temp_free(X); } tcg_temp_free(shift); DEST_EA(env, insn, OS_WORD, src, &addr); set_cc_op(s, CC_OP_FLAGS); } DISAS_INSN(bfext_reg) { int ext = read_im16(env, s); int is_sign = insn & 0x200; TCGv src = DREG(insn, 0); TCGv dst = DREG(ext, 12); int len = ((extract32(ext, 0, 5) - 1) & 31) + 1; int ofs = extract32(ext, 6, 5); /* big bit-endian */ int pos = 32 - ofs - len; /* little bit-endian */ TCGv tmp = tcg_temp_new(); TCGv shift; /* * In general, we're going to rotate the field so that it's at the * top of the word and then right-shift by the complement of the * width to extend the field. */ if (ext & 0x20) { /* Variable width. */ if (ext & 0x800) { /* Variable offset. */ tcg_gen_andi_i32(tmp, DREG(ext, 6), 31); tcg_gen_rotl_i32(tmp, src, tmp); } else { tcg_gen_rotli_i32(tmp, src, ofs); } shift = tcg_temp_new(); tcg_gen_neg_i32(shift, DREG(ext, 0)); tcg_gen_andi_i32(shift, shift, 31); tcg_gen_sar_i32(QREG_CC_N, tmp, shift); if (is_sign) { tcg_gen_mov_i32(dst, QREG_CC_N); } else { tcg_gen_shr_i32(dst, tmp, shift); } tcg_temp_free(shift); } else { /* Immediate width. */ if (ext & 0x800) { /* Variable offset */ tcg_gen_andi_i32(tmp, DREG(ext, 6), 31); tcg_gen_rotl_i32(tmp, src, tmp); src = tmp; pos = 32 - len; } else { /* * Immediate offset. If the field doesn't wrap around the * end of the word, rely on (s)extract completely. */ if (pos < 0) { tcg_gen_rotli_i32(tmp, src, ofs); src = tmp; pos = 32 - len; } } tcg_gen_sextract_i32(QREG_CC_N, src, pos, len); if (is_sign) { tcg_gen_mov_i32(dst, QREG_CC_N); } else { tcg_gen_extract_i32(dst, src, pos, len); } } tcg_temp_free(tmp); set_cc_op(s, CC_OP_LOGIC); } DISAS_INSN(bfext_mem) { int ext = read_im16(env, s); int is_sign = insn & 0x200; TCGv dest = DREG(ext, 12); TCGv addr, len, ofs; addr = gen_lea(env, s, insn, OS_UNSIZED); if (IS_NULL_QREG(addr)) { gen_addr_fault(s); return; } if (ext & 0x20) { len = DREG(ext, 0); } else { len = tcg_const_i32(extract32(ext, 0, 5)); } if (ext & 0x800) { ofs = DREG(ext, 6); } else { ofs = tcg_const_i32(extract32(ext, 6, 5)); } if (is_sign) { gen_helper_bfexts_mem(dest, cpu_env, addr, ofs, len); tcg_gen_mov_i32(QREG_CC_N, dest); } else { TCGv_i64 tmp = tcg_temp_new_i64(); gen_helper_bfextu_mem(tmp, cpu_env, addr, ofs, len); tcg_gen_extr_i64_i32(dest, QREG_CC_N, tmp); tcg_temp_free_i64(tmp); } set_cc_op(s, CC_OP_LOGIC); if (!(ext & 0x20)) { tcg_temp_free(len); } if (!(ext & 0x800)) { tcg_temp_free(ofs); } } DISAS_INSN(bfop_reg) { int ext = read_im16(env, s); TCGv src = DREG(insn, 0); int len = ((extract32(ext, 0, 5) - 1) & 31) + 1; int ofs = extract32(ext, 6, 5); /* big bit-endian */ TCGv mask, tofs, tlen; tofs = NULL; tlen = NULL; if ((insn & 0x0f00) == 0x0d00) { /* bfffo */ tofs = tcg_temp_new(); tlen = tcg_temp_new(); } if ((ext & 0x820) == 0) { /* Immediate width and offset. */ uint32_t maski = 0x7fffffffu >> (len - 1); if (ofs + len <= 32) { tcg_gen_shli_i32(QREG_CC_N, src, ofs); } else { tcg_gen_rotli_i32(QREG_CC_N, src, ofs); } tcg_gen_andi_i32(QREG_CC_N, QREG_CC_N, ~maski); mask = tcg_const_i32(ror32(maski, ofs)); if (tofs) { tcg_gen_movi_i32(tofs, ofs); tcg_gen_movi_i32(tlen, len); } } else { TCGv tmp = tcg_temp_new(); if (ext & 0x20) { /* Variable width */ tcg_gen_subi_i32(tmp, DREG(ext, 0), 1); tcg_gen_andi_i32(tmp, tmp, 31); mask = tcg_const_i32(0x7fffffffu); tcg_gen_shr_i32(mask, mask, tmp); if (tlen) { tcg_gen_addi_i32(tlen, tmp, 1); } } else { /* Immediate width */ mask = tcg_const_i32(0x7fffffffu >> (len - 1)); if (tlen) { tcg_gen_movi_i32(tlen, len); } } if (ext & 0x800) { /* Variable offset */ tcg_gen_andi_i32(tmp, DREG(ext, 6), 31); tcg_gen_rotl_i32(QREG_CC_N, src, tmp); tcg_gen_andc_i32(QREG_CC_N, QREG_CC_N, mask); tcg_gen_rotr_i32(mask, mask, tmp); if (tofs) { tcg_gen_mov_i32(tofs, tmp); } } else { /* Immediate offset (and variable width) */ tcg_gen_rotli_i32(QREG_CC_N, src, ofs); tcg_gen_andc_i32(QREG_CC_N, QREG_CC_N, mask); tcg_gen_rotri_i32(mask, mask, ofs); if (tofs) { tcg_gen_movi_i32(tofs, ofs); } } tcg_temp_free(tmp); } set_cc_op(s, CC_OP_LOGIC); switch (insn & 0x0f00) { case 0x0a00: /* bfchg */ tcg_gen_eqv_i32(src, src, mask); break; case 0x0c00: /* bfclr */ tcg_gen_and_i32(src, src, mask); break; case 0x0d00: /* bfffo */ gen_helper_bfffo_reg(DREG(ext, 12), QREG_CC_N, tofs, tlen); tcg_temp_free(tlen); tcg_temp_free(tofs); break; case 0x0e00: /* bfset */ tcg_gen_orc_i32(src, src, mask); break; case 0x0800: /* bftst */ /* flags already set; no other work to do. */ break; default: g_assert_not_reached(); } tcg_temp_free(mask); } DISAS_INSN(bfop_mem) { int ext = read_im16(env, s); TCGv addr, len, ofs; TCGv_i64 t64; addr = gen_lea(env, s, insn, OS_UNSIZED); if (IS_NULL_QREG(addr)) { gen_addr_fault(s); return; } if (ext & 0x20) { len = DREG(ext, 0); } else { len = tcg_const_i32(extract32(ext, 0, 5)); } if (ext & 0x800) { ofs = DREG(ext, 6); } else { ofs = tcg_const_i32(extract32(ext, 6, 5)); } switch (insn & 0x0f00) { case 0x0a00: /* bfchg */ gen_helper_bfchg_mem(QREG_CC_N, cpu_env, addr, ofs, len); break; case 0x0c00: /* bfclr */ gen_helper_bfclr_mem(QREG_CC_N, cpu_env, addr, ofs, len); break; case 0x0d00: /* bfffo */ t64 = tcg_temp_new_i64(); gen_helper_bfffo_mem(t64, cpu_env, addr, ofs, len); tcg_gen_extr_i64_i32(DREG(ext, 12), QREG_CC_N, t64); tcg_temp_free_i64(t64); break; case 0x0e00: /* bfset */ gen_helper_bfset_mem(QREG_CC_N, cpu_env, addr, ofs, len); break; case 0x0800: /* bftst */ gen_helper_bfexts_mem(QREG_CC_N, cpu_env, addr, ofs, len); break; default: g_assert_not_reached(); } set_cc_op(s, CC_OP_LOGIC); if (!(ext & 0x20)) { tcg_temp_free(len); } if (!(ext & 0x800)) { tcg_temp_free(ofs); } } DISAS_INSN(bfins_reg) { int ext = read_im16(env, s); TCGv dst = DREG(insn, 0); TCGv src = DREG(ext, 12); int len = ((extract32(ext, 0, 5) - 1) & 31) + 1; int ofs = extract32(ext, 6, 5); /* big bit-endian */ int pos = 32 - ofs - len; /* little bit-endian */ TCGv tmp; tmp = tcg_temp_new(); if (ext & 0x20) { /* Variable width */ tcg_gen_neg_i32(tmp, DREG(ext, 0)); tcg_gen_andi_i32(tmp, tmp, 31); tcg_gen_shl_i32(QREG_CC_N, src, tmp); } else { /* Immediate width */ tcg_gen_shli_i32(QREG_CC_N, src, 32 - len); } set_cc_op(s, CC_OP_LOGIC); /* Immediate width and offset */ if ((ext & 0x820) == 0) { /* Check for suitability for deposit. */ if (pos >= 0) { tcg_gen_deposit_i32(dst, dst, src, pos, len); } else { uint32_t maski = -2U << (len - 1); uint32_t roti = (ofs + len) & 31; tcg_gen_andi_i32(tmp, src, ~maski); tcg_gen_rotri_i32(tmp, tmp, roti); tcg_gen_andi_i32(dst, dst, ror32(maski, roti)); tcg_gen_or_i32(dst, dst, tmp); } } else { TCGv mask = tcg_temp_new(); TCGv rot = tcg_temp_new(); if (ext & 0x20) { /* Variable width */ tcg_gen_subi_i32(rot, DREG(ext, 0), 1); tcg_gen_andi_i32(rot, rot, 31); tcg_gen_movi_i32(mask, -2); tcg_gen_shl_i32(mask, mask, rot); tcg_gen_mov_i32(rot, DREG(ext, 0)); tcg_gen_andc_i32(tmp, src, mask); } else { /* Immediate width (variable offset) */ uint32_t maski = -2U << (len - 1); tcg_gen_andi_i32(tmp, src, ~maski); tcg_gen_movi_i32(mask, maski); tcg_gen_movi_i32(rot, len & 31); } if (ext & 0x800) { /* Variable offset */ tcg_gen_add_i32(rot, rot, DREG(ext, 6)); } else { /* Immediate offset (variable width) */ tcg_gen_addi_i32(rot, rot, ofs); } tcg_gen_andi_i32(rot, rot, 31); tcg_gen_rotr_i32(mask, mask, rot); tcg_gen_rotr_i32(tmp, tmp, rot); tcg_gen_and_i32(dst, dst, mask); tcg_gen_or_i32(dst, dst, tmp); tcg_temp_free(rot); tcg_temp_free(mask); } tcg_temp_free(tmp); } DISAS_INSN(bfins_mem) { int ext = read_im16(env, s); TCGv src = DREG(ext, 12); TCGv addr, len, ofs; addr = gen_lea(env, s, insn, OS_UNSIZED); if (IS_NULL_QREG(addr)) { gen_addr_fault(s); return; } if (ext & 0x20) { len = DREG(ext, 0); } else { len = tcg_const_i32(extract32(ext, 0, 5)); } if (ext & 0x800) { ofs = DREG(ext, 6); } else { ofs = tcg_const_i32(extract32(ext, 6, 5)); } gen_helper_bfins_mem(QREG_CC_N, cpu_env, addr, src, ofs, len); set_cc_op(s, CC_OP_LOGIC); if (!(ext & 0x20)) { tcg_temp_free(len); } if (!(ext & 0x800)) { tcg_temp_free(ofs); } } DISAS_INSN(ff1) { TCGv reg; reg = DREG(insn, 0); gen_logic_cc(s, reg, OS_LONG); gen_helper_ff1(reg, reg); } DISAS_INSN(chk) { TCGv src, reg; int opsize; switch ((insn >> 7) & 3) { case 3: opsize = OS_WORD; break; case 2: if (m68k_feature(env, M68K_FEATURE_CHK2)) { opsize = OS_LONG; break; } /* fallthru */ default: gen_exception(s, s->base.pc_next, EXCP_ILLEGAL); return; } SRC_EA(env, src, opsize, 1, NULL); reg = gen_extend(s, DREG(insn, 9), opsize, 1); gen_flush_flags(s); gen_helper_chk(cpu_env, reg, src); } DISAS_INSN(chk2) { uint16_t ext; TCGv addr1, addr2, bound1, bound2, reg; int opsize; switch ((insn >> 9) & 3) { case 0: opsize = OS_BYTE; break; case 1: opsize = OS_WORD; break; case 2: opsize = OS_LONG; break; default: gen_exception(s, s->base.pc_next, EXCP_ILLEGAL); return; } ext = read_im16(env, s); if ((ext & 0x0800) == 0) { gen_exception(s, s->base.pc_next, EXCP_ILLEGAL); return; } addr1 = gen_lea(env, s, insn, OS_UNSIZED); addr2 = tcg_temp_new(); tcg_gen_addi_i32(addr2, addr1, opsize_bytes(opsize)); bound1 = gen_load(s, opsize, addr1, 1, IS_USER(s)); tcg_temp_free(addr1); bound2 = gen_load(s, opsize, addr2, 1, IS_USER(s)); tcg_temp_free(addr2); reg = tcg_temp_new(); if (ext & 0x8000) { tcg_gen_mov_i32(reg, AREG(ext, 12)); } else { gen_ext(reg, DREG(ext, 12), opsize, 1); } gen_flush_flags(s); gen_helper_chk2(cpu_env, reg, bound1, bound2); tcg_temp_free(reg); tcg_temp_free(bound1); tcg_temp_free(bound2); } static void m68k_copy_line(TCGv dst, TCGv src, int index) { TCGv addr; TCGv_i64 t0, t1; addr = tcg_temp_new(); t0 = tcg_temp_new_i64(); t1 = tcg_temp_new_i64(); tcg_gen_andi_i32(addr, src, ~15); tcg_gen_qemu_ld64(t0, addr, index); tcg_gen_addi_i32(addr, addr, 8); tcg_gen_qemu_ld64(t1, addr, index); tcg_gen_andi_i32(addr, dst, ~15); tcg_gen_qemu_st64(t0, addr, index); tcg_gen_addi_i32(addr, addr, 8); tcg_gen_qemu_st64(t1, addr, index); tcg_temp_free_i64(t0); tcg_temp_free_i64(t1); tcg_temp_free(addr); } DISAS_INSN(move16_reg) { int index = IS_USER(s); TCGv tmp; uint16_t ext; ext = read_im16(env, s); if ((ext & (1 << 15)) == 0) { gen_exception(s, s->base.pc_next, EXCP_ILLEGAL); } m68k_copy_line(AREG(ext, 12), AREG(insn, 0), index); /* Ax can be Ay, so save Ay before incrementing Ax */ tmp = tcg_temp_new(); tcg_gen_mov_i32(tmp, AREG(ext, 12)); tcg_gen_addi_i32(AREG(insn, 0), AREG(insn, 0), 16); tcg_gen_addi_i32(AREG(ext, 12), tmp, 16); tcg_temp_free(tmp); } DISAS_INSN(move16_mem) { int index = IS_USER(s); TCGv reg, addr; reg = AREG(insn, 0); addr = tcg_const_i32(read_im32(env, s)); if ((insn >> 3) & 1) { /* MOVE16 (xxx).L, (Ay) */ m68k_copy_line(reg, addr, index); } else { /* MOVE16 (Ay), (xxx).L */ m68k_copy_line(addr, reg, index); } tcg_temp_free(addr); if (((insn >> 3) & 2) == 0) { /* (Ay)+ */ tcg_gen_addi_i32(reg, reg, 16); } } DISAS_INSN(strldsr) { uint16_t ext; uint32_t addr; addr = s->pc - 2; ext = read_im16(env, s); if (ext != 0x46FC) { gen_exception(s, addr, EXCP_ILLEGAL); return; } ext = read_im16(env, s); if (IS_USER(s) || (ext & SR_S) == 0) { gen_exception(s, addr, EXCP_PRIVILEGE); return; } gen_push(s, gen_get_sr(s)); gen_set_sr_im(s, ext, 0); gen_exit_tb(s); } DISAS_INSN(move_from_sr) { TCGv sr; if (IS_USER(s) && m68k_feature(env, M68K_FEATURE_MOVEFROMSR_PRIV)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } sr = gen_get_sr(s); DEST_EA(env, insn, OS_WORD, sr, NULL); } #if defined(CONFIG_SOFTMMU) DISAS_INSN(moves) { int opsize; uint16_t ext; TCGv reg; TCGv addr; int extend; if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } ext = read_im16(env, s); opsize = insn_opsize(insn); if (ext & 0x8000) { /* address register */ reg = AREG(ext, 12); extend = 1; } else { /* data register */ reg = DREG(ext, 12); extend = 0; } addr = gen_lea(env, s, insn, opsize); if (IS_NULL_QREG(addr)) { gen_addr_fault(s); return; } if (ext & 0x0800) { /* from reg to ea */ gen_store(s, opsize, addr, reg, DFC_INDEX(s)); } else { /* from ea to reg */ TCGv tmp = gen_load(s, opsize, addr, 0, SFC_INDEX(s)); if (extend) { gen_ext(reg, tmp, opsize, 1); } else { gen_partset_reg(opsize, reg, tmp); } tcg_temp_free(tmp); } switch (extract32(insn, 3, 3)) { case 3: /* Indirect postincrement. */ tcg_gen_addi_i32(AREG(insn, 0), addr, REG(insn, 0) == 7 && opsize == OS_BYTE ? 2 : opsize_bytes(opsize)); break; case 4: /* Indirect predecrememnt. */ tcg_gen_mov_i32(AREG(insn, 0), addr); break; } } DISAS_INSN(move_to_sr) { if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } gen_move_to_sr(env, s, insn, false); gen_exit_tb(s); } DISAS_INSN(move_from_usp) { if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } tcg_gen_ld_i32(AREG(insn, 0), cpu_env, offsetof(CPUM68KState, sp[M68K_USP])); } DISAS_INSN(move_to_usp) { if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } tcg_gen_st_i32(AREG(insn, 0), cpu_env, offsetof(CPUM68KState, sp[M68K_USP])); } DISAS_INSN(halt) { if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } gen_exception(s, s->pc, EXCP_HALT_INSN); } DISAS_INSN(stop) { uint16_t ext; if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } ext = read_im16(env, s); gen_set_sr_im(s, ext, 0); tcg_gen_movi_i32(cpu_halted, 1); gen_exception(s, s->pc, EXCP_HLT); } DISAS_INSN(rte) { if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } gen_exception(s, s->base.pc_next, EXCP_RTE); } DISAS_INSN(cf_movec) { uint16_t ext; TCGv reg; if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } ext = read_im16(env, s); if (ext & 0x8000) { reg = AREG(ext, 12); } else { reg = DREG(ext, 12); } gen_helper_cf_movec_to(cpu_env, tcg_const_i32(ext & 0xfff), reg); gen_exit_tb(s); } DISAS_INSN(m68k_movec) { uint16_t ext; TCGv reg; if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } ext = read_im16(env, s); if (ext & 0x8000) { reg = AREG(ext, 12); } else { reg = DREG(ext, 12); } if (insn & 1) { gen_helper_m68k_movec_to(cpu_env, tcg_const_i32(ext & 0xfff), reg); } else { gen_helper_m68k_movec_from(reg, cpu_env, tcg_const_i32(ext & 0xfff)); } gen_exit_tb(s); } DISAS_INSN(intouch) { if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } /* ICache fetch. Implement as no-op. */ } DISAS_INSN(cpushl) { if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } /* Cache push/invalidate. Implement as no-op. */ } DISAS_INSN(cpush) { if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } /* Cache push/invalidate. Implement as no-op. */ } DISAS_INSN(cinv) { if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } /* Invalidate cache line. Implement as no-op. */ } #if defined(CONFIG_SOFTMMU) DISAS_INSN(pflush) { TCGv opmode; if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } opmode = tcg_const_i32((insn >> 3) & 3); gen_helper_pflush(cpu_env, AREG(insn, 0), opmode); tcg_temp_free(opmode); } DISAS_INSN(ptest) { TCGv is_read; if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } is_read = tcg_const_i32((insn >> 5) & 1); gen_helper_ptest(cpu_env, AREG(insn, 0), is_read); tcg_temp_free(is_read); } #endif DISAS_INSN(wddata) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); } DISAS_INSN(wdebug) { if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } /* TODO: Implement wdebug. */ cpu_abort(env_cpu(env), "WDEBUG not implemented"); } #endif DISAS_INSN(trap) { gen_exception(s, s->pc, EXCP_TRAP0 + (insn & 0xf)); } static void do_trapcc(DisasContext *s, DisasCompare *c) { if (c->tcond != TCG_COND_NEVER) { TCGLabel *over = NULL; update_cc_op(s); if (c->tcond != TCG_COND_ALWAYS) { /* Jump over if !c. */ over = gen_new_label(); tcg_gen_brcond_i32(tcg_invert_cond(c->tcond), c->v1, c->v2, over); } tcg_gen_movi_i32(QREG_PC, s->pc); gen_raise_exception_format2(s, EXCP_TRAPCC, s->base.pc_next); if (over != NULL) { gen_set_label(over); s->base.is_jmp = DISAS_NEXT; } } free_cond(c); } DISAS_INSN(trapcc) { DisasCompare c; /* Consume and discard the immediate operand. */ switch (extract32(insn, 0, 3)) { case 2: /* trapcc.w */ (void)read_im16(env, s); break; case 3: /* trapcc.l */ (void)read_im32(env, s); break; case 4: /* trapcc (no operand) */ break; default: /* trapcc registered with only valid opmodes */ g_assert_not_reached(); } gen_cc_cond(&c, s, extract32(insn, 8, 4)); do_trapcc(s, &c); } DISAS_INSN(trapv) { DisasCompare c; gen_cc_cond(&c, s, 9); /* V set */ do_trapcc(s, &c); } static void gen_load_fcr(DisasContext *s, TCGv res, int reg) { switch (reg) { case M68K_FPIAR: tcg_gen_movi_i32(res, 0); break; case M68K_FPSR: tcg_gen_ld_i32(res, cpu_env, offsetof(CPUM68KState, fpsr)); break; case M68K_FPCR: tcg_gen_ld_i32(res, cpu_env, offsetof(CPUM68KState, fpcr)); break; } } static void gen_store_fcr(DisasContext *s, TCGv val, int reg) { switch (reg) { case M68K_FPIAR: break; case M68K_FPSR: tcg_gen_st_i32(val, cpu_env, offsetof(CPUM68KState, fpsr)); break; case M68K_FPCR: gen_helper_set_fpcr(cpu_env, val); break; } } static void gen_qemu_store_fcr(DisasContext *s, TCGv addr, int reg) { int index = IS_USER(s); TCGv tmp; tmp = tcg_temp_new(); gen_load_fcr(s, tmp, reg); tcg_gen_qemu_st32(tmp, addr, index); tcg_temp_free(tmp); } static void gen_qemu_load_fcr(DisasContext *s, TCGv addr, int reg) { int index = IS_USER(s); TCGv tmp; tmp = tcg_temp_new(); tcg_gen_qemu_ld32u(tmp, addr, index); gen_store_fcr(s, tmp, reg); tcg_temp_free(tmp); } static void gen_op_fmove_fcr(CPUM68KState *env, DisasContext *s, uint32_t insn, uint32_t ext) { int mask = (ext >> 10) & 7; int is_write = (ext >> 13) & 1; int mode = extract32(insn, 3, 3); int i; TCGv addr, tmp; switch (mode) { case 0: /* Dn */ if (mask != M68K_FPIAR && mask != M68K_FPSR && mask != M68K_FPCR) { gen_exception(s, s->base.pc_next, EXCP_ILLEGAL); return; } if (is_write) { gen_load_fcr(s, DREG(insn, 0), mask); } else { gen_store_fcr(s, DREG(insn, 0), mask); } return; case 1: /* An, only with FPIAR */ if (mask != M68K_FPIAR) { gen_exception(s, s->base.pc_next, EXCP_ILLEGAL); return; } if (is_write) { gen_load_fcr(s, AREG(insn, 0), mask); } else { gen_store_fcr(s, AREG(insn, 0), mask); } return; case 7: /* Immediate */ if (REG(insn, 0) == 4) { if (is_write || (mask != M68K_FPIAR && mask != M68K_FPSR && mask != M68K_FPCR)) { gen_exception(s, s->base.pc_next, EXCP_ILLEGAL); return; } tmp = tcg_const_i32(read_im32(env, s)); gen_store_fcr(s, tmp, mask); tcg_temp_free(tmp); return; } break; default: break; } tmp = gen_lea(env, s, insn, OS_LONG); if (IS_NULL_QREG(tmp)) { gen_addr_fault(s); return; } addr = tcg_temp_new(); tcg_gen_mov_i32(addr, tmp); /* * mask: * * 0b100 Floating-Point Control Register * 0b010 Floating-Point Status Register * 0b001 Floating-Point Instruction Address Register * */ if (is_write && mode == 4) { for (i = 2; i >= 0; i--, mask >>= 1) { if (mask & 1) { gen_qemu_store_fcr(s, addr, 1 << i); if (mask != 1) { tcg_gen_subi_i32(addr, addr, opsize_bytes(OS_LONG)); } } } tcg_gen_mov_i32(AREG(insn, 0), addr); } else { for (i = 0; i < 3; i++, mask >>= 1) { if (mask & 1) { if (is_write) { gen_qemu_store_fcr(s, addr, 1 << i); } else { gen_qemu_load_fcr(s, addr, 1 << i); } if (mask != 1 || mode == 3) { tcg_gen_addi_i32(addr, addr, opsize_bytes(OS_LONG)); } } } if (mode == 3) { tcg_gen_mov_i32(AREG(insn, 0), addr); } } tcg_temp_free_i32(addr); } static void gen_op_fmovem(CPUM68KState *env, DisasContext *s, uint32_t insn, uint32_t ext) { int opsize; TCGv addr, tmp; int mode = (ext >> 11) & 0x3; int is_load = ((ext & 0x2000) == 0); if (m68k_feature(s->env, M68K_FEATURE_FPU)) { opsize = OS_EXTENDED; } else { opsize = OS_DOUBLE; /* FIXME */ } addr = gen_lea(env, s, insn, opsize); if (IS_NULL_QREG(addr)) { gen_addr_fault(s); return; } tmp = tcg_temp_new(); if (mode & 0x1) { /* Dynamic register list */ tcg_gen_ext8u_i32(tmp, DREG(ext, 4)); } else { /* Static register list */ tcg_gen_movi_i32(tmp, ext & 0xff); } if (!is_load && (mode & 2) == 0) { /* * predecrement addressing mode * only available to store register to memory */ if (opsize == OS_EXTENDED) { gen_helper_fmovemx_st_predec(tmp, cpu_env, addr, tmp); } else { gen_helper_fmovemd_st_predec(tmp, cpu_env, addr, tmp); } } else { /* postincrement addressing mode */ if (opsize == OS_EXTENDED) { if (is_load) { gen_helper_fmovemx_ld_postinc(tmp, cpu_env, addr, tmp); } else { gen_helper_fmovemx_st_postinc(tmp, cpu_env, addr, tmp); } } else { if (is_load) { gen_helper_fmovemd_ld_postinc(tmp, cpu_env, addr, tmp); } else { gen_helper_fmovemd_st_postinc(tmp, cpu_env, addr, tmp); } } } if ((insn & 070) == 030 || (insn & 070) == 040) { tcg_gen_mov_i32(AREG(insn, 0), tmp); } tcg_temp_free(tmp); } /* * ??? FP exceptions are not implemented. Most exceptions are deferred until * immediately before the next FP instruction is executed. */ DISAS_INSN(fpu) { uint16_t ext; int opmode; int opsize; TCGv_ptr cpu_src, cpu_dest; ext = read_im16(env, s); opmode = ext & 0x7f; switch ((ext >> 13) & 7) { case 0: break; case 1: goto undef; case 2: if (insn == 0xf200 && (ext & 0xfc00) == 0x5c00) { /* fmovecr */ TCGv rom_offset = tcg_const_i32(opmode); cpu_dest = gen_fp_ptr(REG(ext, 7)); gen_helper_fconst(cpu_env, cpu_dest, rom_offset); tcg_temp_free_ptr(cpu_dest); tcg_temp_free(rom_offset); return; } break; case 3: /* fmove out */ cpu_src = gen_fp_ptr(REG(ext, 7)); opsize = ext_opsize(ext, 10); if (gen_ea_fp(env, s, insn, opsize, cpu_src, EA_STORE, IS_USER(s)) == -1) { gen_addr_fault(s); } gen_helper_ftst(cpu_env, cpu_src); tcg_temp_free_ptr(cpu_src); return; case 4: /* fmove to control register. */ case 5: /* fmove from control register. */ gen_op_fmove_fcr(env, s, insn, ext); return; case 6: /* fmovem */ case 7: if ((ext & 0x1000) == 0 && !m68k_feature(s->env, M68K_FEATURE_FPU)) { goto undef; } gen_op_fmovem(env, s, insn, ext); return; } if (ext & (1 << 14)) { /* Source effective address. */ opsize = ext_opsize(ext, 10); cpu_src = gen_fp_result_ptr(); if (gen_ea_fp(env, s, insn, opsize, cpu_src, EA_LOADS, IS_USER(s)) == -1) { gen_addr_fault(s); return; } } else { /* Source register. */ opsize = OS_EXTENDED; cpu_src = gen_fp_ptr(REG(ext, 10)); } cpu_dest = gen_fp_ptr(REG(ext, 7)); switch (opmode) { case 0: /* fmove */ gen_fp_move(cpu_dest, cpu_src); break; case 0x40: /* fsmove */ gen_helper_fsround(cpu_env, cpu_dest, cpu_src); break; case 0x44: /* fdmove */ gen_helper_fdround(cpu_env, cpu_dest, cpu_src); break; case 1: /* fint */ gen_helper_firound(cpu_env, cpu_dest, cpu_src); break; case 2: /* fsinh */ gen_helper_fsinh(cpu_env, cpu_dest, cpu_src); break; case 3: /* fintrz */ gen_helper_fitrunc(cpu_env, cpu_dest, cpu_src); break; case 4: /* fsqrt */ gen_helper_fsqrt(cpu_env, cpu_dest, cpu_src); break; case 0x41: /* fssqrt */ gen_helper_fssqrt(cpu_env, cpu_dest, cpu_src); break; case 0x45: /* fdsqrt */ gen_helper_fdsqrt(cpu_env, cpu_dest, cpu_src); break; case 0x06: /* flognp1 */ gen_helper_flognp1(cpu_env, cpu_dest, cpu_src); break; case 0x08: /* fetoxm1 */ gen_helper_fetoxm1(cpu_env, cpu_dest, cpu_src); break; case 0x09: /* ftanh */ gen_helper_ftanh(cpu_env, cpu_dest, cpu_src); break; case 0x0a: /* fatan */ gen_helper_fatan(cpu_env, cpu_dest, cpu_src); break; case 0x0c: /* fasin */ gen_helper_fasin(cpu_env, cpu_dest, cpu_src); break; case 0x0d: /* fatanh */ gen_helper_fatanh(cpu_env, cpu_dest, cpu_src); break; case 0x0e: /* fsin */ gen_helper_fsin(cpu_env, cpu_dest, cpu_src); break; case 0x0f: /* ftan */ gen_helper_ftan(cpu_env, cpu_dest, cpu_src); break; case 0x10: /* fetox */ gen_helper_fetox(cpu_env, cpu_dest, cpu_src); break; case 0x11: /* ftwotox */ gen_helper_ftwotox(cpu_env, cpu_dest, cpu_src); break; case 0x12: /* ftentox */ gen_helper_ftentox(cpu_env, cpu_dest, cpu_src); break; case 0x14: /* flogn */ gen_helper_flogn(cpu_env, cpu_dest, cpu_src); break; case 0x15: /* flog10 */ gen_helper_flog10(cpu_env, cpu_dest, cpu_src); break; case 0x16: /* flog2 */ gen_helper_flog2(cpu_env, cpu_dest, cpu_src); break; case 0x18: /* fabs */ gen_helper_fabs(cpu_env, cpu_dest, cpu_src); break; case 0x58: /* fsabs */ gen_helper_fsabs(cpu_env, cpu_dest, cpu_src); break; case 0x5c: /* fdabs */ gen_helper_fdabs(cpu_env, cpu_dest, cpu_src); break; case 0x19: /* fcosh */ gen_helper_fcosh(cpu_env, cpu_dest, cpu_src); break; case 0x1a: /* fneg */ gen_helper_fneg(cpu_env, cpu_dest, cpu_src); break; case 0x5a: /* fsneg */ gen_helper_fsneg(cpu_env, cpu_dest, cpu_src); break; case 0x5e: /* fdneg */ gen_helper_fdneg(cpu_env, cpu_dest, cpu_src); break; case 0x1c: /* facos */ gen_helper_facos(cpu_env, cpu_dest, cpu_src); break; case 0x1d: /* fcos */ gen_helper_fcos(cpu_env, cpu_dest, cpu_src); break; case 0x1e: /* fgetexp */ gen_helper_fgetexp(cpu_env, cpu_dest, cpu_src); break; case 0x1f: /* fgetman */ gen_helper_fgetman(cpu_env, cpu_dest, cpu_src); break; case 0x20: /* fdiv */ gen_helper_fdiv(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x60: /* fsdiv */ gen_helper_fsdiv(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x64: /* fddiv */ gen_helper_fddiv(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x21: /* fmod */ gen_helper_fmod(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x22: /* fadd */ gen_helper_fadd(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x62: /* fsadd */ gen_helper_fsadd(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x66: /* fdadd */ gen_helper_fdadd(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x23: /* fmul */ gen_helper_fmul(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x63: /* fsmul */ gen_helper_fsmul(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x67: /* fdmul */ gen_helper_fdmul(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x24: /* fsgldiv */ gen_helper_fsgldiv(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x25: /* frem */ gen_helper_frem(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x26: /* fscale */ gen_helper_fscale(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x27: /* fsglmul */ gen_helper_fsglmul(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x28: /* fsub */ gen_helper_fsub(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x68: /* fssub */ gen_helper_fssub(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x6c: /* fdsub */ gen_helper_fdsub(cpu_env, cpu_dest, cpu_src, cpu_dest); break; case 0x30: case 0x31: case 0x32: case 0x33: case 0x34: case 0x35: case 0x36: case 0x37: { TCGv_ptr cpu_dest2 = gen_fp_ptr(REG(ext, 0)); gen_helper_fsincos(cpu_env, cpu_dest, cpu_dest2, cpu_src); tcg_temp_free_ptr(cpu_dest2); } break; case 0x38: /* fcmp */ gen_helper_fcmp(cpu_env, cpu_src, cpu_dest); return; case 0x3a: /* ftst */ gen_helper_ftst(cpu_env, cpu_src); return; default: goto undef; } tcg_temp_free_ptr(cpu_src); gen_helper_ftst(cpu_env, cpu_dest); tcg_temp_free_ptr(cpu_dest); return; undef: /* FIXME: Is this right for offset addressing modes? */ s->pc -= 2; disas_undef_fpu(env, s, insn); } static void gen_fcc_cond(DisasCompare *c, DisasContext *s, int cond) { TCGv fpsr; c->g1 = 1; c->v2 = tcg_const_i32(0); c->g2 = 0; /* TODO: Raise BSUN exception. */ fpsr = tcg_temp_new(); gen_load_fcr(s, fpsr, M68K_FPSR); switch (cond) { case 0: /* False */ case 16: /* Signaling False */ c->v1 = c->v2; c->tcond = TCG_COND_NEVER; break; case 1: /* EQual Z */ case 17: /* Signaling EQual Z */ c->v1 = tcg_temp_new(); c->g1 = 0; tcg_gen_andi_i32(c->v1, fpsr, FPSR_CC_Z); c->tcond = TCG_COND_NE; break; case 2: /* Ordered Greater Than !(A || Z || N) */ case 18: /* Greater Than !(A || Z || N) */ c->v1 = tcg_temp_new(); c->g1 = 0; tcg_gen_andi_i32(c->v1, fpsr, FPSR_CC_A | FPSR_CC_Z | FPSR_CC_N); c->tcond = TCG_COND_EQ; break; case 3: /* Ordered Greater than or Equal Z || !(A || N) */ case 19: /* Greater than or Equal Z || !(A || N) */ c->v1 = tcg_temp_new(); c->g1 = 0; tcg_gen_andi_i32(c->v1, fpsr, FPSR_CC_A); tcg_gen_shli_i32(c->v1, c->v1, ctz32(FPSR_CC_N) - ctz32(FPSR_CC_A)); tcg_gen_andi_i32(fpsr, fpsr, FPSR_CC_Z | FPSR_CC_N); tcg_gen_or_i32(c->v1, c->v1, fpsr); tcg_gen_xori_i32(c->v1, c->v1, FPSR_CC_N); c->tcond = TCG_COND_NE; break; case 4: /* Ordered Less Than !(!N || A || Z); */ case 20: /* Less Than !(!N || A || Z); */ c->v1 = tcg_temp_new(); c->g1 = 0; tcg_gen_xori_i32(c->v1, fpsr, FPSR_CC_N); tcg_gen_andi_i32(c->v1, c->v1, FPSR_CC_N | FPSR_CC_A | FPSR_CC_Z); c->tcond = TCG_COND_EQ; break; case 5: /* Ordered Less than or Equal Z || (N && !A) */ case 21: /* Less than or Equal Z || (N && !A) */ c->v1 = tcg_temp_new(); c->g1 = 0; tcg_gen_andi_i32(c->v1, fpsr, FPSR_CC_A); tcg_gen_shli_i32(c->v1, c->v1, ctz32(FPSR_CC_N) - ctz32(FPSR_CC_A)); tcg_gen_andc_i32(c->v1, fpsr, c->v1); tcg_gen_andi_i32(c->v1, c->v1, FPSR_CC_Z | FPSR_CC_N); c->tcond = TCG_COND_NE; break; case 6: /* Ordered Greater or Less than !(A || Z) */ case 22: /* Greater or Less than !(A || Z) */ c->v1 = tcg_temp_new(); c->g1 = 0; tcg_gen_andi_i32(c->v1, fpsr, FPSR_CC_A | FPSR_CC_Z); c->tcond = TCG_COND_EQ; break; case 7: /* Ordered !A */ case 23: /* Greater, Less or Equal !A */ c->v1 = tcg_temp_new(); c->g1 = 0; tcg_gen_andi_i32(c->v1, fpsr, FPSR_CC_A); c->tcond = TCG_COND_EQ; break; case 8: /* Unordered A */ case 24: /* Not Greater, Less or Equal A */ c->v1 = tcg_temp_new(); c->g1 = 0; tcg_gen_andi_i32(c->v1, fpsr, FPSR_CC_A); c->tcond = TCG_COND_NE; break; case 9: /* Unordered or Equal A || Z */ case 25: /* Not Greater or Less then A || Z */ c->v1 = tcg_temp_new(); c->g1 = 0; tcg_gen_andi_i32(c->v1, fpsr, FPSR_CC_A | FPSR_CC_Z); c->tcond = TCG_COND_NE; break; case 10: /* Unordered or Greater Than A || !(N || Z)) */ case 26: /* Not Less or Equal A || !(N || Z)) */ c->v1 = tcg_temp_new(); c->g1 = 0; tcg_gen_andi_i32(c->v1, fpsr, FPSR_CC_Z); tcg_gen_shli_i32(c->v1, c->v1, ctz32(FPSR_CC_N) - ctz32(FPSR_CC_Z)); tcg_gen_andi_i32(fpsr, fpsr, FPSR_CC_A | FPSR_CC_N); tcg_gen_or_i32(c->v1, c->v1, fpsr); tcg_gen_xori_i32(c->v1, c->v1, FPSR_CC_N); c->tcond = TCG_COND_NE; break; case 11: /* Unordered or Greater or Equal A || Z || !N */ case 27: /* Not Less Than A || Z || !N */ c->v1 = tcg_temp_new(); c->g1 = 0; tcg_gen_andi_i32(c->v1, fpsr, FPSR_CC_A | FPSR_CC_Z | FPSR_CC_N); tcg_gen_xori_i32(c->v1, c->v1, FPSR_CC_N); c->tcond = TCG_COND_NE; break; case 12: /* Unordered or Less Than A || (N && !Z) */ case 28: /* Not Greater than or Equal A || (N && !Z) */ c->v1 = tcg_temp_new(); c->g1 = 0; tcg_gen_andi_i32(c->v1, fpsr, FPSR_CC_Z); tcg_gen_shli_i32(c->v1, c->v1, ctz32(FPSR_CC_N) - ctz32(FPSR_CC_Z)); tcg_gen_andc_i32(c->v1, fpsr, c->v1); tcg_gen_andi_i32(c->v1, c->v1, FPSR_CC_A | FPSR_CC_N); c->tcond = TCG_COND_NE; break; case 13: /* Unordered or Less or Equal A || Z || N */ case 29: /* Not Greater Than A || Z || N */ c->v1 = tcg_temp_new(); c->g1 = 0; tcg_gen_andi_i32(c->v1, fpsr, FPSR_CC_A | FPSR_CC_Z | FPSR_CC_N); c->tcond = TCG_COND_NE; break; case 14: /* Not Equal !Z */ case 30: /* Signaling Not Equal !Z */ c->v1 = tcg_temp_new(); c->g1 = 0; tcg_gen_andi_i32(c->v1, fpsr, FPSR_CC_Z); c->tcond = TCG_COND_EQ; break; case 15: /* True */ case 31: /* Signaling True */ c->v1 = c->v2; c->tcond = TCG_COND_ALWAYS; break; } tcg_temp_free(fpsr); } static void gen_fjmpcc(DisasContext *s, int cond, TCGLabel *l1) { DisasCompare c; gen_fcc_cond(&c, s, cond); update_cc_op(s); tcg_gen_brcond_i32(c.tcond, c.v1, c.v2, l1); free_cond(&c); } DISAS_INSN(fbcc) { uint32_t offset; uint32_t base; TCGLabel *l1; base = s->pc; offset = (int16_t)read_im16(env, s); if (insn & (1 << 6)) { offset = (offset << 16) | read_im16(env, s); } l1 = gen_new_label(); update_cc_op(s); gen_fjmpcc(s, insn & 0x3f, l1); gen_jmp_tb(s, 0, s->pc, s->base.pc_next); gen_set_label(l1); gen_jmp_tb(s, 1, base + offset, s->base.pc_next); } DISAS_INSN(fscc) { DisasCompare c; int cond; TCGv tmp; uint16_t ext; ext = read_im16(env, s); cond = ext & 0x3f; gen_fcc_cond(&c, s, cond); tmp = tcg_temp_new(); tcg_gen_setcond_i32(c.tcond, tmp, c.v1, c.v2); free_cond(&c); tcg_gen_neg_i32(tmp, tmp); DEST_EA(env, insn, OS_BYTE, tmp, NULL); tcg_temp_free(tmp); } DISAS_INSN(ftrapcc) { DisasCompare c; uint16_t ext; int cond; ext = read_im16(env, s); cond = ext & 0x3f; /* Consume and discard the immediate operand. */ switch (extract32(insn, 0, 3)) { case 2: /* ftrapcc.w */ (void)read_im16(env, s); break; case 3: /* ftrapcc.l */ (void)read_im32(env, s); break; case 4: /* ftrapcc (no operand) */ break; default: /* ftrapcc registered with only valid opmodes */ g_assert_not_reached(); } gen_fcc_cond(&c, s, cond); do_trapcc(s, &c); } #if defined(CONFIG_SOFTMMU) DISAS_INSN(frestore) { TCGv addr; if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } if (m68k_feature(s->env, M68K_FEATURE_M68040)) { SRC_EA(env, addr, OS_LONG, 0, NULL); /* FIXME: check the state frame */ } else { disas_undef(env, s, insn); } } DISAS_INSN(fsave) { if (IS_USER(s)) { gen_exception(s, s->base.pc_next, EXCP_PRIVILEGE); return; } if (m68k_feature(s->env, M68K_FEATURE_M68040)) { /* always write IDLE */ TCGv idle = tcg_const_i32(0x41000000); DEST_EA(env, insn, OS_LONG, idle, NULL); tcg_temp_free(idle); } else { disas_undef(env, s, insn); } } #endif static inline TCGv gen_mac_extract_word(DisasContext *s, TCGv val, int upper) { TCGv tmp = tcg_temp_new(); if (s->env->macsr & MACSR_FI) { if (upper) tcg_gen_andi_i32(tmp, val, 0xffff0000); else tcg_gen_shli_i32(tmp, val, 16); } else if (s->env->macsr & MACSR_SU) { if (upper) tcg_gen_sari_i32(tmp, val, 16); else tcg_gen_ext16s_i32(tmp, val); } else { if (upper) tcg_gen_shri_i32(tmp, val, 16); else tcg_gen_ext16u_i32(tmp, val); } return tmp; } static void gen_mac_clear_flags(void) { tcg_gen_andi_i32(QREG_MACSR, QREG_MACSR, ~(MACSR_V | MACSR_Z | MACSR_N | MACSR_EV)); } DISAS_INSN(mac) { TCGv rx; TCGv ry; uint16_t ext; int acc; TCGv tmp; TCGv addr; TCGv loadval; int dual; TCGv saved_flags; if (!s->done_mac) { s->mactmp = tcg_temp_new_i64(); s->done_mac = 1; } ext = read_im16(env, s); acc = ((insn >> 7) & 1) | ((ext >> 3) & 2); dual = ((insn & 0x30) != 0 && (ext & 3) != 0); if (dual && !m68k_feature(s->env, M68K_FEATURE_CF_EMAC_B)) { disas_undef(env, s, insn); return; } if (insn & 0x30) { /* MAC with load. */ tmp = gen_lea(env, s, insn, OS_LONG); addr = tcg_temp_new(); tcg_gen_and_i32(addr, tmp, QREG_MAC_MASK); /* * Load the value now to ensure correct exception behavior. * Perform writeback after reading the MAC inputs. */ loadval = gen_load(s, OS_LONG, addr, 0, IS_USER(s)); acc ^= 1; rx = (ext & 0x8000) ? AREG(ext, 12) : DREG(insn, 12); ry = (ext & 8) ? AREG(ext, 0) : DREG(ext, 0); } else { loadval = addr = NULL_QREG; rx = (insn & 0x40) ? AREG(insn, 9) : DREG(insn, 9); ry = (insn & 8) ? AREG(insn, 0) : DREG(insn, 0); } gen_mac_clear_flags(); #if 0 l1 = -1; /* Disabled because conditional branches clobber temporary vars. */ if ((s->env->macsr & MACSR_OMC) != 0 && !dual) { /* Skip the multiply if we know we will ignore it. */ l1 = gen_new_label(); tmp = tcg_temp_new(); tcg_gen_andi_i32(tmp, QREG_MACSR, 1 << (acc + 8)); gen_op_jmp_nz32(tmp, l1); } #endif if ((ext & 0x0800) == 0) { /* Word. */ rx = gen_mac_extract_word(s, rx, (ext & 0x80) != 0); ry = gen_mac_extract_word(s, ry, (ext & 0x40) != 0); } if (s->env->macsr & MACSR_FI) { gen_helper_macmulf(s->mactmp, cpu_env, rx, ry); } else { if (s->env->macsr & MACSR_SU) gen_helper_macmuls(s->mactmp, cpu_env, rx, ry); else gen_helper_macmulu(s->mactmp, cpu_env, rx, ry); switch ((ext >> 9) & 3) { case 1: tcg_gen_shli_i64(s->mactmp, s->mactmp, 1); break; case 3: tcg_gen_shri_i64(s->mactmp, s->mactmp, 1); break; } } if (dual) { /* Save the overflow flag from the multiply. */ saved_flags = tcg_temp_new(); tcg_gen_mov_i32(saved_flags, QREG_MACSR); } else { saved_flags = NULL_QREG; } #if 0 /* Disabled because conditional branches clobber temporary vars. */ if ((s->env->macsr & MACSR_OMC) != 0 && dual) { /* Skip the accumulate if the value is already saturated. */ l1 = gen_new_label(); tmp = tcg_temp_new(); gen_op_and32(tmp, QREG_MACSR, tcg_const_i32(MACSR_PAV0 << acc)); gen_op_jmp_nz32(tmp, l1); } #endif if (insn & 0x100) tcg_gen_sub_i64(MACREG(acc), MACREG(acc), s->mactmp); else tcg_gen_add_i64(MACREG(acc), MACREG(acc), s->mactmp); if (s->env->macsr & MACSR_FI) gen_helper_macsatf(cpu_env, tcg_const_i32(acc)); else if (s->env->macsr & MACSR_SU) gen_helper_macsats(cpu_env, tcg_const_i32(acc)); else gen_helper_macsatu(cpu_env, tcg_const_i32(acc)); #if 0 /* Disabled because conditional branches clobber temporary vars. */ if (l1 != -1) gen_set_label(l1); #endif if (dual) { /* Dual accumulate variant. */ acc = (ext >> 2) & 3; /* Restore the overflow flag from the multiplier. */ tcg_gen_mov_i32(QREG_MACSR, saved_flags); #if 0 /* Disabled because conditional branches clobber temporary vars. */ if ((s->env->macsr & MACSR_OMC) != 0) { /* Skip the accumulate if the value is already saturated. */ l1 = gen_new_label(); tmp = tcg_temp_new(); gen_op_and32(tmp, QREG_MACSR, tcg_const_i32(MACSR_PAV0 << acc)); gen_op_jmp_nz32(tmp, l1); } #endif if (ext & 2) tcg_gen_sub_i64(MACREG(acc), MACREG(acc), s->mactmp); else tcg_gen_add_i64(MACREG(acc), MACREG(acc), s->mactmp); if (s->env->macsr & MACSR_FI) gen_helper_macsatf(cpu_env, tcg_const_i32(acc)); else if (s->env->macsr & MACSR_SU) gen_helper_macsats(cpu_env, tcg_const_i32(acc)); else gen_helper_macsatu(cpu_env, tcg_const_i32(acc)); #if 0 /* Disabled because conditional branches clobber temporary vars. */ if (l1 != -1) gen_set_label(l1); #endif } gen_helper_mac_set_flags(cpu_env, tcg_const_i32(acc)); if (insn & 0x30) { TCGv rw; rw = (insn & 0x40) ? AREG(insn, 9) : DREG(insn, 9); tcg_gen_mov_i32(rw, loadval); /* * FIXME: Should address writeback happen with the masked or * unmasked value? */ switch ((insn >> 3) & 7) { case 3: /* Post-increment. */ tcg_gen_addi_i32(AREG(insn, 0), addr, 4); break; case 4: /* Pre-decrement. */ tcg_gen_mov_i32(AREG(insn, 0), addr); } tcg_temp_free(loadval); } } DISAS_INSN(from_mac) { TCGv rx; TCGv_i64 acc; int accnum; rx = (insn & 8) ? AREG(insn, 0) : DREG(insn, 0); accnum = (insn >> 9) & 3; acc = MACREG(accnum); if (s->env->macsr & MACSR_FI) { gen_helper_get_macf(rx, cpu_env, acc); } else if ((s->env->macsr & MACSR_OMC) == 0) { tcg_gen_extrl_i64_i32(rx, acc); } else if (s->env->macsr & MACSR_SU) { gen_helper_get_macs(rx, acc); } else { gen_helper_get_macu(rx, acc); } if (insn & 0x40) { tcg_gen_movi_i64(acc, 0); tcg_gen_andi_i32(QREG_MACSR, QREG_MACSR, ~(MACSR_PAV0 << accnum)); } } DISAS_INSN(move_mac) { /* FIXME: This can be done without a helper. */ int src; TCGv dest; src = insn & 3; dest = tcg_const_i32((insn >> 9) & 3); gen_helper_mac_move(cpu_env, dest, tcg_const_i32(src)); gen_mac_clear_flags(); gen_helper_mac_set_flags(cpu_env, dest); } DISAS_INSN(from_macsr) { TCGv reg; reg = (insn & 8) ? AREG(insn, 0) : DREG(insn, 0); tcg_gen_mov_i32(reg, QREG_MACSR); } DISAS_INSN(from_mask) { TCGv reg; reg = (insn & 8) ? AREG(insn, 0) : DREG(insn, 0); tcg_gen_mov_i32(reg, QREG_MAC_MASK); } DISAS_INSN(from_mext) { TCGv reg; TCGv acc; reg = (insn & 8) ? AREG(insn, 0) : DREG(insn, 0); acc = tcg_const_i32((insn & 0x400) ? 2 : 0); if (s->env->macsr & MACSR_FI) gen_helper_get_mac_extf(reg, cpu_env, acc); else gen_helper_get_mac_exti(reg, cpu_env, acc); } DISAS_INSN(macsr_to_ccr) { TCGv tmp = tcg_temp_new(); /* Note that X and C are always cleared. */ tcg_gen_andi_i32(tmp, QREG_MACSR, CCF_N | CCF_Z | CCF_V); gen_helper_set_ccr(cpu_env, tmp); tcg_temp_free(tmp); set_cc_op(s, CC_OP_FLAGS); } DISAS_INSN(to_mac) { TCGv_i64 acc; TCGv val; int accnum; accnum = (insn >> 9) & 3; acc = MACREG(accnum); SRC_EA(env, val, OS_LONG, 0, NULL); if (s->env->macsr & MACSR_FI) { tcg_gen_ext_i32_i64(acc, val); tcg_gen_shli_i64(acc, acc, 8); } else if (s->env->macsr & MACSR_SU) { tcg_gen_ext_i32_i64(acc, val); } else { tcg_gen_extu_i32_i64(acc, val); } tcg_gen_andi_i32(QREG_MACSR, QREG_MACSR, ~(MACSR_PAV0 << accnum)); gen_mac_clear_flags(); gen_helper_mac_set_flags(cpu_env, tcg_const_i32(accnum)); } DISAS_INSN(to_macsr) { TCGv val; SRC_EA(env, val, OS_LONG, 0, NULL); gen_helper_set_macsr(cpu_env, val); gen_exit_tb(s); } DISAS_INSN(to_mask) { TCGv val; SRC_EA(env, val, OS_LONG, 0, NULL); tcg_gen_ori_i32(QREG_MAC_MASK, val, 0xffff0000); } DISAS_INSN(to_mext) { TCGv val; TCGv acc; SRC_EA(env, val, OS_LONG, 0, NULL); acc = tcg_const_i32((insn & 0x400) ? 2 : 0); if (s->env->macsr & MACSR_FI) gen_helper_set_mac_extf(cpu_env, val, acc); else if (s->env->macsr & MACSR_SU) gen_helper_set_mac_exts(cpu_env, val, acc); else gen_helper_set_mac_extu(cpu_env, val, acc); } static disas_proc opcode_table[65536]; static void register_opcode (disas_proc proc, uint16_t opcode, uint16_t mask) { int i; int from; int to; /* Sanity check. All set bits must be included in the mask. */ if (opcode & ~mask) { fprintf(stderr, "qemu internal error: bogus opcode definition %04x/%04x\n", opcode, mask); abort(); } /* * This could probably be cleverer. For now just optimize the case where * the top bits are known. */ /* Find the first zero bit in the mask. */ i = 0x8000; while ((i & mask) != 0) i >>= 1; /* Iterate over all combinations of this and lower bits. */ if (i == 0) i = 1; else i <<= 1; from = opcode & ~(i - 1); to = from + i; for (i = from; i < to; i++) { if ((i & mask) == opcode) opcode_table[i] = proc; } } /* * Register m68k opcode handlers. Order is important. * Later insn override earlier ones. */ void register_m68k_insns (CPUM68KState *env) { /* * Build the opcode table only once to avoid * multithreading issues. */ if (opcode_table[0] != NULL) { return; } /* * use BASE() for instruction available * for CF_ISA_A and M68000. */ #define BASE(name, opcode, mask) \ register_opcode(disas_##name, 0x##opcode, 0x##mask) #define INSN(name, opcode, mask, feature) do { \ if (m68k_feature(env, M68K_FEATURE_##feature)) \ BASE(name, opcode, mask); \ } while(0) BASE(undef, 0000, 0000); INSN(arith_im, 0080, fff8, CF_ISA_A); INSN(arith_im, 0000, ff00, M68K); INSN(chk2, 00c0, f9c0, CHK2); INSN(bitrev, 00c0, fff8, CF_ISA_APLUSC); BASE(bitop_reg, 0100, f1c0); BASE(bitop_reg, 0140, f1c0); BASE(bitop_reg, 0180, f1c0); BASE(bitop_reg, 01c0, f1c0); INSN(movep, 0108, f138, MOVEP); INSN(arith_im, 0280, fff8, CF_ISA_A); INSN(arith_im, 0200, ff00, M68K); INSN(undef, 02c0, ffc0, M68K); INSN(byterev, 02c0, fff8, CF_ISA_APLUSC); INSN(arith_im, 0480, fff8, CF_ISA_A); INSN(arith_im, 0400, ff00, M68K); INSN(undef, 04c0, ffc0, M68K); INSN(arith_im, 0600, ff00, M68K); INSN(undef, 06c0, ffc0, M68K); INSN(ff1, 04c0, fff8, CF_ISA_APLUSC); INSN(arith_im, 0680, fff8, CF_ISA_A); INSN(arith_im, 0c00, ff38, CF_ISA_A); INSN(arith_im, 0c00, ff00, M68K); BASE(bitop_im, 0800, ffc0); BASE(bitop_im, 0840, ffc0); BASE(bitop_im, 0880, ffc0); BASE(bitop_im, 08c0, ffc0); INSN(arith_im, 0a80, fff8, CF_ISA_A); INSN(arith_im, 0a00, ff00, M68K); #if defined(CONFIG_SOFTMMU) INSN(moves, 0e00, ff00, M68K); #endif INSN(cas, 0ac0, ffc0, CAS); INSN(cas, 0cc0, ffc0, CAS); INSN(cas, 0ec0, ffc0, CAS); INSN(cas2w, 0cfc, ffff, CAS); INSN(cas2l, 0efc, ffff, CAS); BASE(move, 1000, f000); BASE(move, 2000, f000); BASE(move, 3000, f000); INSN(chk, 4000, f040, M68K); INSN(strldsr, 40e7, ffff, CF_ISA_APLUSC); INSN(negx, 4080, fff8, CF_ISA_A); INSN(negx, 4000, ff00, M68K); INSN(undef, 40c0, ffc0, M68K); INSN(move_from_sr, 40c0, fff8, CF_ISA_A); INSN(move_from_sr, 40c0, ffc0, M68K); BASE(lea, 41c0, f1c0); BASE(clr, 4200, ff00); BASE(undef, 42c0, ffc0); INSN(move_from_ccr, 42c0, fff8, CF_ISA_A); INSN(move_from_ccr, 42c0, ffc0, M68K); INSN(neg, 4480, fff8, CF_ISA_A); INSN(neg, 4400, ff00, M68K); INSN(undef, 44c0, ffc0, M68K); BASE(move_to_ccr, 44c0, ffc0); INSN(not, 4680, fff8, CF_ISA_A); INSN(not, 4600, ff00, M68K); #if defined(CONFIG_SOFTMMU) BASE(move_to_sr, 46c0, ffc0); #endif INSN(nbcd, 4800, ffc0, M68K); INSN(linkl, 4808, fff8, M68K); BASE(pea, 4840, ffc0); BASE(swap, 4840, fff8); INSN(bkpt, 4848, fff8, BKPT); INSN(movem, 48d0, fbf8, CF_ISA_A); INSN(movem, 48e8, fbf8, CF_ISA_A); INSN(movem, 4880, fb80, M68K); BASE(ext, 4880, fff8); BASE(ext, 48c0, fff8); BASE(ext, 49c0, fff8); BASE(tst, 4a00, ff00); INSN(tas, 4ac0, ffc0, CF_ISA_B); INSN(tas, 4ac0, ffc0, M68K); #if defined(CONFIG_SOFTMMU) INSN(halt, 4ac8, ffff, CF_ISA_A); INSN(halt, 4ac8, ffff, M68K); #endif INSN(pulse, 4acc, ffff, CF_ISA_A); BASE(illegal, 4afc, ffff); INSN(mull, 4c00, ffc0, CF_ISA_A); INSN(mull, 4c00, ffc0, LONG_MULDIV); INSN(divl, 4c40, ffc0, CF_ISA_A); INSN(divl, 4c40, ffc0, LONG_MULDIV); INSN(sats, 4c80, fff8, CF_ISA_B); BASE(trap, 4e40, fff0); BASE(link, 4e50, fff8); BASE(unlk, 4e58, fff8); #if defined(CONFIG_SOFTMMU) INSN(move_to_usp, 4e60, fff8, USP); INSN(move_from_usp, 4e68, fff8, USP); INSN(reset, 4e70, ffff, M68K); BASE(stop, 4e72, ffff); BASE(rte, 4e73, ffff); INSN(cf_movec, 4e7b, ffff, CF_ISA_A); INSN(m68k_movec, 4e7a, fffe, MOVEC); #endif BASE(nop, 4e71, ffff); INSN(rtd, 4e74, ffff, RTD); BASE(rts, 4e75, ffff); INSN(trapv, 4e76, ffff, M68K); INSN(rtr, 4e77, ffff, M68K); BASE(jump, 4e80, ffc0); BASE(jump, 4ec0, ffc0); INSN(addsubq, 5000, f080, M68K); BASE(addsubq, 5080, f0c0); INSN(scc, 50c0, f0f8, CF_ISA_A); /* Scc.B Dx */ INSN(scc, 50c0, f0c0, M68K); /* Scc.B */ INSN(dbcc, 50c8, f0f8, M68K); INSN(trapcc, 50fa, f0fe, TRAPCC); /* opmode 010, 011 */ INSN(trapcc, 50fc, f0ff, TRAPCC); /* opmode 100 */ INSN(trapcc, 51fa, fffe, CF_ISA_A); /* TPF (trapf) opmode 010, 011 */ INSN(trapcc, 51fc, ffff, CF_ISA_A); /* TPF (trapf) opmode 100 */ /* Branch instructions. */ BASE(branch, 6000, f000); /* Disable long branch instructions, then add back the ones we want. */ BASE(undef, 60ff, f0ff); /* All long branches. */ INSN(branch, 60ff, f0ff, CF_ISA_B); INSN(undef, 60ff, ffff, CF_ISA_B); /* bra.l */ INSN(branch, 60ff, ffff, BRAL); INSN(branch, 60ff, f0ff, BCCL); BASE(moveq, 7000, f100); INSN(mvzs, 7100, f100, CF_ISA_B); BASE(or, 8000, f000); BASE(divw, 80c0, f0c0); INSN(sbcd_reg, 8100, f1f8, M68K); INSN(sbcd_mem, 8108, f1f8, M68K); BASE(addsub, 9000, f000); INSN(undef, 90c0, f0c0, CF_ISA_A); INSN(subx_reg, 9180, f1f8, CF_ISA_A); INSN(subx_reg, 9100, f138, M68K); INSN(subx_mem, 9108, f138, M68K); INSN(suba, 91c0, f1c0, CF_ISA_A); INSN(suba, 90c0, f0c0, M68K); BASE(undef_mac, a000, f000); INSN(mac, a000, f100, CF_EMAC); INSN(from_mac, a180, f9b0, CF_EMAC); INSN(move_mac, a110, f9fc, CF_EMAC); INSN(from_macsr,a980, f9f0, CF_EMAC); INSN(from_mask, ad80, fff0, CF_EMAC); INSN(from_mext, ab80, fbf0, CF_EMAC); INSN(macsr_to_ccr, a9c0, ffff, CF_EMAC); INSN(to_mac, a100, f9c0, CF_EMAC); INSN(to_macsr, a900, ffc0, CF_EMAC); INSN(to_mext, ab00, fbc0, CF_EMAC); INSN(to_mask, ad00, ffc0, CF_EMAC); INSN(mov3q, a140, f1c0, CF_ISA_B); INSN(cmp, b000, f1c0, CF_ISA_B); /* cmp.b */ INSN(cmp, b040, f1c0, CF_ISA_B); /* cmp.w */ INSN(cmpa, b0c0, f1c0, CF_ISA_B); /* cmpa.w */ INSN(cmp, b080, f1c0, CF_ISA_A); INSN(cmpa, b1c0, f1c0, CF_ISA_A); INSN(cmp, b000, f100, M68K); INSN(eor, b100, f100, M68K); INSN(cmpm, b108, f138, M68K); INSN(cmpa, b0c0, f0c0, M68K); INSN(eor, b180, f1c0, CF_ISA_A); BASE(and, c000, f000); INSN(exg_dd, c140, f1f8, M68K); INSN(exg_aa, c148, f1f8, M68K); INSN(exg_da, c188, f1f8, M68K); BASE(mulw, c0c0, f0c0); INSN(abcd_reg, c100, f1f8, M68K); INSN(abcd_mem, c108, f1f8, M68K); BASE(addsub, d000, f000); INSN(undef, d0c0, f0c0, CF_ISA_A); INSN(addx_reg, d180, f1f8, CF_ISA_A); INSN(addx_reg, d100, f138, M68K); INSN(addx_mem, d108, f138, M68K); INSN(adda, d1c0, f1c0, CF_ISA_A); INSN(adda, d0c0, f0c0, M68K); INSN(shift_im, e080, f0f0, CF_ISA_A); INSN(shift_reg, e0a0, f0f0, CF_ISA_A); INSN(shift8_im, e000, f0f0, M68K); INSN(shift16_im, e040, f0f0, M68K); INSN(shift_im, e080, f0f0, M68K); INSN(shift8_reg, e020, f0f0, M68K); INSN(shift16_reg, e060, f0f0, M68K); INSN(shift_reg, e0a0, f0f0, M68K); INSN(shift_mem, e0c0, fcc0, M68K); INSN(rotate_im, e090, f0f0, M68K); INSN(rotate8_im, e010, f0f0, M68K); INSN(rotate16_im, e050, f0f0, M68K); INSN(rotate_reg, e0b0, f0f0, M68K); INSN(rotate8_reg, e030, f0f0, M68K); INSN(rotate16_reg, e070, f0f0, M68K); INSN(rotate_mem, e4c0, fcc0, M68K); INSN(bfext_mem, e9c0, fdc0, BITFIELD); /* bfextu & bfexts */ INSN(bfext_reg, e9c0, fdf8, BITFIELD); INSN(bfins_mem, efc0, ffc0, BITFIELD); INSN(bfins_reg, efc0, fff8, BITFIELD); INSN(bfop_mem, eac0, ffc0, BITFIELD); /* bfchg */ INSN(bfop_reg, eac0, fff8, BITFIELD); /* bfchg */ INSN(bfop_mem, ecc0, ffc0, BITFIELD); /* bfclr */ INSN(bfop_reg, ecc0, fff8, BITFIELD); /* bfclr */ INSN(bfop_mem, edc0, ffc0, BITFIELD); /* bfffo */ INSN(bfop_reg, edc0, fff8, BITFIELD); /* bfffo */ INSN(bfop_mem, eec0, ffc0, BITFIELD); /* bfset */ INSN(bfop_reg, eec0, fff8, BITFIELD); /* bfset */ INSN(bfop_mem, e8c0, ffc0, BITFIELD); /* bftst */ INSN(bfop_reg, e8c0, fff8, BITFIELD); /* bftst */ BASE(undef_fpu, f000, f000); INSN(fpu, f200, ffc0, CF_FPU); INSN(fbcc, f280, ffc0, CF_FPU); INSN(fpu, f200, ffc0, FPU); INSN(fscc, f240, ffc0, FPU); INSN(ftrapcc, f27a, fffe, FPU); /* opmode 010, 011 */ INSN(ftrapcc, f27c, ffff, FPU); /* opmode 100 */ INSN(fbcc, f280, ff80, FPU); #if defined(CONFIG_SOFTMMU) INSN(frestore, f340, ffc0, CF_FPU); INSN(fsave, f300, ffc0, CF_FPU); INSN(frestore, f340, ffc0, FPU); INSN(fsave, f300, ffc0, FPU); INSN(intouch, f340, ffc0, CF_ISA_A); INSN(cpushl, f428, ff38, CF_ISA_A); INSN(cpush, f420, ff20, M68040); INSN(cinv, f400, ff20, M68040); INSN(pflush, f500, ffe0, M68040); INSN(ptest, f548, ffd8, M68040); INSN(wddata, fb00, ff00, CF_ISA_A); INSN(wdebug, fbc0, ffc0, CF_ISA_A); #endif INSN(move16_mem, f600, ffe0, M68040); INSN(move16_reg, f620, fff8, M68040); #undef INSN } static void m68k_tr_init_disas_context(DisasContextBase *dcbase, CPUState *cpu) { DisasContext *dc = container_of(dcbase, DisasContext, base); CPUM68KState *env = cpu->env_ptr; dc->env = env; dc->pc = dc->base.pc_first; /* This value will always be filled in properly before m68k_tr_tb_stop. */ dc->pc_prev = 0xdeadbeef; dc->cc_op = CC_OP_DYNAMIC; dc->cc_op_synced = 1; dc->done_mac = 0; dc->writeback_mask = 0; init_release_array(dc); dc->ss_active = (M68K_SR_TRACE(env->sr) == M68K_SR_TRACE_ANY_INS); /* If architectural single step active, limit to 1 */ if (dc->ss_active) { dc->base.max_insns = 1; } } static void m68k_tr_tb_start(DisasContextBase *dcbase, CPUState *cpu) { } static void m68k_tr_insn_start(DisasContextBase *dcbase, CPUState *cpu) { DisasContext *dc = container_of(dcbase, DisasContext, base); tcg_gen_insn_start(dc->base.pc_next, dc->cc_op); } static void m68k_tr_translate_insn(DisasContextBase *dcbase, CPUState *cpu) { DisasContext *dc = container_of(dcbase, DisasContext, base); CPUM68KState *env = cpu->env_ptr; uint16_t insn = read_im16(env, dc); opcode_table[insn](env, dc, insn); do_writebacks(dc); do_release(dc); dc->pc_prev = dc->base.pc_next; dc->base.pc_next = dc->pc; if (dc->base.is_jmp == DISAS_NEXT) { /* * Stop translation when the next insn might touch a new page. * This ensures that prefetch aborts at the right place. * * We cannot determine the size of the next insn without * completely decoding it. However, the maximum insn size * is 32 bytes, so end if we do not have that much remaining. * This may produce several small TBs at the end of each page, * but they will all be linked with goto_tb. * * ??? ColdFire maximum is 4 bytes; MC68000's maximum is also * smaller than MC68020's. */ target_ulong start_page_offset = dc->pc - (dc->base.pc_first & TARGET_PAGE_MASK); if (start_page_offset >= TARGET_PAGE_SIZE - 32) { dc->base.is_jmp = DISAS_TOO_MANY; } } } static void m68k_tr_tb_stop(DisasContextBase *dcbase, CPUState *cpu) { DisasContext *dc = container_of(dcbase, DisasContext, base); switch (dc->base.is_jmp) { case DISAS_NORETURN: break; case DISAS_TOO_MANY: update_cc_op(dc); gen_jmp_tb(dc, 0, dc->pc, dc->pc_prev); break; case DISAS_JUMP: /* We updated CC_OP and PC in gen_jmp/gen_jmp_im. */ if (dc->ss_active) { gen_raise_exception_format2(dc, EXCP_TRACE, dc->pc_prev); } else { tcg_gen_lookup_and_goto_ptr(); } break; case DISAS_EXIT: /* * We updated CC_OP and PC in gen_exit_tb, but also modified * other state that may require returning to the main loop. */ if (dc->ss_active) { gen_raise_exception_format2(dc, EXCP_TRACE, dc->pc_prev); } else { tcg_gen_exit_tb(NULL, 0); } break; default: g_assert_not_reached(); } } static void m68k_tr_disas_log(const DisasContextBase *dcbase, CPUState *cpu, FILE *logfile) { fprintf(logfile, "IN: %s\n", lookup_symbol(dcbase->pc_first)); target_disas(logfile, cpu, dcbase->pc_first, dcbase->tb->size); } static const TranslatorOps m68k_tr_ops = { .init_disas_context = m68k_tr_init_disas_context, .tb_start = m68k_tr_tb_start, .insn_start = m68k_tr_insn_start, .translate_insn = m68k_tr_translate_insn, .tb_stop = m68k_tr_tb_stop, .disas_log = m68k_tr_disas_log, }; void gen_intermediate_code(CPUState *cpu, TranslationBlock *tb, int max_insns, target_ulong pc, void *host_pc) { DisasContext dc; translator_loop(cpu, tb, max_insns, pc, host_pc, &m68k_tr_ops, &dc.base); } static double floatx80_to_double(CPUM68KState *env, uint16_t high, uint64_t low) { floatx80 a = { .high = high, .low = low }; union { float64 f64; double d; } u; u.f64 = floatx80_to_float64(a, &env->fp_status); return u.d; } void m68k_cpu_dump_state(CPUState *cs, FILE *f, int flags) { M68kCPU *cpu = M68K_CPU(cs); CPUM68KState *env = &cpu->env; int i; uint16_t sr; for (i = 0; i < 8; i++) { qemu_fprintf(f, "D%d = %08x A%d = %08x " "F%d = %04x %016"PRIx64" (%12g)\n", i, env->dregs[i], i, env->aregs[i], i, env->fregs[i].l.upper, env->fregs[i].l.lower, floatx80_to_double(env, env->fregs[i].l.upper, env->fregs[i].l.lower)); } qemu_fprintf(f, "PC = %08x ", env->pc); sr = env->sr | cpu_m68k_get_ccr(env); qemu_fprintf(f, "SR = %04x T:%x I:%x %c%c %c%c%c%c%c\n", sr, (sr & SR_T) >> SR_T_SHIFT, (sr & SR_I) >> SR_I_SHIFT, (sr & SR_S) ? 'S' : 'U', (sr & SR_M) ? '%' : 'I', (sr & CCF_X) ? 'X' : '-', (sr & CCF_N) ? 'N' : '-', (sr & CCF_Z) ? 'Z' : '-', (sr & CCF_V) ? 'V' : '-', (sr & CCF_C) ? 'C' : '-'); qemu_fprintf(f, "FPSR = %08x %c%c%c%c ", env->fpsr, (env->fpsr & FPSR_CC_A) ? 'A' : '-', (env->fpsr & FPSR_CC_I) ? 'I' : '-', (env->fpsr & FPSR_CC_Z) ? 'Z' : '-', (env->fpsr & FPSR_CC_N) ? 'N' : '-'); qemu_fprintf(f, "\n " "FPCR = %04x ", env->fpcr); switch (env->fpcr & FPCR_PREC_MASK) { case FPCR_PREC_X: qemu_fprintf(f, "X "); break; case FPCR_PREC_S: qemu_fprintf(f, "S "); break; case FPCR_PREC_D: qemu_fprintf(f, "D "); break; } switch (env->fpcr & FPCR_RND_MASK) { case FPCR_RND_N: qemu_fprintf(f, "RN "); break; case FPCR_RND_Z: qemu_fprintf(f, "RZ "); break; case FPCR_RND_M: qemu_fprintf(f, "RM "); break; case FPCR_RND_P: qemu_fprintf(f, "RP "); break; } qemu_fprintf(f, "\n"); #ifdef CONFIG_SOFTMMU qemu_fprintf(f, "%sA7(MSP) = %08x %sA7(USP) = %08x %sA7(ISP) = %08x\n", env->current_sp == M68K_SSP ? "->" : " ", env->sp[M68K_SSP], env->current_sp == M68K_USP ? "->" : " ", env->sp[M68K_USP], env->current_sp == M68K_ISP ? "->" : " ", env->sp[M68K_ISP]); qemu_fprintf(f, "VBR = 0x%08x\n", env->vbr); qemu_fprintf(f, "SFC = %x DFC %x\n", env->sfc, env->dfc); qemu_fprintf(f, "SSW %08x TCR %08x URP %08x SRP %08x\n", env->mmu.ssw, env->mmu.tcr, env->mmu.urp, env->mmu.srp); qemu_fprintf(f, "DTTR0/1: %08x/%08x ITTR0/1: %08x/%08x\n", env->mmu.ttr[M68K_DTTR0], env->mmu.ttr[M68K_DTTR1], env->mmu.ttr[M68K_ITTR0], env->mmu.ttr[M68K_ITTR1]); qemu_fprintf(f, "MMUSR %08x, fault at %08x\n", env->mmu.mmusr, env->mmu.ar); #endif }