diff options
Diffstat (limited to 'sim/m32c/r8c.opc')
| -rw-r--r-- | sim/m32c/r8c.opc | 1580 |
1 files changed, 1580 insertions, 0 deletions
diff --git a/sim/m32c/r8c.opc b/sim/m32c/r8c.opc new file mode 100644 index 0000000..4a6ba51 --- /dev/null +++ b/sim/m32c/r8c.opc @@ -0,0 +1,1580 @@ +/* r8c.opc --- semantics for r8c opcodes. -*- mode: c -*- + +Copyright (C) 2005 Free Software Foundation, Inc. +Contributed by Red Hat, Inc. + +This file is part of the GNU simulators. + +The GNU simulators are free software; you can redistribute them and/or +modify them under the terms of the GNU General Public License as +published by the Free Software Foundation; either version 2 of the +License, or (at your option) any later version. + +The GNU simulators are distributed in the hope that they will be +useful, but WITHOUT ANY WARRANTY; without even the implied warranty of +MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +General Public License for more details. + +You should have received a copy of the GNU General Public License +along with the GNU simulators; if not, write to the Free Software +Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA +02110-1301, USA */ + + +#include <stdio.h> +#include <stdlib.h> + +#include "cpu.h" +#include "mem.h" +#include "misc.h" +#include "int.h" + +#define AU __attribute__((unused)) + +#define tprintf if (trace) printf + +static unsigned char +getbyte () +{ + int tsave = trace; + unsigned char b; + + if (trace == 1) + trace = 0; + b = mem_get_pc (); + regs.r_pc ++; + trace = tsave; + return b; +} + +#define M16C_ONLY() /* FIXME: add something here */ + +#define GETBYTE() (op[opi++] = getbyte()) + +#define UNSUPPORTED() unsupported("unsupported", orig_pc) +#define NOTYET() unsupported("unimplemented", orig_pc) + +static void +unsupported (char *tag, int orig_pc) +{ + int i; + printf("%s opcode at %08x\n", tag, orig_pc); + regs.r_pc = orig_pc; + for (i=0; i<2; i++) + { + int b = mem_get_pc(); + printf(" %s", bits(b>>4, 4)); + printf(" %s", bits(b, 4)); + regs.r_pc ++; + } + printf("\n"); + regs.r_pc = orig_pc; + for (i=0; i<6; i++) + { + printf(" %02x", mem_get_pc ()); + regs.r_pc ++; + } + printf("\n"); + exit(1); +} + +static int +IMM(bw) +{ + int rv = getbyte (); + if (bw) + rv = rv + 256 * getbyte(); + if (bw == 2) + rv = rv + 65536 * getbyte(); + return rv; +} + +#define IMM4() (immm >= 8 ? 7 - immm : immm + 1) + +#define UNARY_SOP \ + dc = decode_srcdest4 (dest, w); \ + v = sign_ext (get_src (dc), w?16:8); + +#define UNARY_UOP \ + dc = decode_srcdest4 (dest, w); \ + v = get_src (dc); + +#define BINARY_SOP \ + sc = decode_srcdest4 (srcx, w); \ + dc = decode_srcdest4 (dest, w); \ + a = sign_ext (get_src (sc), w?16:8); \ + b = sign_ext (get_src (dc), w?16:8); + +#define BINARY_UOP \ + sc = decode_srcdest4 (srcx, w); \ + dc = decode_srcdest4 (dest, w); \ + a = get_src (sc); \ + b = get_src (dc); + +#define carry (FLAG_C ? 1 : 0) + +static void +cmp (int d, int s, int w) +{ + int a, b, f=0; + int mask = w ? 0xffff : 0xff; + a = d - s; + b = sign_ext (d, w?16:8) - sign_ext (s, w?16:8); + tprintf ("cmp: %x - %x = %08x, %x - %x = %d\n", + d, s, a, + sign_ext(d,w?16:8), sign_ext(s,w?16:8), b); + + if (b == 0) + f |= FLAGBIT_Z; + if (b & (w ? 0x8000 : 0x80)) + f |= FLAGBIT_S; + if ((d & mask) >= (s & mask)) + f |= FLAGBIT_C; + if (b < (w ? -32768 : -128) || b > (w ? 32767 : 127)) + f |= FLAGBIT_O; + + set_flags (FLAGBIT_Z | FLAGBIT_S | FLAGBIT_O | FLAGBIT_C, f); +} + +static void +div_op (int s, int u, int x, int w) +{ + srcdest sc; + int v, a, b; + + if (s == -1) + s = IMM(w); + else + { + sc = decode_srcdest4 (s, w); + s = get_src (sc); + } + + v = get_reg (w ? r2r0 : r0); + + if (!u) + { + s = sign_ext (s, w ? 16 : 8); + v = sign_ext (v, w ? 16 : 8); + } + + if (s == 0) + { + set_flags (FLAGBIT_O, FLAGBIT_O); + return; + } + + if (u) + { + a = (unsigned int)v / (unsigned int)s; + b = (unsigned int)v % (unsigned int)s; + } + else + { + a = v / s; + b = v % s; + } + if (x) + { + if ((s > 0 && b < 0) + || (s < 0 && b > 0)) + { + a --; + b += s; + } + } + tprintf ("%d / %d = %d rem %d\n", v, s, a, b); + if ((!u && (a > (w ? 32767 : 127) + || a < (w ? -32768 : -129))) + || (u && (a > (w ? 65536 : 255)))) + set_flags (FLAGBIT_O, FLAGBIT_O); + else + set_flags (FLAGBIT_O, 0); + + put_reg (w ? r0 : r0l, a); + put_reg (w ? r2 : r0h, b); +} + +static void +rot_op (srcdest sd, int rotc, int count) +{ + int mask = (sd.bytes == 2) ? 0xffff : 0xff; + int msb = (sd.bytes == 2) ? 0x8000 : 0x80; + int v = get_src (sd); + int c = carry, ct; + + tprintf("%s %x by %d\n", rotc ? "rotc" : "rot", v, count); + tprintf (": %s %d\n", bits(v, 8*sd.bytes), c); + while (count > 0) + { + ct = (v & msb) ? 1 : 0; + v <<= 1; + v |= rotc ? c : ct; + v &= mask; + c = ct; + tprintf (": %s %d\n", bits(v, 8*sd.bytes), c); + count --; + } + while (count < 0) + { + ct = v & 1; + v >>= 1; + v |= (rotc ? c : ct) * msb; + c = ct; + tprintf (": %s %d\n", bits(v, 8*sd.bytes), c); + count ++; + } + put_dest (sd, v); + set_szc (v, sd.bytes, c); +} + +static void +shift_op (srcdest sd, int arith, int count) +{ + int mask = (sd.bytes == 2) ? 0xffff : 0xff; + int msb = (sd.bytes == 2) ? 0x8000 : 0x80; + int v = get_src (sd); + int c = 0; + + if (sd.bytes == 4) + { + mask = 0xffffffffU; + msb = 0x80000000U; + } + + tprintf("%s %x by %d\n", arith ? "sha" : "shl", v, count); + tprintf (": %s %d\n", bits(v, 8*sd.bytes), c); + while (count > 0) + { + c = (v & msb) ? 1 : 0; + v <<= 1; + v &= mask; + tprintf (": %s %d\n", bits(v, 8*sd.bytes), c); + count --; + } + while (count < 0) + { + c = v & 1; + if (arith) + v = (v & msb) | (v >> 1); + else + v = (v >> 1) & (msb - 1); + tprintf (": %s %d\n", bits(v, 8*sd.bytes), c); + count ++; + } + put_dest (sd, v); + set_szc (v, sd.bytes, c); +} + +#define MATH_OP(dc,s,c,op,carryrel) \ + a = get_src(dc); \ + b = s & b2mask[dc.bytes]; \ + v2 = a op b op c; \ + tprintf("0x%x " #op " 0x%x " #op " 0x%x = 0x%x\n", a, b, c, v2); \ + a = sign_ext (a, dc.bytes * 8); \ + b = sign_ext (s, dc.bytes * 8); \ + v = a op b op c; \ + tprintf("%d " #op " %d " #op " %d = %d\n", a, b, c, v); \ + set_oszc (v, dc.bytes, v2 carryrel); \ + put_dest (dc, v2); + +#define BIT_OP(field,expr) \ + dc = decode_bit (field); \ + b = get_bit (dc); \ + v = expr; \ + tprintf ("b=%d, carry=%d, %s = %d\n", b, carry, #expr, v); \ + put_bit (dc, v); + +#define BIT_OPC(field,expr) \ + dc = decode_bit (field); \ + b = get_bit (dc); \ + v = expr; \ + tprintf ("b=%d, carry=%d, %s = %d\n", b, carry, #expr, v); \ + set_c (v); + +int +decode_r8c() +{ + unsigned char op[40]; + int opi = 0; + int v, v2, a, b; + int orig_pc = get_reg (pc); + srcdest sc, dc; + int imm; + + step_result = M32C_MAKE_STEPPED (); + + tprintf("trace: decode pc = %05x\n", orig_pc); + + /** VARY dst 011 100 101 110 111 */ + + /** 0111 011w 1111 dest ABS.size dest */ + + UNARY_SOP; + a = v<0 ? -v : v; + tprintf("abs(%d) = %d\n", v, a); + set_osz(a, w+1); + put_dest (dc, a); + + /** 0111 011w 0110 dest ADC.size #IMM,dest */ + + dc = decode_srcdest4(dest, w); + imm = IMM(w); + MATH_OP (dc, imm, carry, +, > (w?0xffff:0xff)); + + /** 1011 000w srcx dest ADC.size src,dest */ + + sc = decode_srcdest4(srcx, w); + dc = decode_srcdest4(dest, w); + b = get_src (sc); + MATH_OP (dc, b, carry, +, > (w?0xffff:0xff)); + + /** 0111 011w 1110 dest ADCF.size dest */ + + dc = decode_srcdest4(dest, w); + MATH_OP (dc, 0, carry, +, > (w?0xffff:0xff)); + + /** 0111 011w 0100 dest ADD.size:G #imm,dest */ + + dc = decode_srcdest4(dest, w); + imm = IMM(w); + MATH_OP (dc, imm, 0, +, > (w?0xffff:0xff)); + + /** 1100 100w immm dest ADD.size:Q #IMM,dest */ + + dc = decode_srcdest4(dest, w); + imm = sign_ext (immm, 4); + MATH_OP (dc, imm, 0, +, > (w?0xffff:0xff)); + + /** 1000 0dst ADD.B:S #IMM8,dst */ + + imm = IMM(0); + dc = decode_dest3 (dst, 0); + MATH_OP (dc, imm, 0, +, > 0xff); + + /** 1010 000w srcx dest ADD.size:G src,dest */ + + sc = decode_srcdest4(srcx, w); + dc = decode_srcdest4(dest, w); + b = get_src (sc); + MATH_OP (dc, b, 0, +, > (w?0xffff:0xff)); + + /** 0010 0d sr ADD.B:S src,R0L/R0H */ + + sc = decode_src2 (sr, 0, d); + dc = decode_dest1 (d, 0); + b = get_src (sc); + MATH_OP (dc, b, 0, +, > 0xff); + + /** 0111 110w 1110 1011 ADD.size:G #IMM,sp */ + + dc = reg_sd (sp); + imm = sign_ext (IMM(w), w?16:8); + MATH_OP (dc, imm, 0, +, > 0xffff); + + /** 0111 1101 1011 immm ADD.size:Q #IMM,sp */ + + dc = reg_sd (sp); + imm = sign_ext (immm, 4); + MATH_OP (dc, imm, 0, +, > 0xffff); + + /** 1111 100w immm dest ADJNZ.size #IMM,dest,label */ + + UNARY_UOP; + imm = sign_ext(immm, 4); + tprintf("%x + %d = %x\n", v, imm, v+imm); + v += imm; + put_dest (dc, v); + a = sign_ext (IMM(0), 8); + if ((v & (w ? 0xffff : 0xff)) != 0) + { + tprintf("jmp: %x + 2 + %d = ", get_reg (pc), a); + put_reg (pc, orig_pc + 2 + a); + tprintf("%x\n", get_reg (pc)); + } + + /** 0111 011w 0010 dest AND.size:G #IMM,dest */ + + UNARY_UOP; + imm = IMM(w); + tprintf ("%x & %x = %x\n", v, imm, v & imm); + v &= imm; + set_sz (v, w+1); + put_dest (dc, v); + + /** 1001 0dst AND.B:S #IMM8,dest */ + + imm = IMM(0); + dc = decode_dest3 (dst, 0); + v = get_src (dc); + tprintf("%x & %x = %x\n", v, imm, v & imm); + v &= imm; + set_sz (v, 1); + put_dest (dc, v); + + /** 1001 000w srcx dest AND.size:G src.dest */ + + BINARY_UOP; + tprintf ("%x & %x = %x\n", a, b, a & b); + v = a & b; + set_sz (v, w+1); + put_dest (dc, v); + + /** 0001 0d sr AND.B:S src,R0L/R0H */ + + sc = decode_src2 (sr, 0, d); + dc = decode_dest1 (d, 0); + a = get_src (sc); + b = get_src (dc); + v = a & b; + tprintf("%x & %x = %x\n", a, b, v); + set_sz (v, 1); + put_dest (dc, v); + + /** 0111 1110 0100 srcx BAND src */ + + BIT_OPC (srcx, b & carry); + + /** 0111 1110 1000 dest BCLR:G dest */ + + dc = decode_bit (dest); + put_bit (dc, 0); + + /** 0100 0bit BCLR:S bit,base:11[SB] */ + + dc = decode_bit11 (bit); + put_bit (dc, 0); + + /** 0111 1110 0010 dest BMcnd dest */ + + dc = decode_bit (dest); + if (condition_true (IMM (0))) + put_bit (dc, 1); + else + put_bit (dc, 0); + + /** 0111 1101 1101 cond BMcnd C */ + + if (condition_true (cond)) + set_c (1); + else + set_c (0); + + /** 0111 1110 0101 srcx BNAND src */ + + BIT_OPC (srcx, !b & carry); + + /** 0111 1110 0111 srcx BNOR src */ + + BIT_OPC (srcx, !b | carry); + + /** 0111 1110 1010 dest BNOT:G dest */ + + BIT_OP (dest, !b); + + /** 0101 0bit BNOT:S bit,base:11[SB] */ + + dc = decode_bit11 (bit); + put_bit (dc, !get_bit (dc)); + + /** 0111 1110 0011 srcx BNTST src */ + + dc = decode_bit (srcx); + b = get_bit (dc); + set_zc (!b, !b); + + /** 0111 1110 1101 srcx BNXOR src */ + + BIT_OPC (srcx, !b ^ carry); + + /** 0111 1110 0110 srcx BOR src */ + + BIT_OPC (srcx, b | carry); + + /** 0000 0000 BRK */ + + /* We report the break to our caller with the PC still pointing at the + breakpoint instruction. */ + put_reg (pc, orig_pc); + if (verbose) + printf("[break]\n"); + return M32C_MAKE_HIT_BREAK (); + + /** 0111 1110 1001 dest BSET:G dest */ + + dc = decode_bit (dest); + put_bit (dc, 1); + + /** 0100 1bit BSET:S bit,base:11[SB] */ + + dc = decode_bit11 (bit); + put_bit (dc, 1); + + /** 0111 1110 1011 srcx BTST:G src */ + + dc = decode_bit (srcx); + b = get_bit (dc); + set_zc (!b, b); + + /** 0101 1bit BTST:S bit,base:11[SB] */ + + dc = decode_bit11 (bit); + b = get_bit (dc); + set_zc (!b, b); + + /** 0111 1110 0000 dest BTSTC dest */ + + dc = decode_bit (dest); + b = get_bit (dc); + set_zc (!b, b); + put_bit (dc, 0); + + /** 0111 1110 0001 dest BTSTS dest */ + + dc = decode_bit (dest); + b = get_bit (dc); + set_zc (!b, b); + put_bit (dc, 1); + + /** 0111 1110 1100 srcx BXOR src */ + + BIT_OPC (srcx, b ^ carry); + + /** 0111 011w 1000 dest CMP.size:G #IMM,dest */ + + UNARY_UOP; + imm = IMM(w); + cmp (v, imm, w); + + /** 1101 000w immm dest CMP.size:Q #IMM,dest */ + + UNARY_UOP; + immm = sign_ext (immm, 4); + cmp (v, immm, w); + + /** 1110 0dst CMP.B:S #IMM8,dest */ + + imm = IMM(0); + dc = decode_dest3 (dst, 0); + v = get_src (dc); + cmp (v, imm, 0); + + /** 1100 000w srcx dest CMP.size:G src,dest */ + + BINARY_UOP; + cmp(b, a, w); + + /** 0011 1d sr CMP.B:S src,R0L/R0H */ + + sc = decode_src2 (sr, 0, d); + dc = decode_dest1 (d, 0); + a = get_src (sc); + b = get_src (dc); + cmp (b, a, 0); + + /** 0111 110w 1110 i1c s DADC,DADD,DSBB,DSUB */ + + /* w = width, i = immediate, c = carry, s = subtract */ + + int src = i ? IMM(w) : get_reg (w ? r1 : r0h); + int dest = get_reg (w ? r0 : r0l); + int res; + + src = bcd2int(src, w); + dest = bcd2int(dest, w); + + tprintf("decimal: %d %s %d", dest, s?"-":"+", src); + if (c) + tprintf(" c=%d", carry); + + if (!s) + { + res = dest + src; + if (c) + res += carry; + c = res > (w ? 9999 : 99); + } + else + { + res = dest - src; + if (c) + res -= (1-carry); + c = res >= 0; + if (res < 0) + res += w ? 10000 : 100; + } + + res = int2bcd (res, w); + tprintf(" = %x\n", res); + + set_szc (res, w+1, c); + + put_reg (w ? r0 : r0l, res); + + /** 1010 1dst DEC.B dest */ + + dc = decode_dest3 (dst, 0); + v = get_src (dc); + tprintf("%x -- = %x\n", v, v-1); + v --; + set_sz (v, 1); + put_dest (dc, v); + + /** 1111 d010 DEC.W dest */ + + v = get_reg (d ? a1 : a0); + tprintf("%x -- = %x\n", v, v-1); + v --; + set_sz (v, 2); + put_reg (d ? a1 : a0, v); + + /** 0111 110w 1110 0001 DIV.size #IMM */ + + div_op (-1, 0, 0, w); + + /** 0111 011w 1101 srcx DIV.size src */ + + div_op (srcx, 0, 0, w); + + /** 0111 110w 1110 0000 DIVU.size #IMM */ + + div_op (-1, 1, 0, w); + + /** 0111 011w 1100 srcx DIVU.size src */ + + div_op (srcx, 1, 0, w); + + /** 0111 110w 1110 0011 DIVX.size #IMM */ + + div_op (-1, 0, 1, w); + + /** 0111 011w 1001 srcx DIVX.size src */ + + div_op (srcx, 0, 1, w); + + /** 0111 1100 1111 0010 ENTER #IMM8 */ + + imm = IMM(0); + put_reg (sp, get_reg (sp) - 2); + mem_put_hi (get_reg (sp), get_reg (fb)); + put_reg (fb, get_reg (sp)); + put_reg (sp, get_reg (sp) - imm); + + /** 0111 1101 1111 0010 EXITD */ + + put_reg (sp, get_reg (fb)); + put_reg (fb, mem_get_hi (get_reg (sp))); + put_reg (sp, get_reg (sp) + 2); + put_reg (pc, mem_get_psi (get_reg (sp))); + put_reg (sp, get_reg (sp) + 3); + + /** 0111 1100 0110 dest EXTS.B dest */ + + dc = decode_srcdest4 (dest, 0); + v = sign_ext (get_src (dc), 8); + dc = widen_sd (dc); + put_dest (dc, v); + set_sz (v, 1); + + /** 0111 1100 1111 0011 EXTS.W R0 */ + + v = sign_ext (get_reg (r0), 16); + put_reg (r2r0, v); + set_sz (v, 2); + + /** 1110 1011 0flg 0101 FCLR dest */ + + set_flags (1 << flg, 0); + + /** 1110 1011 0flg 0100 FSET dest */ + + set_flags (1 << flg, 1 << flg); + + /** 1010 0dst INC.B dest */ + + dc = decode_dest3 (dst, 0); + v = get_src (dc); + tprintf("%x ++ = %x\n", v, v+1); + v ++; + set_sz (v, 1); + put_dest (dc, v); + + /** 1011 d010 INC.W dest */ + + v = get_reg (d ? a1 : a0); + tprintf("%x ++ = %x\n", v, v+1); + v ++; + set_sz (v, 2); + put_reg (d ? a1 : a0, v); + + /** 1110 1011 11vector INT #imm */ + + trigger_based_interrupt (vector); + + /** 1111 0110 INTO */ + + if (FLAG_O) + trigger_fixed_interrupt (0xffe0); + + /** 0110 1cnd Jcnd label */ + + v = sign_ext (IMM(0), 8); + if (condition_true (cnd)) + put_reg (pc, orig_pc + 1 + v); + + /** 0111 1101 1100 cond Jcnd label */ + + v = sign_ext (IMM(0), 8); + if (condition_true (cond)) + put_reg (pc, orig_pc + 2 + v); + + /** 0110 0dsp JMP.S label */ + + put_reg (pc, orig_pc + 2 + dsp); + + /** 1111 1110 JMP.B label */ + + imm = sign_ext (IMM(0), 8); + if (imm == -1) + { + if (verbose) + printf("[jmp-to-self detected as exit]\n"); + return M32C_MAKE_HIT_BREAK (); + } + put_reg (pc, orig_pc + 1 + imm); + + /** 1111 0100 JMP.W label */ + + imm = sign_ext (IMM(1), 16); + put_reg (pc, orig_pc + 1 + imm); + + /** 1111 1100 JMP.A label */ + + imm = IMM(2); + put_reg (pc, imm); + + /** 0111 1101 0010 srcx JMPI.W src */ + + sc = decode_jumpdest (srcx, 1); + a = get_src (sc); + a = sign_ext (a, 16); + put_reg (pc, orig_pc + a); + + /** 0111 1101 0000 srcx JMPI.A src */ + + sc = decode_jumpdest (srcx, 0); + a = get_src (sc); + put_reg (pc, a); + + /** 1110 1110 JMPS #IMM8 */ + + M16C_ONLY(); + + imm = IMM(0); + a = 0xf0000 + mem_get_hi (0xffffe - imm * 2); + put_reg (pc, a); + + /** 1111 0101 JSR.W label */ + + imm = sign_ext (IMM(1), 16); + put_reg (sp, get_reg (sp) - 3); + mem_put_psi (get_reg (sp), get_reg (pc)); + put_reg (pc, orig_pc + imm + 1); + + /** 1111 1101 JSR.A label */ + + imm = IMM(2); + put_reg (sp, get_reg (sp) - 3); + mem_put_psi (get_reg (sp), get_reg (pc)); + put_reg (pc, imm); + + /** 0111 1101 0011 srcx JSRI.W src */ + + sc = decode_jumpdest (srcx, 1); + a = get_src (sc); + a = sign_ext (a, 16); + + put_reg (sp, get_reg (sp) - 3); + mem_put_psi (get_reg (sp), get_reg (pc)); + put_reg (pc, orig_pc + a); + + /** 0111 1101 0001 srcx JSRI.A src */ + + sc = decode_jumpdest (srcx, 0); + a = get_src (sc); + + put_reg (sp, get_reg (sp) - 3); + mem_put_psi (get_reg (sp), get_reg (pc)); + put_reg (pc, a); + + /** 1110 1111 JSRS #IMM8 */ + + M16C_ONLY(); + + imm = IMM(0); + a = 0xf0000 + mem_get_hi (0xffffe - imm * 2); + + put_reg (sp, get_reg (sp) - 3); + mem_put_psi (get_reg (sp), get_reg (pc)); + put_reg (pc, a); + + /** 1110 1011 0reg 0000 LDC #IMM16,dest */ + + dc = decode_cr (reg); + imm = IMM(1); + put_dest (dc, imm); + + /** 0111 1010 1reg srcx LDC src,dest */ + + dc = decode_cr (reg); + sc = decode_srcdest4 (srcx,1); + put_dest (dc, get_src (sc)); + + /** 0111 1100 1111 0000 LDCTX abs16,abs20 */ + + NOTYET(); + + /** 0111 010w 1000 dest LDE.size abs20,dest */ + + dc = decode_srcdest4 (dest, w); + imm = IMM(2); + if (w) + v = mem_get_hi (imm); + else + v = mem_get_qi (imm); + put_dest (dc, v); + + /** 0111 010w 1001 dest LDE.size dsp:20[a0], dest */ + + dc = decode_srcdest4 (dest, w); + imm = IMM(2) + get_reg (a0); + if (w) + v = mem_get_hi (imm); + else + v = mem_get_qi (imm); + put_dest (dc, v); + + /** 0111 010w 1010 dest LDE.size [a1a0],dest */ + + dc = decode_srcdest4 (dest, w); + imm = get_reg (a1a0); + if (w) + v = mem_get_hi (imm); + else + v = mem_get_qi (imm); + put_dest (dc, v); + + /** 0111 1101 1010 0imm LDIPL #IMM */ + + set_flags (0x700, imm*0x100); + + /** 0111 010w 1100 dest MOV.size:G #IMM,dest */ + + UNARY_UOP; + imm = IMM(w); + v = imm; + tprintf("%x = %x\n", v, v); + set_sz(v, w+1); + put_dest (dc, v); + + /** 1101 100w immm dest MOV.size:Q #IMM,dest */ + + UNARY_SOP; + v = sign_ext (immm, 4); + tprintf ("%x = %x\n", v, v); + set_sz (v, w+1); + put_dest (dc, v); + + /** 1100 0dst MOV.B:S #IMM8,dest */ + + imm = IMM(0); + dc = decode_dest3 (dst, 0); + v = imm; + tprintf("%x = %x\n", v, v); + set_sz (v, 1); + put_dest (dc, v); + + /** 1w10 d010 MOV.size:S #IMM,dest */ + + /* Note that for w, 0=W and 1=B unlike the usual meaning. */ + v = IMM(1-w); + tprintf("%x = %x\n", v, v); + set_sz (v, 2-w); + put_reg (d ? a1 : a0, v); + + /** 1011 0dst MOV.B:Z #0,dest */ + + dc = decode_dest3 (dst, 0); + v = 0; + set_sz (v, 1); + put_dest (dc, v); + + /** 0111 001w srcx dest MOV.size:G src,dest */ + + sc = decode_srcdest4 (srcx, w); + dc = decode_srcdest4 (dest, w); + v = get_src (sc); + set_sz (v, w+1); + put_dest (dc, v); + + /** 0011 0d sr MOV.B:S src,dest */ + + sc = decode_src2 (sr, 0, d); + v = get_src (sc); + set_sz (v, 1); + put_reg (d ? a1 : a0, v); + + /** 0000 0s ds MOV.B:S R0L/R0H,dest */ + + if (ds == 0) + UNSUPPORTED(); + dc = decode_src2 (ds, 0, s); + v = get_reg (s ? r0h : r0l); + set_sz (v, 1); + put_dest (dc, v); + + /** 0000 1d sr MOV.B:S src,R0L/R0H */ + + sc = decode_src2 (sr, 0, d); + v = get_src (sc); + set_sz (v, 1); + put_reg (d ? r0h : r0l, v); + + /** 0111 010w 1011 dest MOV.size:G dsp:8[SP], dest */ + + dc = decode_srcdest4 (dest, w); + imm = IMM(0); + a = get_reg (sp) + sign_ext (imm, 8); + a &= addr_mask; + if (w) + v = mem_get_hi (a); + else + v = mem_get_qi (a); + set_sz (v, w+1); + put_dest (dc, v); + + /** 0111 010w 0011 srcx MOV.size:G src, disp8[SP] */ + + sc = decode_srcdest4 (srcx, w); + imm = IMM(0); + a = get_reg (sp) + sign_ext (imm, 8); + a &= addr_mask; + v = get_src (sc); + if (w) + mem_put_hi (a, v); + else + mem_put_qi (a, v); + set_sz (v, w+1); + + /** 1110 1011 0reg 1src MOVA src,dest */ + + static reg_id map[] = { r0, r1, r2, r3, a0, a1, 0, 0 }; + sc = decode_srcdest4 (8 + src, 0); + put_reg (map[reg], sc.u.addr); + + /** 0111 1100 10hl dest MOVdir R0L,dest */ + + if (dest == 0 || dest == 4 || dest == 5) + UNSUPPORTED(); + dc = decode_srcdest4 (dest, 0); + a = get_src (dc); + b = get_reg (r0l); + switch (hl) + { + case 0: a = (a & 0xf0) | (b & 0x0f); break; + case 1: a = (a & 0xf0) | ((b>>4) & 0x0f); break; + case 2: a = (a & 0x0f) | ((b & 0x0f)<<4); break; + case 3: a = (a & 0x0f) | (b & 0xf0); break; + } + put_dest (dc, a); + + /** 0111 1100 00hl srcx MOVdir src,R0L */ + + if (srcx == 0 || srcx == 4 || srcx == 5) + UNSUPPORTED(); + sc = decode_srcdest4 (srcx, 0); + a = get_reg (r0l); + b = get_src (sc); + switch (hl) + { + case 0: a = (a & 0xf0) | (b & 0x0f); break; + case 1: a = (a & 0xf0) | ((b>>4) & 0x0f); break; + case 2: a = (a & 0x0f) | ((b & 0x0f)<<4); break; + case 3: a = (a & 0x0f) | (b & 0xf0); break; + } + put_reg (r0l, a); + + /** 0111 110w 0101 dest MUL.size #IMM,dest */ + + UNARY_SOP; + imm = sign_ext (IMM(w), w?16:8); + tprintf("%d * %d = %d\n", v, imm, v*imm); + v *= imm; + dc = widen_sd (dc); + put_dest (dc, v); + + /** 0111 100w srcx dest MUL.size src,dest */ + + BINARY_SOP; + v = a * b; + tprintf("%d * %d = %d\n", a, b, v); + dc = widen_sd (dc); + put_dest (dc, v); + + /** 0111 110w 0100 dest MULU.size #IMM,dest */ + + UNARY_UOP; + imm = IMM(w); + tprintf("%u * %u = %u\n", v, imm, v*imm); + v *= imm; + dc = widen_sd (dc); + put_dest (dc, v); + + /** 0111 000w srcx dest MULU.size src,dest */ + + BINARY_UOP; + v = a * b; + tprintf("%u * %u = %u\n", a, b, v); + dc = widen_sd (dc); + put_dest (dc, v); + + /** 0111 010w 0101 dest NEG.size dest */ + + UNARY_SOP; + tprintf("%d * -1 = %d\n", v, -v); + v = -v; + set_oszc (v, w+1, v == 0); + put_dest (dc, v); + + /** 0000 0100 NOP */ + + tprintf("nop\n"); + + /** 0111 010w 0111 dest NOT.size:G */ + + UNARY_UOP; + tprintf("~ %x = %x\n", v, ~v); + v = ~v; + set_sz (v, w+1); + put_dest (dc, v); + + /** 1011 1dst NOT.B:S dest */ + + dc = decode_dest3 (dst, 0); + v = get_src (dc); + tprintf("~ %x = %x\n", v, ~v); + v = ~v; + set_sz (v, 1); + put_dest (dc, v); + + /** 0111 011w 0011 dest OR.size:G #IMM,dest */ + + UNARY_UOP; + imm = IMM(w); + tprintf ("%x | %x = %x\n", v, imm, v | imm); + v |= imm; + set_sz (v, w+1); + put_dest (dc, v); + + /** 1001 1dst OR.B:S #IMM8,dest */ + + imm = IMM(0); + dc = decode_dest3 (dst, 0); + v = get_src (dc); + tprintf("%x | %x = %x\n", v, imm, v|imm); + v |= imm; + set_sz (v, 1); + put_dest (dc, v); + + /** 1001 100w srcx dest OR.size:G src,dest */ + + BINARY_UOP; + tprintf ("%x | %x = %x\n", a, b, a | b); + v = a | b; + set_sz (v, w+1); + put_dest (dc, v); + + /** 0001 1d sr OR.B:S src,R0L/R0H */ + + sc = decode_src2 (sr, 0, d); + dc = decode_dest1 (d, 0); + a = get_src (sc); + b = get_src (dc); + v = a | b; + tprintf("%x | %x = %x\n", a, b, v); + set_sz (v, 1); + put_dest (dc, v); + + /** 0111 010w 1101 dest POP.size:G dest */ + + dc = decode_srcdest4 (dest, w); + if (w) + { + v = mem_get_hi (get_reg (sp)); + put_reg (sp, get_reg (sp) + 2); + tprintf("pophi: %x\n", v); + } + else + { + v = mem_get_qi (get_reg (sp)); + put_reg (sp, get_reg (sp) + 1); + tprintf("popqi: %x\n", v); + } + put_dest (dc, v); + + /** 1001 d010 POP.B:S dest */ + + v = mem_get_qi (get_reg (sp)); + put_reg (d ? r0h : r0l, v); + put_reg (sp, get_reg (sp) + 1); + tprintf("popqi: %x\n", v); + + /** 1101 d010 POP.W:S dest */ + + v = mem_get_hi (get_reg (sp)); + put_reg (d ? a1 : a0, v); + put_reg (sp, get_reg (sp) + 2); + tprintf("pophi: %x\n", v); + + /** 1110 1011 0reg 0011 POPC dest */ + + dc = decode_cr (reg); + v = mem_get_hi (get_reg (sp)); + put_dest (dc, v); + put_reg (sp, get_reg (sp) + 2); + tprintf("popc: %x\n", v); + + /** 1110 1101 POPM dest */ + + static int map[] = { r0, r1, r2, r3, a0, a1, sb, fb }; + imm = IMM(0); + tprintf("popm: %x\n", imm); + for (a=0; a<8; a++) + if (imm & (1<<a)) + { + v = mem_get_hi (get_reg (sp)); + put_reg (map[a], v); + put_reg (sp, get_reg (sp) + 2); + } + + /** 0111 110w 1110 0010 PUSH.size:G #IMM */ + + imm = IMM(w); + if (w) + { + put_reg (sp, get_reg (sp) - 2); + mem_put_hi (get_reg (sp), imm); + tprintf("pushhi %04x\n", imm); + } + else + { + put_reg (sp, get_reg (sp) - 1); + mem_put_qi (get_reg (sp), imm); + tprintf("pushqi %02x\n", imm); + } + + /** 0111 010w 0100 srcx PUSH.size:G src */ + + sc = decode_srcdest4 (srcx, w); + v = get_src (sc); + if (w) + { + put_reg (sp, get_reg (sp) - 2); + mem_put_hi (get_reg (sp), v); + tprintf("pushhi: %x\n", v); + } + else + { + put_reg (sp, get_reg (sp) - 1); + mem_put_qi (get_reg (sp), v); + tprintf("pushqi: %x\n", v); + } + + /** 1000 s010 PUSH.B:S src */ + + v = get_reg (s ? r0h : r0l); + put_reg (sp, get_reg (sp) - 1); + mem_put_qi (get_reg (sp), v); + tprintf("pushqi: %x\n", v); + + /** 1100 s010 PUSH.W:S src */ + + v = get_reg (s ? a1 : a0); + put_reg (sp, get_reg (sp) - 2); + mem_put_hi (get_reg (sp), v); + tprintf("pushhi: %x\n", v); + + /** 0111 1101 1001 srcx PUSHA src */ + + sc = decode_srcdest4 (srcx, 0); + put_reg (sp, get_reg (sp) - 2); + mem_put_hi (get_reg (sp), sc.u.addr); + tprintf("pushhi: %x\n", sc.u.addr); + + /** 1110 1011 0src 0010 PUSHC src */ + + sc = decode_cr (src); + put_reg (sp, get_reg (sp) - 2); + v = get_src (sc); + mem_put_hi (get_reg (sp), v); + tprintf("pushc: %x\n", v); + + /** 1110 1100 PUSHM src */ + + static int map[] = { fb, sb, a1, a0, r3, r2, r1, r0 }; + imm = IMM(0); + tprintf("pushm: %x\n", imm); + for (a=0; a<8; a++) + if (imm & (1<<a)) + { + put_reg (sp, get_reg (sp) - 2); + v = get_reg (map[a]); + mem_put_hi (get_reg (sp), v); + } + + /** 1111 1011 REIT */ + + a = get_reg (sp); + v = (mem_get_hi (a) + + 65536 * (mem_get_qi (a+3) & 0x0f)); + b = (mem_get_qi (a+2) + + 16 * (mem_get_qi (a+3) & 0xf0)); + put_reg (pc, v); + put_reg (flags, b); + put_reg (sp, get_reg (sp) + 4); + + /** 0111 110w 1111 0001 RMPA.size */ + + int count = get_reg (r3); + int list1 = get_reg (a0); + int list2 = get_reg (a1); + int sum = get_reg (w ? r2r0 : r0); + + while (count) + { + if (w) + { + a = sign_ext (mem_get_hi (list1), 16); + b = sign_ext (mem_get_hi (list2), 16); + } + else + { + a = sign_ext (mem_get_qi (list1), 8); + b = sign_ext (mem_get_qi (list2), 8); + } + tprintf("%d + %d * %d = ", sum, a, b); + sum += a * b; + tprintf("%d\n", sum); + list1 += w ? 2 : 1; + list2 += w ? 2 : 1; + count --; + } + put_reg (r3, count); + put_reg (a0, list1); + put_reg (a1, list2); + put_reg (w ? r2r0 : r0, sum); + + /** 0111 011w 1010 dest ROLC.size dest */ + + dc = decode_srcdest4 (dest, w); + rot_op (dc, 1, 1); + + /** 0111 011w 1011 dest RORC.size dest */ + + dc = decode_srcdest4 (dest, w); + rot_op (dc, 1, -1); + + /** 1110 000w immm dest ROT.size #IMM,dest */ + + dc = decode_srcdest4 (dest, w); + rot_op (dc, 0, IMM4()); + + /** 0111 010w 0110 dest ROT.size R1H,dest */ + + dc = decode_srcdest4 (dest, w); + rot_op (dc, 0, sign_ext (get_reg (r1h), 8)); + + /** 1111 0011 RTS */ + + put_reg (pc, mem_get_psi (get_reg (sp))); + put_reg (sp, get_reg (sp) + 3); + + /** 0111 011w 0111 dest SBB.size #IMM,dest */ + + dc = decode_srcdest4 (dest, w); + imm = IMM(w); + MATH_OP (dc, imm, !carry, -, >= 0); + + /** 1011 100w srcx dest SBB.size src,dest */ + + sc = decode_srcdest4(srcx, w); + dc = decode_srcdest4(dest, w); + b = get_src (sc); + MATH_OP (dc, b, !carry, -, >= 0); + + /** 1111 000w immm dest SHA.size #IMM, dest */ + + dc = decode_srcdest4(dest, w); + shift_op (dc, 1, IMM4()); + + /** 0111 010w 1111 dest SHA.size R1H,dest */ + + dc = decode_srcdest4(dest, w); + a = sign_ext (get_reg (r1h), 8); + shift_op (dc, 1, a); + + /** 1110 1011 101d immm SHA.L #IMM, dest */ + + dc = reg_sd (d ? r3r1 : r2r0); + shift_op (dc, 1, IMM4()); + + /** 1110 1011 001d 0001 SHA.L R1H,dest */ + + dc = reg_sd (d ? r3r1 : r2r0); + a = sign_ext (get_reg (r1h), 8); + shift_op (dc, 1, a); + + /** 1110 100w immm dest SHL.size #IMM, dest */ + + dc = decode_srcdest4(dest, w); + shift_op (dc, 0, IMM4()); + + /** 0111 010w 1110 dest SHL.size R1H,dest */ + + dc = decode_srcdest4(dest, w); + a = sign_ext (get_reg (r1h), 8); + shift_op (dc, 0, a); + + /** 1110 1011 100d immm SHL.L #IMM,dest */ + + dc = reg_sd (d ? r3r1 : r2r0); + shift_op (dc, 0, IMM4()); + + /** 1110 1011 000d 0001 SHL.L R1H,dest */ + + dc = reg_sd (d ? r3r1 : r2r0); + a = sign_ext (get_reg (r1h), 8); + shift_op (dc, 0, a); + + /** 0111 110w 1110 100b SMOVB.size */ + + int count = get_reg (r3); + int s1 = get_reg (a0) + (get_reg (r1h) << 16); + int s2 = get_reg (a1); + int inc = (w ? 2 : 1) * (b ? -1 : 1); + + while (count) + { + if (w) + { + v = mem_get_hi (s1); + mem_put_hi (s2, v); + } + else + { + v = mem_get_qi (s1); + mem_put_qi (s2, v); + } + s1 += inc; + s2 += inc; + count --; + } + put_reg (r3, count); + put_reg (a0, s1 & 0xffff); + put_reg (a1, s2); + put_reg (r1h, s1 >> 16); + + /** 0111 110w 1110 1010 SSTR.size */ + + int count = get_reg (r3); + int s1 = get_reg (a1); + v = get_reg (w ? r0 : r0h); + + while (count) + { + if (w) + { + mem_put_hi (s1, v); + s1 += 2; + } + else + { + mem_put_qi (s1, v); + s1 += 1; + } + count --; + } + put_reg (r3, count); + put_reg (a1, s1); + + /** 0111 1011 1src dest STC src,dest */ + + dc = decode_srcdest4 (dest, 1); + sc = decode_cr (src); + put_dest (dc, get_src(sc)); + + /** 0111 1100 1100 dest STC PC,dest */ + + dc = decode_srcdest4 (dest, 1); + dc.bytes = 3; + put_dest (dc, orig_pc); + + /** 0111 1101 1111 0000 STCTX abs16,abs20 */ + + NOTYET(); + + /** 0111 010w 0000 srcx STE.size src,abs20 */ + + sc = decode_srcdest4 (srcx, w); + a = IMM(2); + v = get_src (sc); + if (w) + mem_put_hi (a, v); + else + mem_put_qi (a, v); + if (srcx == 4 || srcx == 5) + { + v = get_reg (sc.u.reg); + set_sz (v, 2); + } + else + set_sz (v, w+1); + + /** 0111 010w 0001 srcx STE.size src,disp20[a0] */ + + sc = decode_srcdest4 (srcx, w); + a = get_reg(a0) + IMM(2); + v = get_src (sc); + if (w) + mem_put_hi (a, v); + else + mem_put_qi (a, v); + if (srcx == 4 || srcx == 5) + { + v = get_reg (sc.u.reg); + set_sz (v, 2); + } + else + set_sz (v, w+1); + + /** 0111 010w 0010 srcx STE.size src,[a1a0] */ + + sc = decode_srcdest4 (srcx, w); + a = get_reg(a1a0); + v = get_src (sc); + if (w) + mem_put_hi (a, v); + else + mem_put_qi (a, v); + if (srcx == 4 || srcx == 5) + { + v = get_reg (sc.u.reg); + set_sz (v, 2); + } + else + set_sz (v, w+1); + + /** 1101 0dst STNZ #IMM8,dest */ + + imm = IMM(0); + dc = decode_dest3(dst, 0); + if (!FLAG_Z) + put_dest (dc, imm); + + /** 1100 1dst STZ #IMM8,dest */ + + imm = IMM(0); + dc = decode_dest3(dst, 0); + if (FLAG_Z) + put_dest (dc, imm); + + /** 1101 1dst STZX #IMM81,#IMM82,dest */ + + a = IMM(0); + dc = decode_dest3(dst, 0); + b = IMM(0); + if (FLAG_Z) + put_dest (dc, a); + else + put_dest (dc, b); + + /** 0111 011w 0101 dest SUB.size:G #IMM,dest */ + + dc = decode_srcdest4 (dest, w); + imm = IMM(w); + MATH_OP (dc, imm, 0, -, >= 0); + + /** 1000 1dst SUB.B:S #IMM8,dest */ + + imm = IMM(0); + dc = decode_dest3 (dst, 0); + MATH_OP (dc, imm, 0, -, >= 0); + + /** 1010 100w srcx dest SUB.size:G src,dest */ + + sc = decode_srcdest4(srcx, w); + dc = decode_srcdest4(dest, w); + b = get_src (sc); + MATH_OP (dc, b, 0, -, > 0); + + /** 0010 1d sr SUB.B:S src,R0L/R0H */ + + sc = decode_src2 (sr, 0, d); + dc = decode_dest1 (d, 0); + b = get_src (sc); + MATH_OP (dc, b, 0, -, > 0); + + /** 0111 011w 0000 dest TST.size #IMM, dest */ + + UNARY_UOP; + imm = IMM(w); + tprintf ("%x & %x = %x\n", v, imm, v & imm); + v &= imm; + set_sz (v, w+1); + + /** 1000 000w srcx dest TST.size src,dest */ + + BINARY_UOP; + tprintf ("%x & %x = %x\n", a, b, a & b); + v = a & b; + set_sz (v, w+1); + + /** 1111 1111 UND */ + + trigger_fixed_interrupt (0xffdc); + + /** 0111 1101 1111 0011 WAIT */ + + tprintf("waiting...\n"); + + /** 0111 101w 00sr dest XCHG.size src,dest */ + + sc = decode_srcdest4 (sr, w); + dc = decode_srcdest4 (dest, w); + a = get_src (sc); + b = get_src (dc); + put_dest (dc, a); + put_dest (sc, b); + + /** 0111 011w 0001 dest XOR.size #IMM,dest */ + + UNARY_UOP; + imm = IMM(w); + tprintf ("%x ^ %x = %x\n", v, imm, v ^ imm); + v ^= imm; + set_sz (v, w+1); + put_dest (dc, v); + + /** 1000 100w srcx dest XOR.size src,dest */ + + BINARY_UOP; + tprintf ("%x ^ %x = %x\n", a, b, a ^ b); + v = a ^ b; + set_sz (v, w+1); + put_dest (dc, v); + + /** OP */ +/** */ + + return step_result; +} |