[Qemu-devel] [PATCH v5 08/17] target/m68k: add move16

[Laurent Vivier <laurent@vivier.eu>]

move16 moves the source line to the destination line. Lines are aligned
to 16-byte boundaries and are 16 bytes long.

Signed-off-by: Laurent Vivier <laurent@vivier.eu>
---
 target/m68k/cpu.c       | 10 ++++++-
 target/m68k/cpu.h       |  1 +
 target/m68k/translate.c | 73 +++++++++++++++++++++++++++++++++++++++++++++++++
 3 files changed, 83 insertions(+), 1 deletion(-)

diff --git a/target/m68k/cpu.c b/target/m68k/cpu.c
index 57ffcb2114..1936efd170 100644
--- a/target/m68k/cpu.c
+++ b/target/m68k/cpu.c
@@ -137,7 +137,15 @@ static void m68020_cpu_initfn(Object *obj)
     m68k_set_feature(env, M68K_FEATURE_CHK2);
 }
 #define m68030_cpu_initfn m68020_cpu_initfn
-#define m68040_cpu_initfn m68020_cpu_initfn
+
+static void m68040_cpu_initfn(Object *obj)
+{
+    M68kCPU *cpu = M68K_CPU(obj);
+    CPUM68KState *env = &cpu->env;
+
+    m68020_cpu_initfn(obj);
+    m68k_set_feature(env, M68K_FEATURE_M68040);
+}
 
 static void m68060_cpu_initfn(Object *obj)
 {
diff --git a/target/m68k/cpu.h b/target/m68k/cpu.h
index 42c358d1a7..c21e36d1af 100644
--- a/target/m68k/cpu.h
+++ b/target/m68k/cpu.h
@@ -305,6 +305,7 @@ enum m68k_features {
     M68K_FEATURE_BKPT,
     M68K_FEATURE_RTD,
     M68K_FEATURE_CHK2,
+    M68K_FEATURE_M68040, /* instructions specific to MC68040 */
 };
 
 static inline int m68k_feature(CPUM68KState *env, int feature)
diff --git a/target/m68k/translate.c b/target/m68k/translate.c
index 6ef4c3a53c..9f13299bcf 100644
--- a/target/m68k/translate.c
+++ b/target/m68k/translate.c
@@ -4337,6 +4337,78 @@ DISAS_INSN(chk2)
     gen_set_label(l1);
 }
 
+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)
+{
+    int index = IS_USER(s);
+    uint16_t mode;
+
+    mode = (insn >> 3) & 7;
+
+    if (mode & 4) {
+        TCGv tmp;
+        uint16_t ext;
+
+        ext = read_im16(env, s);
+        if ((ext & (1 << 15)) == 0) {
+            gen_exception(s, s->insn_pc, 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);
+    } else {
+        TCGv reg, addr;
+
+        reg = AREG(insn, 0);
+        addr = tcg_const_i32(read_im32(env, s));
+
+        if (mode & 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 ((mode & 2) == 0) {
+            /* (Ay)+ */
+            tcg_gen_addi_i32(reg, reg, 16);
+        }
+    }
+}
+
 static TCGv gen_get_sr(DisasContext *s)
 {
     TCGv ccr;
@@ -5638,6 +5710,7 @@ void register_m68k_insns (CPUM68KState *env)
     INSN(fsave,     f300, ffc0, FPU);
     INSN(intouch,   f340, ffc0, CF_ISA_A);
     INSN(cpushl,    f428, ff38, CF_ISA_A);
+    INSN(move16,    f600, ffc0, M68040);
     INSN(wddata,    fb00, ff00, CF_ISA_A);
     INSN(wdebug,    fbc0, ffc0, CF_ISA_A);
 #undef INSN
-- 
2.14.3