| /* |
| * Simulator for the Renesas (formerly Hitachi) H8/300 architecture. |
| * |
| * Written by Steve Chamberlain of Cygnus Support. sac@cygnus.com |
| * |
| * This file is part of H8/300 sim |
| * |
| * |
| * THIS SOFTWARE IS NOT COPYRIGHTED |
| * |
| * Cygnus offers the following for use in the public domain. Cygnus makes no |
| * warranty with regard to the software or its performance and the user |
| * accepts the software "AS IS" with all faults. |
| * |
| * CYGNUS DISCLAIMS ANY WARRANTIES, EXPRESS OR IMPLIED, WITH REGARD TO THIS |
| * SOFTWARE INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY |
| * AND FITNESS FOR A PARTICULAR PURPOSE. |
| */ |
| |
| /* This must come before any other includes. */ |
| #include "defs.h" |
| |
| #include <signal.h> |
| #include <time.h> |
| #include <stdlib.h> |
| #ifdef HAVE_SYS_PARAM_H |
| #include <sys/param.h> |
| #endif |
| |
| #include "bfd.h" |
| #include "sim-main.h" |
| #include "gdb/sim-h8300.h" |
| #include "sys/stat.h" |
| #include "sys/types.h" |
| #include "sim-options.h" |
| #include "sim-signal.h" |
| #include "sim/callback.h" |
| |
| #ifndef SIGTRAP |
| # define SIGTRAP 5 |
| #endif |
| |
| int debug; |
| |
| static int memory_size; |
| |
| #define X(op, size) (op * 4 + size) |
| |
| #define SP (h8300hmode && !h8300_normal_mode ? SL : SW) |
| |
| #define h8_opcodes ops |
| #define DEFINE_TABLE |
| #include "opcode/h8300.h" |
| |
| /* CPU data object: */ |
| |
| static unsigned int |
| h8_get_pc (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> pc; |
| } |
| |
| static void |
| h8_set_pc (SIM_DESC sd, unsigned int val) |
| { |
| (STATE_CPU (sd, 0)) -> pc = val; |
| } |
| |
| static unsigned int |
| h8_get_ccr (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> regs[CCR_REGNUM]; |
| } |
| |
| static void |
| h8_set_ccr (SIM_DESC sd, unsigned int val) |
| { |
| (STATE_CPU (sd, 0)) -> regs[CCR_REGNUM] = val; |
| } |
| |
| static unsigned int |
| h8_get_exr (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> regs[EXR_REGNUM]; |
| } |
| |
| static void |
| h8_set_exr (SIM_DESC sd, unsigned int val) |
| { |
| (STATE_CPU (sd, 0)) -> regs[EXR_REGNUM] = val; |
| } |
| |
| static int |
| h8_get_sbr (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> regs[SBR_REGNUM]; |
| } |
| |
| static void |
| h8_set_sbr (SIM_DESC sd, int val) |
| { |
| (STATE_CPU (sd, 0)) -> regs[SBR_REGNUM] = val; |
| } |
| |
| static int |
| h8_get_vbr (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> regs[VBR_REGNUM]; |
| } |
| |
| static void |
| h8_set_vbr (SIM_DESC sd, int val) |
| { |
| (STATE_CPU (sd, 0)) -> regs[VBR_REGNUM] = val; |
| } |
| |
| static int |
| h8_get_mask (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> mask; |
| } |
| |
| static void |
| h8_set_mask (SIM_DESC sd, int val) |
| { |
| (STATE_CPU (sd, 0)) -> mask = val; |
| } |
| #if 0 |
| static int |
| h8_get_exception (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> exception; |
| } |
| |
| static void |
| h8_set_exception (SIM_DESC sd, int val) |
| { |
| (STATE_CPU (sd, 0)) -> exception = val; |
| } |
| |
| static enum h8300_sim_state |
| h8_get_state (SIM_DESC sd) |
| { |
| return H8300_SIM_STATE (sd)->state; |
| } |
| |
| static void |
| h8_set_state (SIM_DESC sd, enum h8300_sim_state val) |
| { |
| H8300_SIM_STATE (sd)->state = val; |
| } |
| #endif |
| static unsigned int |
| h8_get_cycles (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> regs[CYCLE_REGNUM]; |
| } |
| |
| static void |
| h8_set_cycles (SIM_DESC sd, unsigned int val) |
| { |
| (STATE_CPU (sd, 0)) -> regs[CYCLE_REGNUM] = val; |
| } |
| |
| static unsigned int |
| h8_get_insts (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> regs[INST_REGNUM]; |
| } |
| |
| static void |
| h8_set_insts (SIM_DESC sd, unsigned int val) |
| { |
| (STATE_CPU (sd, 0)) -> regs[INST_REGNUM] = val; |
| } |
| |
| static unsigned int |
| h8_get_ticks (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> regs[TICK_REGNUM]; |
| } |
| |
| static void |
| h8_set_ticks (SIM_DESC sd, unsigned int val) |
| { |
| (STATE_CPU (sd, 0)) -> regs[TICK_REGNUM] = val; |
| } |
| |
| static unsigned int |
| h8_get_mach (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> regs[MACH_REGNUM]; |
| } |
| |
| static void |
| h8_set_mach (SIM_DESC sd, unsigned int val) |
| { |
| (STATE_CPU (sd, 0)) -> regs[MACH_REGNUM] = val; |
| } |
| |
| static unsigned int |
| h8_get_macl (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> regs[MACL_REGNUM]; |
| } |
| |
| static void |
| h8_set_macl (SIM_DESC sd, unsigned int val) |
| { |
| (STATE_CPU (sd, 0)) -> regs[MACL_REGNUM] = val; |
| } |
| |
| static unsigned int * |
| h8_get_reg_buf (SIM_DESC sd) |
| { |
| return &(((STATE_CPU (sd, 0)) -> regs)[0]); |
| } |
| |
| static unsigned int |
| h8_get_reg (SIM_DESC sd, int regnum) |
| { |
| return (STATE_CPU (sd, 0)) -> regs[regnum]; |
| } |
| |
| static void |
| h8_set_reg (SIM_DESC sd, int regnum, int val) |
| { |
| (STATE_CPU (sd, 0)) -> regs[regnum] = val; |
| } |
| |
| #ifdef ADEBUG |
| static int |
| h8_get_stats (SIM_DESC sd, int idx) |
| { |
| return H8300_SIM_STATE (sd)->stats[idx]; |
| } |
| |
| static void |
| h8_increment_stats (SIM_DESC sd, int idx) |
| { |
| H8300_SIM_STATE (sd)->stats[idx] ++; |
| } |
| #endif /* ADEBUG */ |
| |
| static unsigned char * |
| h8_get_memory_buf (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> memory; |
| } |
| |
| static void |
| h8_set_memory_buf (SIM_DESC sd, unsigned char *ptr) |
| { |
| (STATE_CPU (sd, 0)) -> memory = ptr; |
| } |
| |
| static unsigned char |
| h8_get_memory (SIM_DESC sd, int idx) |
| { |
| ASSERT (idx < memory_size); |
| return (STATE_CPU (sd, 0)) -> memory[idx]; |
| } |
| |
| static void |
| h8_set_memory (SIM_DESC sd, int idx, unsigned int val) |
| { |
| ASSERT (idx < memory_size); |
| (STATE_CPU (sd, 0)) -> memory[idx] = (unsigned char) val; |
| } |
| |
| static unsigned int |
| h8_get_delayed_branch (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> delayed_branch; |
| } |
| |
| static void |
| h8_set_delayed_branch (SIM_DESC sd, unsigned int dest) |
| { |
| (STATE_CPU (sd, 0)) -> delayed_branch = dest; |
| } |
| |
| static char ** |
| h8_get_command_line (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> command_line; |
| } |
| |
| static void |
| h8_set_command_line (SIM_DESC sd, char ** val) |
| { |
| (STATE_CPU (sd, 0)) -> command_line = val; |
| } |
| |
| static char * |
| h8_get_cmdline_arg (SIM_DESC sd, int index) |
| { |
| return (STATE_CPU (sd, 0)) -> command_line[index]; |
| } |
| |
| static void |
| h8_set_cmdline_arg (SIM_DESC sd, int index, char * val) |
| { |
| (STATE_CPU (sd, 0)) -> command_line[index] = val; |
| } |
| |
| /* MAC Saturation Mode */ |
| static int |
| h8_get_macS (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> macS; |
| } |
| |
| #if 0 |
| static void |
| h8_set_macS (SIM_DESC sd, int val) |
| { |
| (STATE_CPU (sd, 0)) -> macS = (val != 0); |
| } |
| #endif |
| |
| /* MAC Zero Flag */ |
| static int |
| h8_get_macZ (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> macZ; |
| } |
| |
| static void |
| h8_set_macZ (SIM_DESC sd, int val) |
| { |
| (STATE_CPU (sd, 0)) -> macZ = (val != 0); |
| } |
| |
| /* MAC Negative Flag */ |
| static int |
| h8_get_macN (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> macN; |
| } |
| |
| static void |
| h8_set_macN (SIM_DESC sd, int val) |
| { |
| (STATE_CPU (sd, 0)) -> macN = (val != 0); |
| } |
| |
| /* MAC Overflow Flag */ |
| static int |
| h8_get_macV (SIM_DESC sd) |
| { |
| return (STATE_CPU (sd, 0)) -> macV; |
| } |
| |
| static void |
| h8_set_macV (SIM_DESC sd, int val) |
| { |
| (STATE_CPU (sd, 0)) -> macV = (val != 0); |
| } |
| |
| /* End CPU data object. */ |
| |
| /* The rate at which to call the host's poll_quit callback. */ |
| |
| enum { POLL_QUIT_INTERVAL = 0x80000 }; |
| |
| #define LOW_BYTE(x) ((x) & 0xff) |
| #define HIGH_BYTE(x) (((x) >> 8) & 0xff) |
| #define P(X, Y) ((X << 8) | Y) |
| |
| #define C (c != 0) |
| #define Z (nz == 0) |
| #define V (v != 0) |
| #define N (n != 0) |
| #define U (u != 0) |
| #define H (h != 0) |
| #define UI (ui != 0) |
| #define I (intMaskBit != 0) |
| |
| #define BUILDSR(SD) \ |
| h8_set_ccr (SD, (I << 7) | (UI << 6) | (H << 5) | (U << 4) \ |
| | (N << 3) | (Z << 2) | (V << 1) | C) |
| |
| #define GETSR(SD) \ |
| /* Get Status Register (flags). */ \ |
| c = (h8_get_ccr (sd) >> 0) & 1; \ |
| v = (h8_get_ccr (sd) >> 1) & 1; \ |
| nz = !((h8_get_ccr (sd) >> 2) & 1); \ |
| n = (h8_get_ccr (sd) >> 3) & 1; \ |
| u = (h8_get_ccr (sd) >> 4) & 1; \ |
| h = (h8_get_ccr (sd) >> 5) & 1; \ |
| ui = ((h8_get_ccr (sd) >> 6) & 1); \ |
| intMaskBit = (h8_get_ccr (sd) >> 7) & 1 |
| |
| |
| #ifdef __CHAR_IS_SIGNED__ |
| #define SEXTCHAR(x) ((char) (x)) |
| #endif |
| |
| #ifndef SEXTCHAR |
| #define SEXTCHAR(x) ((x & 0x80) ? (x | ~0xff) : x & 0xff) |
| #endif |
| |
| #define UEXTCHAR(x) ((x) & 0xff) |
| #define UEXTSHORT(x) ((x) & 0xffff) |
| #define SEXTSHORT(x) ((short) (x)) |
| |
| int h8300hmode = 0; |
| int h8300smode = 0; |
| int h8300_normal_mode = 0; |
| int h8300sxmode = 0; |
| |
| static int |
| get_now (void) |
| { |
| return time (0); /* WinXX HAS UNIX like 'time', so why not use it? */ |
| } |
| |
| static int |
| now_persec (void) |
| { |
| return 1; |
| } |
| |
| static int |
| bitfrom (int x) |
| { |
| switch (x & SIZE) |
| { |
| case L_8: |
| return SB; |
| case L_16: |
| case L_16U: |
| return SW; |
| case L_32: |
| return SL; |
| case L_P: |
| return (h8300hmode && !h8300_normal_mode)? SL : SW; |
| } |
| return 0; |
| } |
| |
| /* Simulate an indirection / dereference. |
| return 0 for success, -1 for failure. |
| */ |
| |
| static unsigned int |
| lvalue (SIM_DESC sd, int x, int rn, unsigned int *val) |
| { |
| SIM_CPU *cpu = STATE_CPU (sd, 0); |
| |
| if (val == NULL) /* Paranoia. */ |
| return -1; |
| |
| switch (x / 4) |
| { |
| case OP_DISP: |
| if (rn == ZERO_REGNUM) |
| *val = X (OP_IMM, SP); |
| else |
| *val = X (OP_REG, SP); |
| break; |
| case OP_MEM: |
| *val = X (OP_MEM, SP); |
| break; |
| default: |
| sim_engine_halt (sd, cpu, NULL, NULL_CIA, sim_stopped, SIM_SIGSEGV); |
| return -1; |
| } |
| return 0; |
| } |
| |
| static int |
| cmdline_location(void) |
| { |
| if (h8300smode && !h8300_normal_mode) |
| return 0xffff00L; |
| else if (h8300hmode && !h8300_normal_mode) |
| return 0x2ff00L; |
| else |
| return 0xff00L; |
| } |
| |
| static void |
| decode (SIM_DESC sd, int addr, unsigned char *data, decoded_inst *dst) |
| { |
| int cst[3] = {0, 0, 0}; |
| int reg[3] = {0, 0, 0}; |
| int rdisp[3] = {0, 0, 0}; |
| int opnum; |
| const struct h8_opcode *q; |
| |
| dst->dst.type = -1; |
| dst->src.type = -1; |
| |
| /* Find the exact opcode/arg combo. */ |
| for (q = h8_opcodes; q->name; q++) |
| { |
| const op_type *nib = q->data.nib; |
| unsigned int len = 0; |
| |
| if ((q->available == AV_H8SX && !h8300sxmode) || |
| (q->available == AV_H8S && !h8300smode) || |
| (q->available == AV_H8H && !h8300hmode)) |
| continue; |
| |
| cst[0] = cst[1] = cst[2] = 0; |
| reg[0] = reg[1] = reg[2] = 0; |
| rdisp[0] = rdisp[1] = rdisp[2] = 0; |
| |
| while (1) |
| { |
| op_type looking_for = *nib; |
| int thisnib = data[len / 2]; |
| |
| thisnib = (len & 1) ? (thisnib & 0xf) : ((thisnib >> 4) & 0xf); |
| opnum = ((looking_for & OP3) ? 2 : |
| (looking_for & DST) ? 1 : 0); |
| |
| if (looking_for < 16 && looking_for >= 0) |
| { |
| if (looking_for != thisnib) |
| goto fail; |
| } |
| else |
| { |
| if (looking_for & B31) |
| { |
| if (!((thisnib & 0x8) != 0)) |
| goto fail; |
| |
| looking_for = (op_type) (looking_for & ~B31); |
| thisnib &= 0x7; |
| } |
| else if (looking_for & B30) |
| { |
| if (!((thisnib & 0x8) == 0)) |
| goto fail; |
| |
| looking_for = (op_type) (looking_for & ~B30); |
| } |
| |
| if (looking_for & B21) |
| { |
| if (!((thisnib & 0x4) != 0)) |
| goto fail; |
| |
| looking_for = (op_type) (looking_for & ~B21); |
| thisnib &= 0xb; |
| } |
| else if (looking_for & B20) |
| { |
| if (!((thisnib & 0x4) == 0)) |
| goto fail; |
| |
| looking_for = (op_type) (looking_for & ~B20); |
| } |
| |
| if (looking_for & B11) |
| { |
| if (!((thisnib & 0x2) != 0)) |
| goto fail; |
| |
| looking_for = (op_type) (looking_for & ~B11); |
| thisnib &= 0xd; |
| } |
| else if (looking_for & B10) |
| { |
| if (!((thisnib & 0x2) == 0)) |
| goto fail; |
| |
| looking_for = (op_type) (looking_for & ~B10); |
| } |
| |
| if (looking_for & B01) |
| { |
| if (!((thisnib & 0x1) != 0)) |
| goto fail; |
| |
| looking_for = (op_type) (looking_for & ~B01); |
| thisnib &= 0xe; |
| } |
| else if (looking_for & B00) |
| { |
| if (!((thisnib & 0x1) == 0)) |
| goto fail; |
| |
| looking_for = (op_type) (looking_for & ~B00); |
| } |
| |
| if (looking_for & IGNORE) |
| { |
| /* Hitachi has declared that IGNORE must be zero. */ |
| if (thisnib != 0) |
| goto fail; |
| } |
| else if ((looking_for & MODE) == DATA) |
| { |
| ; /* Skip embedded data. */ |
| } |
| else if ((looking_for & MODE) == DBIT) |
| { |
| /* Exclude adds/subs by looking at bit 0 and 2, and |
| make sure the operand size, either w or l, |
| matches by looking at bit 1. */ |
| if ((looking_for & 7) != (thisnib & 7)) |
| goto fail; |
| |
| cst[opnum] = (thisnib & 0x8) ? 2 : 1; |
| } |
| else if ((looking_for & MODE) == REG || |
| (looking_for & MODE) == LOWREG || |
| (looking_for & MODE) == IND || |
| (looking_for & MODE) == PREINC || |
| (looking_for & MODE) == POSTINC || |
| (looking_for & MODE) == PREDEC || |
| (looking_for & MODE) == POSTDEC) |
| { |
| reg[opnum] = thisnib; |
| } |
| else if (looking_for & CTRL) |
| { |
| thisnib &= 7; |
| if (((looking_for & MODE) == CCR && (thisnib != C_CCR)) || |
| ((looking_for & MODE) == EXR && (thisnib != C_EXR)) || |
| ((looking_for & MODE) == MACH && (thisnib != C_MACH)) || |
| ((looking_for & MODE) == MACL && (thisnib != C_MACL)) || |
| ((looking_for & MODE) == VBR && (thisnib != C_VBR)) || |
| ((looking_for & MODE) == SBR && (thisnib != C_SBR))) |
| goto fail; |
| if (((looking_for & MODE) == CCR_EXR && |
| (thisnib != C_CCR && thisnib != C_EXR)) || |
| ((looking_for & MODE) == VBR_SBR && |
| (thisnib != C_VBR && thisnib != C_SBR)) || |
| ((looking_for & MODE) == MACREG && |
| (thisnib != C_MACH && thisnib != C_MACL))) |
| goto fail; |
| if (((looking_for & MODE) == CC_EX_VB_SB && |
| (thisnib != C_CCR && thisnib != C_EXR && |
| thisnib != C_VBR && thisnib != C_SBR))) |
| goto fail; |
| |
| reg[opnum] = thisnib; |
| } |
| else if ((looking_for & MODE) == ABS) |
| { |
| /* Absolute addresses are unsigned. */ |
| switch (looking_for & SIZE) |
| { |
| case L_8: |
| cst[opnum] = UEXTCHAR (data[len / 2]); |
| break; |
| case L_16: |
| case L_16U: |
| cst[opnum] = (data[len / 2] << 8) + data[len / 2 + 1]; |
| break; |
| case L_32: |
| cst[opnum] = |
| (data[len / 2 + 0] << 24) + |
| (data[len / 2 + 1] << 16) + |
| (data[len / 2 + 2] << 8) + |
| (data[len / 2 + 3]); |
| break; |
| default: |
| printf ("decode: bad size ABS: %d\n", |
| (looking_for & SIZE)); |
| goto end; |
| } |
| } |
| else if ((looking_for & MODE) == DISP || |
| (looking_for & MODE) == PCREL || |
| (looking_for & MODE) == INDEXB || |
| (looking_for & MODE) == INDEXW || |
| (looking_for & MODE) == INDEXL) |
| { |
| switch (looking_for & SIZE) |
| { |
| case L_2: |
| cst[opnum] = thisnib & 3; |
| break; |
| case L_8: |
| cst[opnum] = SEXTCHAR (data[len / 2]); |
| break; |
| case L_16: |
| cst[opnum] = (data[len / 2] << 8) + data[len / 2 + 1]; |
| cst[opnum] = (short) cst[opnum]; /* Sign extend. */ |
| break; |
| case L_16U: |
| cst[opnum] = (data[len / 2] << 8) + data[len / 2 + 1]; |
| break; |
| case L_32: |
| cst[opnum] = |
| (data[len / 2 + 0] << 24) + |
| (data[len / 2 + 1] << 16) + |
| (data[len / 2 + 2] << 8) + |
| (data[len / 2 + 3]); |
| break; |
| default: |
| printf ("decode: bad size DISP/PCREL/INDEX: %d\n", |
| (looking_for & SIZE)); |
| goto end; |
| } |
| } |
| else if ((looking_for & SIZE) == L_16 || |
| (looking_for & SIZE) == L_16U) |
| { |
| cst[opnum] = (data[len / 2] << 8) + data[len / 2 + 1]; |
| /* Immediates are always unsigned. */ |
| if ((looking_for & SIZE) != L_16U && |
| (looking_for & MODE) != IMM) |
| cst[opnum] = (short) cst[opnum]; /* Sign extend. */ |
| } |
| else if (looking_for & ABSJMP) |
| { |
| switch (looking_for & SIZE) { |
| case L_24: |
| cst[opnum] = (data[1] << 16) | (data[2] << 8) | (data[3]); |
| break; |
| case L_32: |
| cst[opnum] = |
| (data[len / 2 + 0] << 24) + |
| (data[len / 2 + 1] << 16) + |
| (data[len / 2 + 2] << 8) + |
| (data[len / 2 + 3]); |
| break; |
| default: |
| printf ("decode: bad size ABSJMP: %d\n", |
| (looking_for & SIZE)); |
| goto end; |
| } |
| } |
| else if ((looking_for & MODE) == MEMIND) |
| { |
| cst[opnum] = data[1]; |
| } |
| else if ((looking_for & MODE) == VECIND) |
| { |
| if(h8300_normal_mode) |
| cst[opnum] = ((data[1] & 0x7f) + 0x80) * 2; |
| else |
| cst[opnum] = ((data[1] & 0x7f) + 0x80) * 4; |
| cst[opnum] += h8_get_vbr (sd); /* Add vector base reg. */ |
| } |
| else if ((looking_for & SIZE) == L_32) |
| { |
| int i = len / 2; |
| |
| cst[opnum] = |
| (data[i + 0] << 24) | |
| (data[i + 1] << 16) | |
| (data[i + 2] << 8) | |
| (data[i + 3]); |
| } |
| else if ((looking_for & SIZE) == L_24) |
| { |
| int i = len / 2; |
| |
| cst[opnum] = |
| (data[i + 0] << 16) | |
| (data[i + 1] << 8) | |
| (data[i + 2]); |
| } |
| else if (looking_for & DISPREG) |
| { |
| rdisp[opnum] = thisnib & 0x7; |
| } |
| else if ((looking_for & MODE) == KBIT) |
| { |
| switch (thisnib) |
| { |
| case 9: |
| cst[opnum] = 4; |
| break; |
| case 8: |
| cst[opnum] = 2; |
| break; |
| case 0: |
| cst[opnum] = 1; |
| break; |
| default: |
| goto fail; |
| } |
| } |
| else if ((looking_for & SIZE) == L_8) |
| { |
| if ((looking_for & MODE) == ABS) |
| { |
| /* Will be combined with contents of SBR_REGNUM |
| by fetch (). For all modes except h8sx, this |
| will always contain the value 0xFFFFFF00. */ |
| cst[opnum] = data[len / 2] & 0xff; |
| } |
| else |
| { |
| cst[opnum] = data[len / 2] & 0xff; |
| } |
| } |
| else if ((looking_for & SIZE) == L_2) |
| { |
| cst[opnum] = thisnib & 3; |
| } |
| else if ((looking_for & SIZE) == L_3 || |
| (looking_for & SIZE) == L_3NZ) |
| { |
| cst[opnum] = thisnib & 7; |
| if (cst[opnum] == 0 && (looking_for & SIZE) == L_3NZ) |
| goto fail; |
| } |
| else if ((looking_for & SIZE) == L_4) |
| { |
| cst[opnum] = thisnib & 15; |
| } |
| else if ((looking_for & SIZE) == L_5) |
| { |
| cst[opnum] = data[len / 2] & 0x1f; |
| } |
| else if (looking_for == E) |
| { |
| #ifdef ADEBUG |
| dst->op = q; |
| #endif |
| /* Fill in the args. */ |
| { |
| const op_type *args = q->args.nib; |
| int hadone = 0; |
| int nargs; |
| |
| for (nargs = 0; |
| nargs < 3 && *args != E; |
| nargs++) |
| { |
| int x = *args; |
| ea_type *p; |
| |
| opnum = ((x & OP3) ? 2 : |
| (x & DST) ? 1 : 0); |
| if (x & DST) |
| p = &dst->dst; |
| else if (x & OP3) |
| p = &dst->op3; |
| else |
| p = &dst->src; |
| |
| if ((x & MODE) == IMM || |
| (x & MODE) == KBIT || |
| (x & MODE) == DBIT) |
| { |
| /* Use the instruction to determine |
| the operand size. */ |
| p->type = X (OP_IMM, OP_SIZE (q->how)); |
| p->literal = cst[opnum]; |
| } |
| else if ((x & MODE) == CONST_2 || |
| (x & MODE) == CONST_4 || |
| (x & MODE) == CONST_8 || |
| (x & MODE) == CONST_16) |
| { |
| /* Use the instruction to determine |
| the operand size. */ |
| p->type = X (OP_IMM, OP_SIZE (q->how)); |
| switch (x & MODE) { |
| case CONST_2: p->literal = 2; break; |
| case CONST_4: p->literal = 4; break; |
| case CONST_8: p->literal = 8; break; |
| case CONST_16: p->literal = 16; break; |
| } |
| } |
| else if ((x & MODE) == REG) |
| { |
| p->type = X (OP_REG, bitfrom (x)); |
| p->reg = reg[opnum]; |
| } |
| else if ((x & MODE) == LOWREG) |
| { |
| p->type = X (OP_LOWREG, bitfrom (x)); |
| p->reg = reg[opnum]; |
| } |
| else if ((x & MODE) == PREINC) |
| { |
| /* Use the instruction to determine |
| the operand size. */ |
| p->type = X (OP_PREINC, OP_SIZE (q->how)); |
| p->reg = reg[opnum] & 0x7; |
| } |
| else if ((x & MODE) == POSTINC) |
| { |
| /* Use the instruction to determine |
| the operand size. */ |
| p->type = X (OP_POSTINC, OP_SIZE (q->how)); |
| p->reg = reg[opnum] & 0x7; |
| } |
| else if ((x & MODE) == PREDEC) |
| { |
| /* Use the instruction to determine |
| the operand size. */ |
| p->type = X (OP_PREDEC, OP_SIZE (q->how)); |
| p->reg = reg[opnum] & 0x7; |
| } |
| else if ((x & MODE) == POSTDEC) |
| { |
| /* Use the instruction to determine |
| the operand size. */ |
| p->type = X (OP_POSTDEC, OP_SIZE (q->how)); |
| p->reg = reg[opnum] & 0x7; |
| } |
| else if ((x & MODE) == IND) |
| { |
| /* Note: an indirect is transformed into |
| a displacement of zero. |
| */ |
| /* Use the instruction to determine |
| the operand size. */ |
| p->type = X (OP_DISP, OP_SIZE (q->how)); |
| p->reg = reg[opnum] & 0x7; |
| p->literal = 0; |
| if (OP_KIND (q->how) == O_JSR || |
| OP_KIND (q->how) == O_JMP) |
| if (lvalue (sd, p->type, p->reg, (unsigned int *)&p->type)) |
| goto end; |
| } |
| else if ((x & MODE) == ABS) |
| { |
| /* Note: a 16 or 32 bit ABS is transformed into a |
| displacement from pseudo-register ZERO_REGNUM, |
| which is always zero. An 8 bit ABS becomes |
| a displacement from SBR_REGNUM. |
| */ |
| /* Use the instruction to determine |
| the operand size. */ |
| p->type = X (OP_DISP, OP_SIZE (q->how)); |
| p->literal = cst[opnum]; |
| |
| /* 8-bit ABS is displacement from SBR. |
| 16 and 32-bit ABS are displacement from ZERO. |
| (SBR will always be zero except for h8/sx) |
| */ |
| if ((x & SIZE) == L_8) |
| p->reg = SBR_REGNUM; |
| else |
| p->reg = ZERO_REGNUM;; |
| } |
| else if ((x & MODE) == MEMIND || |
| (x & MODE) == VECIND) |
| { |
| /* Size doesn't matter. */ |
| p->type = X (OP_MEM, SB); |
| p->literal = cst[opnum]; |
| if (OP_KIND (q->how) == O_JSR || |
| OP_KIND (q->how) == O_JMP) |
| if (lvalue (sd, p->type, p->reg, (unsigned int *)&p->type)) |
| goto end; |
| } |
| else if ((x & MODE) == PCREL) |
| { |
| /* Size doesn't matter. */ |
| p->type = X (OP_PCREL, SB); |
| p->literal = cst[opnum]; |
| } |
| else if (x & ABSJMP) |
| { |
| p->type = X (OP_IMM, SP); |
| p->literal = cst[opnum]; |
| } |
| else if ((x & MODE) == INDEXB) |
| { |
| p->type = X (OP_INDEXB, OP_SIZE (q->how)); |
| p->literal = cst[opnum]; |
| p->reg = rdisp[opnum]; |
| } |
| else if ((x & MODE) == INDEXW) |
| { |
| p->type = X (OP_INDEXW, OP_SIZE (q->how)); |
| p->literal = cst[opnum]; |
| p->reg = rdisp[opnum]; |
| } |
| else if ((x & MODE) == INDEXL) |
| { |
| p->type = X (OP_INDEXL, OP_SIZE (q->how)); |
| p->literal = cst[opnum]; |
| p->reg = rdisp[opnum]; |
| } |
| else if ((x & MODE) == DISP) |
| { |
| /* Yuck -- special for mova args. */ |
| if (strncmp (q->name, "mova", 4) == 0 && |
| (x & SIZE) == L_2) |
| { |
| /* Mova can have a DISP2 dest, with an |
| INDEXB or INDEXW src. The multiplier |
| for the displacement value is determined |
| by the src operand, not by the insn. */ |
| |
| switch (OP_KIND (dst->src.type)) |
| { |
| case OP_INDEXB: |
| p->type = X (OP_DISP, SB); |
| p->literal = cst[opnum]; |
| break; |
| case OP_INDEXW: |
| p->type = X (OP_DISP, SW); |
| p->literal = cst[opnum] * 2; |
| break; |
| default: |
| goto fail; |
| } |
| } |
| else |
| { |
| p->type = X (OP_DISP, OP_SIZE (q->how)); |
| p->literal = cst[opnum]; |
| /* DISP2 is special. */ |
| if ((x & SIZE) == L_2) |
| switch (OP_SIZE (q->how)) |
| { |
| case SB: break; |
| case SW: p->literal *= 2; break; |
| case SL: p->literal *= 4; break; |
| } |
| } |
| p->reg = rdisp[opnum]; |
| } |
| else if (x & CTRL) |
| { |
| switch (reg[opnum]) |
| { |
| case C_CCR: |
| p->type = X (OP_CCR, SB); |
| break; |
| case C_EXR: |
| p->type = X (OP_EXR, SB); |
| break; |
| case C_MACH: |
| p->type = X (OP_MACH, SL); |
| break; |
| case C_MACL: |
| p->type = X (OP_MACL, SL); |
| break; |
| case C_VBR: |
| p->type = X (OP_VBR, SL); |
| break; |
| case C_SBR: |
| p->type = X (OP_SBR, SL); |
| break; |
| } |
| } |
| else if ((x & MODE) == CCR) |
| { |
| p->type = OP_CCR; |
| } |
| else if ((x & MODE) == EXR) |
| { |
| p->type = OP_EXR; |
| } |
| else |
| printf ("Hmmmm 0x%x...\n", x); |
| |
| args++; |
| } |
| } |
| |
| /* Unary operators: treat src and dst as equivalent. */ |
| if (dst->dst.type == -1) |
| dst->dst = dst->src; |
| if (dst->src.type == -1) |
| dst->src = dst->dst; |
| |
| dst->opcode = q->how; |
| dst->cycles = q->time; |
| |
| /* And jsr's to these locations are turned into |
| magic traps. */ |
| |
| if (OP_KIND (dst->opcode) == O_JSR) |
| { |
| switch (dst->src.literal) |
| { |
| case 0xc5: |
| dst->opcode = O (O_SYS_OPEN, SB); |
| break; |
| case 0xc6: |
| dst->opcode = O (O_SYS_READ, SB); |
| break; |
| case 0xc7: |
| dst->opcode = O (O_SYS_WRITE, SB); |
| break; |
| case 0xc8: |
| dst->opcode = O (O_SYS_LSEEK, SB); |
| break; |
| case 0xc9: |
| dst->opcode = O (O_SYS_CLOSE, SB); |
| break; |
| case 0xca: |
| dst->opcode = O (O_SYS_STAT, SB); |
| break; |
| case 0xcb: |
| dst->opcode = O (O_SYS_FSTAT, SB); |
| break; |
| case 0xcc: |
| dst->opcode = O (O_SYS_CMDLINE, SB); |
| break; |
| } |
| /* End of Processing for system calls. */ |
| } |
| |
| /* Use same register is specified for source |
| and destination. |
| The value of source will be the value after |
| address calculation. */ |
| if (OP_KIND (dst->opcode) != O_CMP && |
| OP_KIND (dst->src.type) == OP_REG && |
| (dst->src.reg & 7) == dst->dst.reg) { |
| switch (OP_KIND (dst->dst.type)) |
| { |
| case OP_POSTDEC: |
| dst->src.type = X (OP_REG_DEC, |
| OP_SIZE (dst->dst.type)); |
| break; |
| case OP_POSTINC: |
| dst->src.type = X (OP_REG_INC, |
| OP_SIZE (dst->dst.type)); |
| break; |
| case OP_PREINC: |
| if (OP_KIND (dst->opcode) == O_MOV) |
| dst->src.type = X (OP_REG_INC, |
| OP_SIZE (dst->dst.type)); |
| break; |
| case OP_PREDEC: |
| if (OP_KIND (dst->opcode) == O_MOV) |
| dst->src.type = X (OP_REG_DEC, |
| OP_SIZE (dst->dst.type)); |
| break; |
| } |
| } |
| dst->next_pc = addr + len / 2; |
| return; |
| } |
| else |
| printf ("Don't understand 0x%x \n", looking_for); |
| } |
| |
| len++; |
| nib++; |
| } |
| |
| fail: |
| ; |
| } |
| end: |
| /* Fell off the end. */ |
| dst->opcode = O (O_ILL, SB); |
| } |
| |
| static unsigned char *breg[32]; |
| static unsigned short *wreg[16]; |
| |
| #define GET_B_REG(X) *(breg[X]) |
| #define SET_B_REG(X, Y) (*(breg[X])) = (Y) |
| #define GET_W_REG(X) *(wreg[X]) |
| #define SET_W_REG(X, Y) (*(wreg[X])) = (Y) |
| #define GET_L_REG(X) h8_get_reg (sd, X) |
| #define SET_L_REG(X, Y) h8_set_reg (sd, X, Y) |
| |
| #define GET_MEMORY_L(X) \ |
| ((X) < memory_size \ |
| ? ((h8_get_memory (sd, (X)+0) << 24) | (h8_get_memory (sd, (X)+1) << 16) \ |
| | (h8_get_memory (sd, (X)+2) << 8) | (h8_get_memory (sd, (X)+3) << 0)) \ |
| : 0) |
| |
| #define GET_MEMORY_W(X) \ |
| ((X) < memory_size \ |
| ? ((h8_get_memory (sd, (X)+0) << 8) | (h8_get_memory (sd, (X)+1) << 0)) \ |
| : 0) |
| |
| #define GET_MEMORY_B(X) \ |
| ((X) < memory_size ? h8_get_memory (sd, (X)) : 0) |
| |
| #define SET_MEMORY_L(X, Y) \ |
| { register unsigned char *_p; register int __y = (Y); \ |
| _p = ((X) < memory_size ? h8_get_memory_buf (sd) + (X) : 0); \ |
| _p[0] = __y >> 24; _p[1] = __y >> 16; \ |
| _p[2] = __y >> 8; _p[3] = __y >> 0; \ |
| } |
| |
| #define SET_MEMORY_W(X, Y) \ |
| { register unsigned char *_p; register int __y = (Y); \ |
| _p = ((X) < memory_size ? h8_get_memory_buf (sd) + (X) : 0); \ |
| _p[0] = __y >> 8; _p[1] = __y; \ |
| } |
| |
| #define SET_MEMORY_B(X, Y) \ |
| ((X) < memory_size ? h8_set_memory (sd, (X), (Y)) : 0) |
| |
| /* Simulate a memory fetch. |
| Return 0 for success, -1 for failure. |
| */ |
| |
| static int |
| fetch_1 (SIM_DESC sd, ea_type *arg, int *val, int twice) |
| { |
| SIM_CPU *cpu = STATE_CPU (sd, 0); |
| int rn = arg->reg; |
| int abs = arg->literal; |
| int r; |
| int t; |
| |
| if (val == NULL) |
| return -1; /* Paranoia. */ |
| |
| switch (arg->type) |
| { |
| /* Indexed register plus displacement mode: |
| |
| This new family of addressing modes are similar to OP_DISP |
| (register plus displacement), with two differences: |
| 1) INDEXB uses only the least significant byte of the register, |
| INDEXW uses only the least significant word, and |
| INDEXL uses the entire register (just like OP_DISP). |
| and |
| 2) The displacement value in abs is multiplied by two |
| for SW-sized operations, and by four for SL-size. |
| |
| This gives nine possible variations. |
| */ |
| |
| case X (OP_INDEXB, SB): |
| case X (OP_INDEXB, SW): |
| case X (OP_INDEXB, SL): |
| case X (OP_INDEXW, SB): |
| case X (OP_INDEXW, SW): |
| case X (OP_INDEXW, SL): |
| case X (OP_INDEXL, SB): |
| case X (OP_INDEXL, SW): |
| case X (OP_INDEXL, SL): |
| t = GET_L_REG (rn); |
| switch (OP_KIND (arg->type)) { |
| case OP_INDEXB: t &= 0xff; break; |
| case OP_INDEXW: t &= 0xffff; break; |
| case OP_INDEXL: |
| default: break; |
| } |
| switch (OP_SIZE (arg->type)) { |
| case SB: |
| *val = GET_MEMORY_B ((t * 1 + abs) & h8_get_mask (sd)); |
| break; |
| case SW: |
| *val = GET_MEMORY_W ((t * 2 + abs) & h8_get_mask (sd)); |
| break; |
| case SL: |
| *val = GET_MEMORY_L ((t * 4 + abs) & h8_get_mask (sd)); |
| break; |
| } |
| break; |
| |
| case X (OP_LOWREG, SB): |
| *val = GET_L_REG (rn) & 0xff; |
| break; |
| case X (OP_LOWREG, SW): |
| *val = GET_L_REG (rn) & 0xffff; |
| break; |
| |
| case X (OP_REG, SB): /* Register direct, byte. */ |
| *val = GET_B_REG (rn); |
| break; |
| case X (OP_REG, SW): /* Register direct, word. */ |
| *val = GET_W_REG (rn); |
| break; |
| case X (OP_REG, SL): /* Register direct, long. */ |
| *val = GET_L_REG (rn); |
| break; |
| case X (OP_IMM, SB): /* Immediate, byte. */ |
| case X (OP_IMM, SW): /* Immediate, word. */ |
| case X (OP_IMM, SL): /* Immediate, long. */ |
| *val = abs; |
| break; |
| case X (OP_POSTINC, SB): /* Register indirect w/post-incr: byte. */ |
| t = GET_L_REG (rn); |
| r = GET_MEMORY_B (t & h8_get_mask (sd)); |
| if (!twice) |
| t += 1; |
| SET_L_REG (rn, t); |
| *val = r; |
| break; |
| case X (OP_POSTINC, SW): /* Register indirect w/post-incr: word. */ |
| t = GET_L_REG (rn); |
| r = GET_MEMORY_W (t & h8_get_mask (sd)); |
| if (!twice) |
| t += 2; |
| SET_L_REG (rn, t); |
| *val = r; |
| break; |
| case X (OP_POSTINC, SL): /* Register indirect w/post-incr: long. */ |
| t = GET_L_REG (rn); |
| r = GET_MEMORY_L (t & h8_get_mask (sd)); |
| if (!twice) |
| t += 4; |
| SET_L_REG (rn, t); |
| *val = r; |
| break; |
| |
| case X (OP_POSTDEC, SB): /* Register indirect w/post-decr: byte. */ |
| t = GET_L_REG (rn); |
| r = GET_MEMORY_B (t & h8_get_mask (sd)); |
| if (!twice) |
| t -= 1; |
| SET_L_REG (rn, t); |
| *val = r; |
| break; |
| case X (OP_POSTDEC, SW): /* Register indirect w/post-decr: word. */ |
| t = GET_L_REG (rn); |
| r = GET_MEMORY_W (t & h8_get_mask (sd)); |
| if (!twice) |
| t -= 2; |
| SET_L_REG (rn, t); |
| *val = r; |
| break; |
| case X (OP_POSTDEC, SL): /* Register indirect w/post-decr: long. */ |
| t = GET_L_REG (rn); |
| r = GET_MEMORY_L (t & h8_get_mask (sd)); |
| if (!twice) |
| t -= 4; |
| SET_L_REG (rn, t); |
| *val = r; |
| break; |
| |
| case X (OP_PREDEC, SB): /* Register indirect w/pre-decr: byte. */ |
| t = GET_L_REG (rn) - 1; |
| SET_L_REG (rn, t); |
| t &= h8_get_mask (sd); |
| *val = GET_MEMORY_B (t); |
| break; |
| |
| case X (OP_PREDEC, SW): /* Register indirect w/pre-decr: word. */ |
| t = GET_L_REG (rn) - 2; |
| SET_L_REG (rn, t); |
| t &= h8_get_mask (sd); |
| *val = GET_MEMORY_W (t); |
| break; |
| |
| case X (OP_PREDEC, SL): /* Register indirect w/pre-decr: long. */ |
| t = GET_L_REG (rn) - 4; |
| SET_L_REG (rn, t); |
| t &= h8_get_mask (sd); |
| *val = GET_MEMORY_L (t); |
| break; |
| |
| case X (OP_PREINC, SB): /* Register indirect w/pre-incr: byte. */ |
| t = GET_L_REG (rn) + 1; |
| SET_L_REG (rn, t); |
| t &= h8_get_mask (sd); |
| *val = GET_MEMORY_B (t); |
| break; |
| |
| case X (OP_PREINC, SW): /* Register indirect w/pre-incr: long. */ |
| t = GET_L_REG (rn) + 2; |
| SET_L_REG (rn, t); |
| t &= h8_get_mask (sd); |
| *val = GET_MEMORY_W (t); |
| break; |
| |
| case X (OP_PREINC, SL): /* Register indirect w/pre-incr: long. */ |
| t = GET_L_REG (rn) + 4; |
| SET_L_REG (rn, t); |
| t &= h8_get_mask (sd); |
| *val = GET_MEMORY_L (t); |
| break; |
| |
| case X (OP_DISP, SB): /* Register indirect w/displacement: byte. */ |
| t = GET_L_REG (rn) + abs; |
| t &= h8_get_mask (sd); |
| *val = GET_MEMORY_B (t); |
| break; |
| |
| case X (OP_DISP, SW): /* Register indirect w/displacement: word. */ |
| t = GET_L_REG (rn) + abs; |
| t &= h8_get_mask (sd); |
| *val = GET_MEMORY_W (t); |
| break; |
| |
| case X (OP_DISP, SL): /* Register indirect w/displacement: long. */ |
| t = GET_L_REG (rn) + abs; |
| t &= h8_get_mask (sd); |
| *val =GET_MEMORY_L (t); |
| break; |
| |
| case X (OP_MEM, SL): /* Absolute memory address, long. */ |
| t = GET_MEMORY_L (abs); |
| t &= h8_get_mask (sd); |
| *val = t; |
| break; |
| |
| case X (OP_MEM, SW): /* Absolute memory address, word. */ |
| t = GET_MEMORY_W (abs); |
| t &= h8_get_mask (sd); |
| *val = t; |
| break; |
| |
| case X (OP_PCREL, SB): /* PC relative (for jump, branch etc). */ |
| case X (OP_PCREL, SW): |
| case X (OP_PCREL, SL): |
| case X (OP_PCREL, SN): |
| *val = abs; |
| break; |
| |
| case X (OP_REG_DEC, SB): /* Register direct, affected decrement byte. */ |
| *val = GET_B_REG (rn) - 1; |
| break; |
| case X (OP_REG_DEC, SW): /* Register direct, affected decrement word. */ |
| *val = GET_W_REG (rn) - 2; |
| break; |
| case X (OP_REG_DEC, SL): /* Register direct, affected decrement long. */ |
| *val = GET_L_REG (rn) - 4; |
| break; |
| case X (OP_REG_INC, SB): /* Register direct, affected increment byte. */ |
| *val = GET_B_REG (rn) + 1; |
| break; |
| case X (OP_REG_INC, SW): /* Register direct, affected increment word. */ |
| *val = GET_W_REG (rn) + 2; |
| break; |
| case X (OP_REG_INC, SL): /* Register direct, affected increment long. */ |
| *val = GET_L_REG (rn) + 4; |
| break; |
| |
| case X (OP_MEM, SB): /* Why isn't this implemented? */ |
| default: |
| sim_engine_halt (sd, cpu, NULL, NULL_CIA, sim_stopped, SIM_SIGSEGV); |
| return -1; |
| } |
| return 0; /* Success. */ |
| } |
| |
| /* Normal fetch. */ |
| |
| static int |
| fetch (SIM_DESC sd, ea_type *arg, int *val) |
| { |
| return fetch_1 (sd, arg, val, 0); |
| } |
| |
| /* Fetch which will be followed by a store to the same location. |
| The difference being that we don't want to do a post-increment |
| or post-decrement at this time: we'll do it when we store. */ |
| |
| static int |
| fetch2 (SIM_DESC sd, ea_type *arg, int *val) |
| { |
| return fetch_1 (sd, arg, val, 1); |
| } |
| |
| /* Simulate a memory store. |
| Return 0 for success, -1 for failure. |
| */ |
| |
| static int |
| store_1 (SIM_DESC sd, ea_type *arg, int n, int twice) |
| { |
| SIM_CPU *cpu = STATE_CPU (sd, 0); |
| int rn = arg->reg; |
| int abs = arg->literal; |
| int t; |
| |
| switch (arg->type) |
| { |
| /* Indexed register plus displacement mode: |
| |
| This new family of addressing modes are similar to OP_DISP |
| (register plus displacement), with two differences: |
| 1) INDEXB uses only the least significant byte of the register, |
| INDEXW uses only the least significant word, and |
| INDEXL uses the entire register (just like OP_DISP). |
| and |
| 2) The displacement value in abs is multiplied by two |
| for SW-sized operations, and by four for SL-size. |
| |
| This gives nine possible variations. |
| */ |
| |
| case X (OP_INDEXB, SB): |
| case X (OP_INDEXB, SW): |
| case X (OP_INDEXB, SL): |
| case X (OP_INDEXW, SB): |
| case X (OP_INDEXW, SW): |
| case X (OP_INDEXW, SL): |
| case X (OP_INDEXL, SB): |
| case X (OP_INDEXL, SW): |
| case X (OP_INDEXL, SL): |
| t = GET_L_REG (rn); |
| switch (OP_KIND (arg->type)) { |
| case OP_INDEXB: t &= 0xff; break; |
| case OP_INDEXW: t &= 0xffff; break; |
| case OP_INDEXL: |
| default: break; |
| } |
| switch (OP_SIZE (arg->type)) { |
| case SB: |
| SET_MEMORY_B ((t * 1 + abs) & h8_get_mask (sd), n); |
| break; |
| case SW: |
| SET_MEMORY_W ((t * 2 + abs) & h8_get_mask (sd), n); |
| break; |
| case SL: |
| SET_MEMORY_L ((t * 4 + abs) & h8_get_mask (sd), n); |
| break; |
| } |
| break; |
| |
| case X (OP_REG, SB): /* Register direct, byte. */ |
| SET_B_REG (rn, n); |
| break; |
| case X (OP_REG, SW): /* Register direct, word. */ |
| SET_W_REG (rn, n); |
| break; |
| case X (OP_REG, SL): /* Register direct, long. */ |
| SET_L_REG (rn, n); |
| break; |
| |
| case X (OP_PREDEC, SB): /* Register indirect w/pre-decr, byte. */ |
| t = GET_L_REG (rn); |
| if (!twice) |
| t -= 1; |
| SET_L_REG (rn, t); |
| t &= h8_get_mask (sd); |
| SET_MEMORY_B (t, n); |
| |
| break; |
| case X (OP_PREDEC, SW): /* Register indirect w/pre-decr, word. */ |
| t = GET_L_REG (rn); |
| if (!twice) |
| t -= 2; |
| SET_L_REG (rn, t); |
| t &= h8_get_mask (sd); |
| SET_MEMORY_W (t, n); |
| break; |
| |
| case X (OP_PREDEC, SL): /* Register indirect w/pre-decr, long. */ |
| t = GET_L_REG (rn); |
| if (!twice) |
| t -= 4; |
| SET_L_REG (rn, t); |
| t &= h8_get_mask (sd); |
| SET_MEMORY_L (t, n); |
| break; |
| |
| case X (OP_PREINC, SB): /* Register indirect w/pre-incr, byte. */ |
| t = GET_L_REG (rn); |
| if (!twice) |
| t += 1; |
| SET_L_REG (rn, t); |
| t &= h8_get_mask (sd); |
| SET_MEMORY_B (t, n); |
| |
| break; |
| case X (OP_PREINC, SW): /* Register indirect w/pre-incr, word. */ |
| t = GET_L_REG (rn); |
| if (!twice) |
| t += 2; |
| SET_L_REG (rn, t); |
| t &= h8_get_mask (sd); |
| SET_MEMORY_W (t, n); |
| break; |
| |
| case X (OP_PREINC, SL): /* Register indirect w/pre-incr, long. */ |
| t = GET_L_REG (rn); |
| if (!twice) |
| t += 4; |
| SET_L_REG (rn, t); |
| t &= h8_get_mask (sd); |
| SET_MEMORY_L (t, n); |
| break; |
| |
| case X (OP_POSTDEC, SB): /* Register indirect w/post-decr, byte. */ |
| t = GET_L_REG (rn); |
| SET_L_REG (rn, t - 1); |
| t &= h8_get_mask (sd); |
| SET_MEMORY_B (t, n); |
| break; |
| |
| case X (OP_POSTDEC, SW): /* Register indirect w/post-decr, word. */ |
| t = GET_L_REG (rn); |
| SET_L_REG (rn, t - 2); |
| t &= h8_get_mask (sd); |
| SET_MEMORY_W (t, n); |
| break; |
| |
| case X (OP_POSTDEC, SL): /* Register indirect w/post-decr, long. */ |
| t = GET_L_REG (rn); |
| SET_L_REG (rn, t - 4); |
| t &= h8_get_mask (sd); |
| SET_MEMORY_L (t, n); |
| break; |
| |
| case X (OP_POSTINC, SB): /* Register indirect w/post-incr, byte. */ |
| t = GET_L_REG (rn); |
| SET_L_REG (rn, t + 1); |
| t &= h8_get_mask (sd); |
| SET_MEMORY_B (t, n); |
| break; |
| |
| case X (OP_POSTINC, SW): /* Register indirect w/post-incr, word. */ |
| t = GET_L_REG (rn); |
| SET_L_REG (rn, t + 2); |
| t &= h8_get_mask (sd); |
| SET_MEMORY_W (t, n); |
| break; |
| |
| case X (OP_POSTINC, SL): /* Register indirect w/post-incr, long. */ |
| t = GET_L_REG (rn); |
| SET_L_REG (rn, t + 4); |
| t &= h8_get_mask (sd); |
| SET_MEMORY_L (t, n); |
| break; |
| |
| case X (OP_DISP, SB): /* Register indirect w/displacement, byte. */ |
| t = GET_L_REG (rn) + abs; |
| t &= h8_get_mask (sd); |
| SET_MEMORY_B (t, n); |
| break; |
| |
| case X (OP_DISP, SW): /* Register indirect w/displacement, word. */ |
| t = GET_L_REG (rn) + abs; |
| t &= h8_get_mask (sd); |
| SET_MEMORY_W (t, n); |
| break; |
| |
| case X (OP_DISP, SL): /* Register indirect w/displacement, long. */ |
| t = GET_L_REG (rn) + abs; |
| t &= h8_get_mask (sd); |
| SET_MEMORY_L (t, n); |
| break; |
| |
| |
| case X (OP_MEM, SB): /* Why isn't this implemented? */ |
| case X (OP_MEM, SW): /* Why isn't this implemented? */ |
| case X (OP_MEM, SL): /* Why isn't this implemented? */ |
| default: |
| sim_engine_halt (sd, cpu, NULL, NULL_CIA, sim_stopped, SIM_SIGSEGV); |
| return -1; |
| } |
| return 0; |
| } |
| |
| /* Normal store. */ |
| |
| static int |
| store (SIM_DESC sd, ea_type *arg, int n) |
| { |
| return store_1 (sd, arg, n, 0); |
| } |
| |
| /* Store which follows a fetch from the same location. |
| The difference being that we don't want to do a pre-increment |
| or pre-decrement at this time: it was already done when we fetched. */ |
| |
| static int |
| store2 (SIM_DESC sd, ea_type *arg, int n) |
| { |
| return store_1 (sd, arg, n, 1); |
| } |
| |
| /* Flag to be set whenever a new SIM_DESC object is created. */ |
| static int init_pointers_needed = 1; |
| |
| static void |
| init_pointers (SIM_DESC sd) |
| { |
| struct h8300_sim_state *state = H8300_SIM_STATE (sd); |
| |
| if (init_pointers_needed) |
| { |
| int i; |
| |
| if (h8300smode && !h8300_normal_mode) |
| memory_size = H8300S_MSIZE; |
| else if (h8300hmode && !h8300_normal_mode) |
| memory_size = H8300H_MSIZE; |
| else |
| memory_size = H8300_MSIZE; |
| /* `msize' must be a power of two. */ |
| if ((memory_size & (memory_size - 1)) != 0) |
| { |
| sim_io_printf |
| (sd, |
| "init_pointers: bad memory size %d, defaulting to %d.\n", |
| memory_size, H8300S_MSIZE); |
| memory_size = H8300S_MSIZE; |
| } |
| |
| if (h8_get_memory_buf (sd)) |
| free (h8_get_memory_buf (sd)); |
| |
| h8_set_memory_buf (sd, (unsigned char *) |
| calloc (sizeof (char), memory_size)); |
| state->memory_size = memory_size; |
| |
| h8_set_mask (sd, memory_size - 1); |
| |
| memset (h8_get_reg_buf (sd), 0, sizeof (((STATE_CPU (sd, 0))->regs))); |
| |
| for (i = 0; i < 8; i++) |
| { |
| /* FIXME: rewrite using local buffer. */ |
| unsigned char *p = (unsigned char *) (h8_get_reg_buf (sd) + i); |
| unsigned char *e = (unsigned char *) (h8_get_reg_buf (sd) + i + 1); |
| unsigned short *q = (unsigned short *) (h8_get_reg_buf (sd) + i); |
| unsigned short *u = (unsigned short *) (h8_get_reg_buf (sd) + i + 1); |
| h8_set_reg (sd, i, 0x00112233); |
| |
| while (p < e) |
| { |
| if (*p == 0x22) |
| breg[i] = p; |
| if (*p == 0x33) |
| breg[i + 8] = p; |
| if (*p == 0x11) |
| breg[i + 16] = p; |
| if (*p == 0x00) |
| breg[i + 24] = p; |
| p++; |
| } |
| |
| wreg[i] = wreg[i + 8] = 0; |
| while (q < u) |
| { |
| if (*q == 0x2233) |
| { |
| wreg[i] = q; |
| } |
| if (*q == 0x0011) |
| { |
| wreg[i + 8] = q; |
| } |
| q++; |
| } |
| |
| if (wreg[i] == 0 || wreg[i + 8] == 0) |
| sim_io_printf (sd, "init_pointers: internal error.\n"); |
| |
| h8_set_reg (sd, i, 0); |
| } |
| |
| init_pointers_needed = 0; |
| } |
| } |
| |
| #define OBITOP(name, f, s, op) \ |
| case O (name, SB): \ |
| { \ |
| int m, tmp; \ |
| \ |
| if (f) \ |
| if (fetch (sd, &code->dst, &ea)) \ |
| goto end; \ |
| if (fetch (sd, &code->src, &tmp)) \ |
| goto end; \ |
| m = 1 << (tmp & 7); \ |
| op; \ |
| if (s) \ |
| if (store (sd, &code->dst,ea)) \ |
| goto end; \ |
| goto next; \ |
| } |
| |
| static void |
| step_once (SIM_DESC sd, SIM_CPU *cpu) |
| { |
| int cycles = 0; |
| int insts = 0; |
| int tick_start = get_now (); |
| int res; |
| int tmp; |
| int rd; |
| int ea; |
| int bit; |
| int pc; |
| int c, nz, v, n, u, h, ui, intMaskBit; |
| int trace = 0; |
| int intMask = 0; |
| int oldmask; |
| const struct h8300_sim_state *state = H8300_SIM_STATE (sd); |
| host_callback *sim_callback = STATE_CALLBACK (sd); |
| |
| init_pointers (sd); |
| |
| pc = h8_get_pc (sd); |
| |
| /* The PC should never be odd. */ |
| if (pc & 0x1) |
| { |
| sim_engine_halt (sd, cpu, NULL, NULL_CIA, sim_stopped, SIM_SIGBUS); |
| return; |
| } |
| |
| /* Get Status Register (flags). */ |
| GETSR (sd); |
| |
| if (h8300smode) /* Get exr. */ |
| { |
| trace = (h8_get_exr (sd) >> 7) & 1; |
| intMask = h8_get_exr (sd) & 7; |
| } |
| |
| oldmask = h8_get_mask (sd); |
| if (!h8300hmode || h8300_normal_mode) |
| h8_set_mask (sd, 0xffff); |
| do |
| { |
| decoded_inst _code, *code = &_code; |
| memset (code, 0, sizeof (*code)); |
| decode (sd, pc, h8_get_memory_buf (sd) + pc, code); |
| code->oldpc = pc; |
| |
| #if ADEBUG |
| if (debug) |
| { |
| printf ("%x %d %s\n", pc, code->opcode, |
| code->op ? code->op->name : "**"); |
| } |
| h8_increment_stats (sd, code->opcode); |
| #endif |
| |
| if (code->opcode) |
| { |
| cycles += code->cycles; |
| insts++; |
| } |
| |
| switch (code->opcode) |
| { |
| case O (O_MOVAB, SL): |
| case O (O_MOVAW, SL): |
| case O (O_MOVAL, SL): |
| /* 1) Evaluate 2nd argument (dst). |
| 2) Mask / zero extend according to whether 1st argument (src) |
| is INDEXB, INDEXW, or INDEXL. |
| 3) Left-shift the result by 0, 1 or 2, according to size of mova |
| (mova/b, mova/w, mova/l). |
| 4) Add literal value of 1st argument (src). |
| 5) Store result in 3rd argument (op3). |
| */ |
| |
| /* Alas, since this is the only instruction with 3 arguments, |
| decode doesn't handle them very well. Some fix-up is required. |
| |
| a) The size of dst is determined by whether src is |
| INDEXB or INDEXW. */ |
| |
| if (OP_KIND (code->src.type) == OP_INDEXB) |
| code->dst.type = X (OP_KIND (code->dst.type), SB); |
| else if (OP_KIND (code->src.type) == OP_INDEXW) |
| code->dst.type = X (OP_KIND (code->dst.type), SW); |
| |
| /* b) If op3 == null, then this is the short form of the insn. |
| Dst is the dispreg of src, and op3 is the 32-bit form |
| of the same register. |
| */ |
| |
| if (code->op3.type == 0) |
| { |
| /* Short form: src == INDEXB/INDEXW, dst == op3 == 0. |
| We get to compose dst and op3 as follows: |
| |
| op3 is a 32-bit register, ID == src.reg. |
| dst is the same register, but 8 or 16 bits |
| depending on whether src is INDEXB or INDEXW. |
| */ |
| |
| code->op3.type = X (OP_REG, SL); |
| code->op3.reg = code->src.reg; |
| code->op3.literal = 0; |
| |
| if (OP_KIND (code->src.type) == OP_INDEXB) |
| { |
| code->dst.type = X (OP_REG, SB); |
| code->dst.reg = code->op3.reg + 8; |
| } |
| else |
| code->dst.type = X (OP_REG, SW); |
| } |
| |
| if (fetch (sd, &code->dst, &ea)) |
| goto end; |
| |
| switch (OP_KIND (code->src.type)) { |
| case OP_INDEXB: ea = ea & 0xff; break; |
| case OP_INDEXW: ea = ea & 0xffff; break; |
| case OP_INDEXL: break; |
| default: goto illegal; |
| } |
| |
| switch (code->opcode) { |
| case O (O_MOVAB, SL): break; |
| case O (O_MOVAW, SL): ea = ea << 1; break; |
| case O (O_MOVAL, SL): ea = ea << 2; break; |
| default: goto illegal; |
| } |
| |
| ea = ea + code->src.literal; |
| |
| if (store (sd, &code->op3, ea)) |
| goto end; |
| |
| goto next; |
| |
| case O (O_SUBX, SB): /* subx, extended sub */ |
| if (fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| if (fetch (sd, &code->src, &ea)) |
| goto end; |
| ea = -(ea + C); |
| res = rd + ea; |
| goto alu8; |
| |
| case O (O_SUBX, SW): /* subx, extended sub */ |
| if (fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| if (fetch (sd, &code->src, &ea)) |
| goto end; |
| ea = -(ea + C); |
| res = rd + ea; |
| goto alu16; |
| |
| case O (O_SUBX, SL): /* subx, extended sub */ |
| if (fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| if (fetch (sd, &code->src, &ea)) |
| goto end; |
| ea = -(ea + C); |
| res = rd + ea; |
| goto alu32; |
| |
| case O (O_ADDX, SB): /* addx, extended add */ |
| if (fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| if (fetch (sd, &code->src, &ea)) |
| goto end; |
| ea = ea + C; |
| res = rd + ea; |
| goto alu8; |
| |
| case O (O_ADDX, SW): /* addx, extended add */ |
| if (fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| if (fetch (sd, &code->src, &ea)) |
| goto end; |
| ea = ea + C; |
| res = rd + ea; |
| goto alu16; |
| |
| case O (O_ADDX, SL): /* addx, extended add */ |
| if (fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| if (fetch (sd, &code->src, &ea)) |
| goto end; |
| ea = ea + C; |
| res = rd + ea; |
| goto alu32; |
| |
| case O (O_SUB, SB): /* sub.b */ |
| /* Fetch rd and ea. */ |
| if (fetch (sd, &code->src, &ea) || fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| ea = -ea; |
| res = rd + ea; |
| goto alu8; |
| |
| case O (O_SUB, SW): /* sub.w */ |
| /* Fetch rd and ea. */ |
| if (fetch (sd, &code->src, &ea) || fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| ea = -ea; |
| res = rd + ea; |
| goto alu16; |
| |
| case O (O_SUB, SL): /* sub.l */ |
| /* Fetch rd and ea. */ |
| if (fetch (sd, &code->src, &ea) || fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| ea = -ea; |
| res = rd + ea; |
| goto alu32; |
| |
| case O (O_NEG, SB): /* neg.b */ |
| /* Fetch ea. */ |
| if (fetch2 (sd, &code->src, &ea)) |
| goto end; |
| ea = -ea; |
| rd = 0; |
| res = rd + ea; |
| goto alu8; |
| |
| case O (O_NEG, SW): /* neg.w */ |
| /* Fetch ea. */ |
| if (fetch2 (sd, &code->src, &ea)) |
| goto end; |
| ea = -ea; |
| rd = 0; |
| res = rd + ea; |
| goto alu16; |
| |
| case O (O_NEG, SL): /* neg.l */ |
| /* Fetch ea. */ |
| if (fetch2 (sd, &code->src, &ea)) |
| goto end; |
| ea = -ea; |
| rd = 0; |
| res = rd + ea; |
| goto alu32; |
| |
| case O (O_ADD, SB): /* add.b */ |
| if (fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| if (fetch (sd, &code->src, &ea)) |
| goto end; |
| res = rd + ea; |
| goto alu8; |
| |
| case O (O_ADD, SW): /* add.w */ |
| if (fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| if (fetch (sd, &code->src, &ea)) |
| goto end; |
| res = rd + ea; |
| goto alu16; |
| |
| case O (O_ADD, SL): /* add.l */ |
| if (fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| if (fetch (sd, &code->src, &ea)) |
| goto end; |
| res = rd + ea; |
| goto alu32; |
| |
| case O (O_AND, SB): /* and.b */ |
| /* Fetch rd and ea. */ |
| if (fetch2 (sd, &code->dst, &rd) || fetch (sd, &code->src, &ea)) |
| goto end; |
| res = rd & ea; |
| goto log8; |
| |
| case O (O_AND, SW): /* and.w */ |
| /* Fetch rd and ea. */ |
| if (fetch (sd, &code->src, &ea) || fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| res = rd & ea; |
| goto log16; |
| |
| case O (O_AND, SL): /* and.l */ |
| /* Fetch rd and ea. */ |
| if (fetch (sd, &code->src, &ea) || fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| res = rd & ea; |
| goto log32; |
| |
| case O (O_OR, SB): /* or.b */ |
| /* Fetch rd and ea. */ |
| if (fetch2 (sd, &code->dst, &rd) || fetch (sd, &code->src, &ea)) |
| goto end; |
| res = rd | ea; |
| goto log8; |
| |
| case O (O_OR, SW): /* or.w */ |
| /* Fetch rd and ea. */ |
| if (fetch (sd, &code->src, &ea) || fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| res = rd | ea; |
| goto log16; |
| |
| case O (O_OR, SL): /* or.l */ |
| /* Fetch rd and ea. */ |
| if (fetch (sd, &code->src, &ea) || fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| res = rd | ea; |
| goto log32; |
| |
| case O (O_XOR, SB): /* xor.b */ |
| /* Fetch rd and ea. */ |
| if (fetch (sd, &code->src, &ea) || fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| res = rd ^ ea; |
| goto log8; |
| |
| case O (O_XOR, SW): /* xor.w */ |
| /* Fetch rd and ea. */ |
| if (fetch (sd, &code->src, &ea) || fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| res = rd ^ ea; |
| goto log16; |
| |
| case O (O_XOR, SL): /* xor.l */ |
| /* Fetch rd and ea. */ |
| if (fetch (sd, &code->src, &ea) || fetch2 (sd, &code->dst, &rd)) |
| goto end; |
| res = rd ^ ea; |
| goto log32; |
| |
| case O (O_MOV, SB): |
| if (fetch (sd, &code->src, &res)) |
| goto end; |
| if (store (sd, &code->dst, res)) |
| goto end; |
| goto just_flags_log8; |
| case O (O_MOV, SW): |
| if (fetch (sd, &code->src, &res)) |
| goto end; |
| if (store (sd, &code->dst, res)) |
| goto end; |
| goto just_flags_log16; |
| case O (O_MOV, SL): |
| if (fetch (sd, &code->src, &res)) |
| goto end; |
| if (store (sd, &code->dst, res)) |
| goto end; |
| goto just_flags_log32; |
| |
| case O (O_MOVMD, SB): /* movmd.b */ |
| ea = GET_W_REG (4); |
| if (ea == 0) |
| ea = 0x10000; |
| |
| while (ea--) |
| { |
| rd = GET_MEMORY_B (GET_L_REG (5)); |
| SET_MEMORY_B (GET_L_REG (6), rd); |
| SET_L_REG (5, GET_L_REG (5) + 1); |
| SET_L_REG (6, GET_L_REG (6) + 1); |
| SET_W_REG (4, ea); |
| } |
| goto next; |
| |
| case O (O_MOVMD, SW): /* movmd.w */ |
| ea = GET_W_REG (4); |
| if (ea == 0) |
| ea = 0x10000; |
| |
| while (ea--) |
| { |
| rd = GET_MEMORY_W (GET_L_REG (5)); |
| SET_MEMORY_W (GET_L_REG (6), rd); |
| SET_L_REG (5, GET_L_REG (5) + 2); |
| SET_L_REG (6, GET_L_REG (6) + 2); |
| SET_W_REG (4, ea); |
| } |
| goto next; |
| |
| case O (O_MOVMD, SL): /* movmd.l */ |
| ea = GET_W_REG (4); |
| if (ea == 0) |
| ea = 0x10000; |
| |
| while (ea--) |
| { |
| rd = GET_MEMORY_L (GET_L_REG (5)); |
| SET_MEMORY_L (GET_L_REG (6), rd); |
| SET_L_REG (5, GET_L_REG (5) + 4); |
| SET_L_REG (6, GET_L_REG (6) + 4); |
| SET_W_REG (4, ea); |
| } |
| goto next; |
| |
| case O (O_MOVSD, SB): /* movsd.b */ |
| /* This instruction implements strncpy, with a conditional branch. |
| r4 contains n, r5 contains src, and r6 contains dst. |
| The 16-bit displacement operand is added to the pc |
| if and only if the end of string is reached before |
| n bytes are transferred. */ |
| |
| ea = GET_L_REG (4) & 0xffff; |
| if (ea == 0) |
| ea = 0x10000; |
| |
| while (ea--) |
| { |
| rd = GET_MEMORY_B (GET_L_REG (5)); |
| SET_MEMORY_B (GET_L_REG (6), rd); |
| SET_L_REG (5, GET_L_REG (5) + 1); |
| SET_L_REG (6, GET_L_REG (6) + 1); |
| SET_W_REG (4, ea); |
| if (rd == 0) |
| goto condtrue; |
| } |
| goto next; |
| |
| case O (O_EEPMOV, SB): /* eepmov.b */ |
| case O (O_EEPMOV, SW): /* eepmov.w */ |
| if (h8300hmode || h8300smode) |
| { |
| register unsigned char *_src, *_dst; |
| unsigned int count = ((code->opcode == O (O_EEPMOV, SW)) |
| ? h8_get_reg (sd, R4_REGNUM) & 0xffff |
| : h8_get_reg (sd, R4_REGNUM) & 0xff); |
| |
| _src = h8_get_memory_buf (sd) + h8_get_reg (sd, R5_REGNUM); |
| if ((_src + count) >= (h8_get_memory_buf (sd) + memory_size)) |
| goto illegal; |
| _dst = h8_get_memory_buf (sd) + h8_get_reg (sd, R6_REGNUM); |
| if ((_dst + count) >= (h8_get_memory_buf (sd) + memory_size)) |
| goto illegal; |
| memcpy (_dst, _src, count); |
| |
| h8_set_reg (sd, R5_REGNUM, h8_get_reg (sd, R5_REGNUM) + count); |
| h8_set_reg (sd, R6_REGNUM, h8_get_reg (sd, R6_REGNUM) + count); |
| h8_set_reg (sd, R4_REGNUM, h8_get_reg (sd, R4_REGNUM) & |
| ((code->opcode == O (O_EEPMOV, SW)) |
| ? (~0xffff) : (~0xff))); |
| cycles += 2 * count; |
| goto next; |
| } |
| goto illegal; |
| |
| case O (O_ADDS, SL): /* adds (.l) */ |
| /* FIXME fetch. |
| * This insn only uses register operands, but still |
| * it would be cleaner to use fetch and store... */ |
| SET_L_REG (code->dst.reg, |
| GET_L_REG (code->dst.reg) |
| + code->src.literal); |
| |
| goto next; |
| |
| case O (O_SUBS, SL): /* subs (.l) */ |
| /* FIXME fetch. |
| * This insn only uses register operands, but still |
| * it would be cleaner to use fetch and store... */ |
| SET_L_REG (code->dst.reg, |
| GET_L_REG (code->dst.reg) |
| - code->src.literal); |
| goto next; |
| |
| case O (O_CMP, SB): /* cmp.b */ |
| if (fetch (sd, &code->dst, &rd)) |
| goto end; |
| if (fetch (sd, &code->src, &ea)) |
| goto end; |
| ea = -ea; |
| res = rd + ea; |
| goto just_flags_alu8; |
| |
| case O (O_CMP, SW): /* cmp.w */ |
| if (fetch (sd, &code->dst, &rd)) |
| goto end; |
| if (fetch (sd, &code->src, &ea)) |
| goto end; |
| ea = -ea; |
| res = rd + ea; |
| goto just_flags_alu16; |
| |
| case O (O_CMP, SL): /* cmp.l */ |
| if (fetch (sd, &code->dst, &rd)) |
| goto end; |
| if (fetch (sd, &code->src, &ea)) |
| goto end; |
| ea = -ea; |
| res = rd + ea; |
| goto just_flags_alu32; |
| |
| case O (O_DEC, SB): /* dec.b */ |
| /* FIXME fetch. |
| * This insn only uses register operands, but still |
| * it would be cleaner to use fetch and store... */ |
| rd = GET_B_REG (code->src.reg); |
| ea = -1; |
| res = rd + ea; |
| SET_B_REG (code->src.reg, res); |
| goto just_flags_inc8; |
| |
| case O (O_DEC, SW): /* dec.w */ |
| /* FIXME fetch. |
| * This insn only uses register operands, but still |
| * it would be cleaner to use fetch and store... */ |
| rd = GET_W_REG (code->dst.reg); |
| ea = -code->src.literal; |
| res = rd + ea; |
| SET_W_REG (code->dst.reg, res); |
| goto just_flags_inc16; |
| |
| case O (O_DEC, SL): /* dec.l */ |
| /* FIXME fetch. |
| * This insn only uses register operands, but still |
| * it would be cleaner to use fetch and store... */ |
| rd = GET_L_REG (code->dst.reg); |
| ea = -code->src.literal; |
| res = rd + ea; |
| SET_L_REG (code->dst.reg, res); |
| goto just_flags_inc32; |
| |
| case O (O_INC, SB): /* inc.b */ |
| /* FIXME fetch. |
| * This insn only uses register operands, but still |
| * it would be cleaner to use fetch and store... */ |
| rd = GET_B_REG (code->src.reg); |
| ea = 1; |
| res = rd + ea; |
| SET_B_REG (code->src.reg, res); |
| goto just_flags_inc8; |
| |
| case O (O_INC, SW): /* inc.w */ |
| /* FIXME fetch. |
| * This insn only uses register operands, but still |
| * it would be cleaner to use fetch and store... */ |
| rd = GET_W_REG (code->dst.reg); |
| ea = code->src.literal; |
| res = rd + ea; |
| SET_W_REG (code->dst.reg, res); |
| goto just_flags_inc16; |
| |
| case O (O_INC, SL): /* inc.l */ |
| /* FIXME fetch. |
| * This insn only uses register operands, but still |
| * it would be cleaner to use fetch and store... */ |
| rd = GET_L_REG (code->dst.reg); |
| ea = code->src.literal; |
| res = rd + ea; |
| SET_L_REG (code->dst.reg, res); |
| goto just_flags_inc32; |
| |
| case O (O_LDC, SB): /* ldc.b */ |
| if (fetch (sd, &code->src, &res)) |
| goto end; |
| goto setc; |
| |
| case O (O_LDC, SW): /* ldc.w */ |
| if (fetch (sd, &code->src, &res)) |
| goto end; |
| |
| /* Word operand, value from MSB, must be shifted. */ |
| res >>= 8; |
| goto setc; |
| |
| case O (O_LDC, SL): /* ldc.l */ |
| if (fetch (sd, &code->src, &res)) |
| goto end; |
| switch (code->dst.type) { |
| case X (OP_SBR, SL): |
| h8_set_sbr (sd, res); |
| break; |
| case X (OP_VBR, SL): |
| h8_set_vbr (sd, res); |
| break; |
| default: |
| goto illegal; |
| } |
| goto next; |
| |
| case O (O_STC, SW): /* stc.w */ |
| case O (O_STC, SB): /* stc.b */ |
| if (code->src.type == X (OP_CCR, SB)) |
| { |
| BUILDSR (sd); |
| res = h8_get_ccr (sd); |
| } |
| else if (code->src.type == X (OP_EXR, SB) && h8300smode) |
| { |
| if (h8300smode) |
| h8_set_exr (sd, (trace << 7) | intMask); |
| res = h8_get_exr (sd); |
| } |
| else |
| goto illegal; |
| |
| /* Word operand, value to MSB, must be shifted. */ |
| if (code->opcode == X (O_STC, SW)) |
| res <<= 8; |
| if (store (sd, &code->dst, res)) |
| goto end; |
| goto next; |
| case O (O_STC, SL): /* stc.l */ |
| switch (code->src.type) { |
| case X (OP_SBR, SL): |
| res = h8_get_sbr (sd); |
| break; |
| case X (OP_VBR, SL): |
| res = h8_get_vbr (sd); |
| break; |
| default: |
| goto illegal; |
| } |
| if (store (sd, &code->dst, res)) |
| goto end; |
| goto next; |
| |
| case O (O_ANDC, SB): /* andc.b */ |
| if (code->dst.type == X (OP_CCR, SB)) |
| { |
| BUILDSR (sd); |
| rd = h8_get_ccr (sd); |
| } |
| else if (code->dst.type == X (OP_EXR, SB) && h8300smode) |
| { |
| if (h8300smode) |
| h8_set_exr (sd, (trace << 7) | intMask); |
| rd = h8_get_exr (sd); |
| } |
| else |
| goto illegal; |
| ea = code->src.literal; |
| res = rd & ea; |
| goto setc; |
| |
| case O (O_ORC, SB): /* orc.b */ |
| if (code->dst.type == X (OP_CCR, SB)) |
| { |
| BUILDSR (sd); |
| rd = h8_get_ccr (sd); |
| } |
| else if (code->dst.type == X (OP_EXR, SB) && h8300smode) |
| { |
| if (h8300smode) |
| h8_set_exr (sd, (trace << 7) | intMask); |
| rd = h8_get_exr (sd); |
| } |
| else |
| goto illegal; |
| ea = code->src.literal; |
| res = rd | ea; |
| goto setc; |
| |
| case O (O_XORC, SB): /* xorc.b */ |
| if (code->dst.type == X (OP_CCR, SB)) |
| { |
| BUILDSR (sd); |
| rd = h8_get_ccr (sd); |
| } |
| else if (code->dst.type == X (OP_EXR, SB) && h8300smode) |
| { |
| if (h8300smode) |
| h8_set_exr (sd, (trace << 7) | intMask); |
| rd = h8_get_exr (sd); |
| } |
| else |
| goto illegal; |
| ea = code->src.literal; |
| res = rd ^ ea; |
| goto setc; |
| |
| case O (O_BRAS, SB): /* bra/s */ |
| /* This is basically an ordinary branch, with a delay slot. */ |
| if (fetch (sd, &code->src, &res)) |
| goto end; |
| |
| if ((res & 1) == 0) |
| goto illegal; |
| |
| res -= 1; |
| |
| /* Execution continues at next instruction, but |
| delayed_branch is set up for next cycle. */ |
| h8_set_delayed_branch (sd, code->next_pc + res); |
| pc = code->next_pc; |
| goto end; |
| |
| case O (O_BRAB, SB): /* bra rd.b */ |
| case O (O_BRAW, SW): /* bra rd.w */ |
| case O (O_BRAL, SL): /* bra erd.l */ |
| if (fetch (sd, &code->src, &rd)) |
| goto end; |
| switch (OP_SIZE (code->opcode)) { |
| case SB: rd &= 0xff; break; |
| case SW: rd &= 0xffff; break; |
| case SL: rd &= 0xffffffff; break; |
| } |
| pc = code->next_pc + rd; |
| goto end; |
| |
| case O (O_BRABC, SB): /* bra/bc, branch if bit clear */ |
| case O (O_BRABS, SB): /* bra/bs, branch if bit set */ |
| case O (O_BSRBC, SB): /* bsr/bc, call if bit clear */ |
| case O (O_BSRBS, SB): /* bsr/bs, call if bit set */ |
| if (fetch (sd, &code->dst, &rd) || |
| fetch (sd, &code->src, &bit)) |
| goto end; |
| |
| if (code->opcode == O (O_BRABC, SB) || /* branch if clear */ |
| code->opcode == O (O_BSRBC, SB)) /* call if clear */ |
| { |
| if ((rd & (1 << bit))) /* no branch */ |
| goto next; |
| } |
| else /* branch/call if set */ |
| { |
| if (!(rd & (1 << bit))) /* no branch */ |
| goto next; |
| } |
| |
| if (fetch (sd, &code->op3, &res)) /* branch */ |
| goto end; |
| pc = code->next_pc + res; |
| |
| if (code->opcode == O (O_BRABC, SB) || |
| code->opcode == O (O_BRABS, SB)) /* branch */ |
| goto end; |
| else /* call */ |
| goto call; |
| |
| case O (O_BRA, SN): |
| case O (O_BRA, SL): |
| case O (O_BRA, SW): |
| case O (O_BRA, SB): /* bra, branch always */ |
| if (1) |
| goto condtrue; |
| goto next; |
| |
| case O (O_BRN, SB): /* brn, ;-/ branch never? */ |
| if (0) |
| goto condtrue; |
| goto next; |
| |
| case O (O_BHI, SB): /* bhi */ |
| if ((C || Z) == 0) |
| goto condtrue; |
| goto next; |
| |
| |
| case O (O_BLS, SB): /* bls */ |
| if ((C || Z)) |
| goto condtrue; |
| goto next; |
| |
| case O (O_BCS, SB): /* bcs, branch if carry set */ |
| if ((C == 1)) |
| goto condtrue; |
| goto next; |
| |
| case O (O_BCC, SB): /* bcc, branch if carry clear */ |
| if ((C == 0)) |
| goto condtrue; |
| goto next; |
| |
| case O (O_BEQ, SB): /* beq, branch if zero set */ |
| if (Z) |
| goto condtrue; |
| goto next; |
| case O (O_BGT, SB): /* bgt */ |
| if (((Z || (N ^ V)) == 0)) |
| goto condtrue; |
| goto next; |
| |
| case O (O_BLE, SB): /* ble */ |
| if (((Z || (N ^ V)) == 1)) |
| goto condtrue; |
| goto next; |
| |
| case O (O_BGE, SB): /* bge */ |
| if ((N ^ V) == 0) |
| goto condtrue; |
| goto next; |
| case O (O_BLT, SB): /* blt */ |
| if ((N ^ V)) |
| goto condtrue; |
| goto next; |
| case O (O_BMI, SB): /* bmi */ |
| if ((N)) |
| goto condtrue; |
| goto next; |
| case O (O_BNE, SB): /* bne, branch if zero clear */ |
| if ((Z == 0)) |
| goto condtrue; |
| goto next; |
| |
| case O (O_BPL, SB): /* bpl */ |
| if (N == 0) |
| goto condtrue; |
| goto next; |
| case O (O_BVC, SB): /* bvc */ |
| if ((V == 0)) |
| goto condtrue; |
| goto next; |
| case O (O_BVS, SB): /* bvs */ |
| if ((V == 1)) |
| goto condtrue; |
| goto next; |
| |
| /* Trap for Command Line setup. */ |
| case O (O_SYS_CMDLINE, SB): |
| { |
| int i = 0; /* Loop counter. */ |
| int j = 0; /* Loop counter. */ |
| int ind_arg_len = 0; /* Length of each argument. */ |
| int no_of_args = 0; /* The no. or cmdline args. */ |
| int current_location = 0; /* Location of string. */ |
| int old_sp = 0; /* The Initial Stack Pointer. */ |
| int no_of_slots = 0; /* No. of slots required on the stack |
| for storing cmdline args. */ |
| int sp_move = 0; /* No. of locations by which the stack needs |
| to grow. */ |
| int new_sp = 0; /* The final stack pointer location passed |
| back. */ |
| int *argv_ptrs; /* Pointers of argv strings to be stored. */ |
| int argv_ptrs_location = 0; /* Location of pointers to cmdline |
| args on the stack. */ |
| int char_ptr_size = 0; /* Size of a character pointer on |
| target machine. */ |
| int addr_cmdline = 0; /* Memory location where cmdline has |
| to be stored. */ |
| int size_cmdline = 0; /* Size of cmdline. */ |
| |
| /* Set the address of 256 free locations where command line is |
| stored. */ |
| addr_cmdline = cmdline_location(); |
| h8_set_reg (sd, 0, addr_cmdline); |
| |
| /* Counting the no. of commandline arguments. */ |
| for (i = 0; h8_get_cmdline_arg (sd, i) != NULL; i++) |
| continue; |
| |
| /* No. of arguments in the command line. */ |
| no_of_args = i; |
| |
| /* Current location is just a temporary variable,which we are |
| setting to the point to the start of our commandline string. */ |
| current_location = addr_cmdline; |
| |
| /* Allocating space for storing pointers of the command line |
| arguments. */ |
| argv_ptrs = (int *) malloc (sizeof (int) * no_of_args); |
| |
| /* Setting char_ptr_size to the sizeof (char *) on the different |
| architectures. */ |
| if ((h8300hmode || h8300smode) && !h8300_normal_mode) |
| { |
| char_ptr_size = 4; |
| } |
| else |
| { |
| char_ptr_size = 2; |
| } |
| |
| for (i = 0; i < no_of_args; i++) |
| { |
| ind_arg_len = 0; |
| |
| /* The size of the commandline argument. */ |
| ind_arg_len = strlen (h8_get_cmdline_arg (sd, i)) + 1; |
| |
| /* The total size of the command line string. */ |
| size_cmdline += ind_arg_len; |
| |
| /* As we have only 256 bytes, we need to provide a graceful |
| exit. Anyways, a program using command line arguments |
| where we cannot store all the command line arguments |
| given may behave unpredictably. */ |
| if (size_cmdline >= 256) |
| { |
| h8_set_reg (sd, 0, 0); |
| goto next; |
| } |
| else |
| { |
| /* current_location points to the memory where the next |
| commandline argument is stored. */ |
| argv_ptrs[i] = current_location; |
| for (j = 0; j < ind_arg_len; j++) |
| { |
| SET_MEMORY_B ((current_location + |
| (sizeof (char) * j)), |
| *(h8_get_cmdline_arg (sd, i) + |
| sizeof (char) * j)); |
| } |
| |
| /* Setting current_location to the starting of next |
| argument. */ |
| current_location += ind_arg_len; |
| } |
| } |
| |
| /* This is the original position of the stack pointer. */ |
| old_sp = h8_get_reg (sd, SP_REGNUM); |
| |
| /* We need space from the stack to store the pointers to argvs. */ |
| /* As we will infringe on the stack, we need to shift the stack |
| pointer so that the data is not overwritten. We calculate how |
| much space is required. */ |
| sp_move = (no_of_args) * (char_ptr_size); |
| |
| /* The final position of stack pointer, we have thus taken some |
| space from the stack. */ |
| new_sp = old_sp - sp_move; |
| |
| /* Temporary variable holding value where the argv pointers need |
| to be stored. */ |
| argv_ptrs_location = new_sp; |
| |
| /* The argv pointers are stored at sequential locations. As per |
| the H8300 ABI. */ |
| for (i = 0; i < no_of_args; i++) |
| { |
| /* Saving the argv pointer. */ |
| if ((h8300hmode || h8300smode) && !h8300_normal_mode) |
| { |
| SET_MEMORY_L (argv_ptrs_location, argv_ptrs[i]); |
| } |
| else |
| { |
| SET_MEMORY_W (argv_ptrs_location, argv_ptrs[i]); |
| } |
| |
| /* The next location where the pointer to the next argv |
| string has to be stored. */ |
| argv_ptrs_location += char_ptr_size; |
| } |
| |
| /* Required by POSIX, Setting 0x0 at the end of the list of argv |
| pointers. */ |
| if ((h8300hmode || h8300smode) && !h8300_normal_mode) |
| { |
| SET_MEMORY_L (old_sp, 0x0); |
| } |
| else |
| { |
| SET_MEMORY_W (old_sp, 0x0); |
| } |
| |
| /* Freeing allocated memory. */ |
| free (argv_ptrs); |
| for (i = 0; i <= no_of_args; i++) |
| { |
| free (h8_get_cmdline_arg (sd, i)); |
| } |
| free (h8_get_command_line (sd)); |
| |
| /* The no. of argv arguments are returned in Reg 0. */ |
| h8_set_reg (sd, 0, no_of_args); |
| /* The Pointer to argv in Register 1. */ |
| h8_set_reg (sd, 1, new_sp); |
| /* Setting the stack pointer to the new value. */ |
| h8_set_reg (sd, SP_REGNUM, new_sp); |
| } |
| goto next; |
| |
| /* System call processing starts. */ |
| case O (O_SYS_OPEN, SB): |
| { |
| int len = 0; /* Length of filename. */ |
| char *filename; /* Filename would go here. */ |
| char temp_char; /* Temporary character */ |
| int mode = 0; /* Mode bits for the file. */ |
| int open_return; /* Return value of open, file descriptor. */ |
| int i; /* Loop counter */ |
| int filename_ptr; /* Pointer to filename in cpu memory. */ |
| |
| /* Setting filename_ptr to first argument of open, */ |
| /* and trying to get mode. */ |
| if ((h8300sxmode || h8300hmode || h8300smode) && !h8300_normal_mode) |
| { |
| filename_ptr = GET_L_REG (0); |
| mode = GET_MEMORY_L (h8_get_reg (sd, SP_REGNUM) + 4); |
| } |
| else |
| { |
| filename_ptr = GET_W_REG (0); |
| mode = GET_MEMORY_W (h8_get_reg (sd, SP_REGNUM) + 2); |
| } |
| |
| /* Trying to find the length of the filename. */ |
| temp_char = GET_MEMORY_B (h8_get_reg (sd, 0)); |
| |
| len = 1; |
| while (temp_char != '\0') |
| { |
| temp_char = GET_MEMORY_B (filename_ptr + len); |
| len++; |
| } |
| |
| /* Allocating space for the filename. */ |
| filename = (char *) malloc (sizeof (char) * len); |
| |
| /* String copying the filename from memory. */ |
| for (i = 0; i < len; i++) |
| { |
| temp_char = GET_MEMORY_B (filename_ptr + i); |
| filename[i] = temp_char; |
| } |
| |
| /* Callback to open and return the file descriptor. */ |
| open_return = sim_callback->open (sim_callback, filename, mode); |
| |
| /* Return value in register 0. */ |
| h8_set_reg (sd, 0, open_return); |
| |
| /* Freeing memory used for filename. */ |
| free (filename); |
| } |
| goto next; |
| |
| case O (O_SYS_READ, SB): |
| { |
| char *char_ptr; /* Where characters read would be stored. */ |
| int fd; /* File descriptor */ |
| int buf_size; /* BUF_SIZE parameter in read. */ |
| int i = 0; /* Temporary Loop counter */ |
| int read_return = 0; /* Return value from callback to |
| read. */ |
| |
| fd = (h8300hmode && !h8300_normal_mode) ? GET_L_REG (0) : GET_W_REG (0); |
| buf_size = (h8300hmode && !h8300_normal_mode) ? GET_L_REG (2) : GET_W_REG (2); |
| |
| char_ptr = (char *) malloc (sizeof (char) * buf_size); |
| |
| /* Callback to read and return the no. of characters read. */ |
| read_return = |
| sim_callback->read (sim_callback, fd, char_ptr, buf_size); |
| |
| /* The characters read are stored in cpu memory. */ |
| for (i = 0; i < buf_size; i++) |
| { |
| SET_MEMORY_B ((h8_get_reg (sd, 1) + (sizeof (char) * i)), |
| *(char_ptr + (sizeof (char) * i))); |
| } |
| |
| /* Return value in Register 0. */ |
| h8_set_reg (sd, 0, read_return); |
| |
| /* Freeing memory used as buffer. */ |
| free (char_ptr); |
| } |
| goto next; |
| |
| case O (O_SYS_WRITE, SB): |
| { |
| int fd; /* File descriptor */ |
| char temp_char; /* Temporary character */ |
| int len; /* Length of write, Parameter II to write. */ |
| int char_ptr; /* Character Pointer, Parameter I of write. */ |
| char *ptr; /* Where characters to be written are stored. |
| */ |
| int write_return; /* Return value from callback to write. */ |
| int i = 0; /* Loop counter */ |
| |
| fd = (h8300hmode && !h8300_normal_mode) ? GET_L_REG (0) : GET_W_REG (0); |
| char_ptr = (h8300hmode && !h8300_normal_mode) ? GET_L_REG (1) : GET_W_REG (1); |
| len = (h8300hmode && !h8300_normal_mode) ? GET_L_REG (2) : GET_W_REG (2); |
| |
| /* Allocating space for the characters to be written. */ |
| ptr = (char *) malloc (sizeof (char) * len); |
| |
| /* Fetching the characters from cpu memory. */ |
| for (i = 0; i < len; i++) |
| { |
| temp_char = GET_MEMORY_B (char_ptr + i); |
| ptr[i] = temp_char; |
| } |
| |
| /* Callback write and return the no. of characters written. */ |
| write_return = sim_callback->write (sim_callback, fd, ptr, len); |
| |
| /* Return value in Register 0. */ |
| h8_set_reg (sd, 0, write_return); |
| |
|