summaryrefslogtreecommitdiff
path: root/toolchain/gdb
diff options
context:
space:
mode:
Diffstat (limited to 'toolchain/gdb')
-rw-r--r--toolchain/gdb/patches/git/h8300-sim-io.patch1705
1 files changed, 1705 insertions, 0 deletions
diff --git a/toolchain/gdb/patches/git/h8300-sim-io.patch b/toolchain/gdb/patches/git/h8300-sim-io.patch
new file mode 100644
index 000000000..b53a1516b
--- /dev/null
+++ b/toolchain/gdb/patches/git/h8300-sim-io.patch
@@ -0,0 +1,1705 @@
+diff --git a/sim/h8300/Makefile.in b/sim/h8300/Makefile.in
+index da68255..713de00 100644
+--- a/sim/h8300/Makefile.in
++++ b/sim/h8300/Makefile.in
+@@ -18,6 +18,7 @@
+ ## COMMON_PRE_CONFIG_FRAG
+
+ SIM_OBJS = compile.o \
++ io.o \
+ $(SIM_NEW_COMMON_OBJS) \
+ sim-load.o
+
+@@ -28,3 +29,5 @@ compile.o: compile.c inst.h config.h \
+ $(srcdir)/../../include/opcode/h8300.h \
+ $(srcdir)/../../include/gdb/remote-sim.h \
+ $(srcdir)/../../include/gdb/callback.h
++
++io.o: io.c sim-main.h
+diff --git a/sim/h8300/compile.c b/sim/h8300/compile.c
+index d084b5d..b2fe38a 100644
+--- a/sim/h8300/compile.c
++++ b/sim/h8300/compile.c
+@@ -41,11 +41,14 @@
+ #endif
+
+ int debug;
++int h8300_interrupt_mode;
+
+ host_callback *sim_callback;
+
+ static SIM_OPEN_KIND sim_kind;
+ static char *myname;
++static int verbose_interrupt = 0;
++static int logging = 0;
+
+ /* FIXME: Needs to live in header file.
+ This header should also include the things in remote-sim.h.
+@@ -578,10 +581,8 @@ lvalue (SIM_DESC sd, int x, int rn, unsigned int *val)
+ static int
+ cmdline_location()
+ {
+- if (h8300smode && !h8300_normal_mode)
+- return 0xffff00L;
+- else if (h8300hmode && !h8300_normal_mode)
+- return 0x2ff00L;
++ if ((h8300hmode || h8300smode) && !h8300_normal_mode)
++ return 0xff0000L;
+ else
+ return 0xff00L;
+ }
+@@ -1037,12 +1038,15 @@ decode (SIM_DESC sd, int addr, unsigned char *data, decoded_inst *dst)
+
+ /* 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)
++ (SBR will always be 0xffff00 except for h8/sx)
+ */
+ if ((x & SIZE) == L_8)
+ p->reg = SBR_REGNUM;
+ else
+- p->reg = ZERO_REGNUM;;
++ p->reg = ZERO_REGNUM;
++ /* address extend for @x:16 */
++ if ((x & SIZE) == L_16U)
++ p->literal += (p->literal >= 0x8000)?0xff0000:0x000000;
+ }
+ else if ((x & MODE) == MEMIND ||
+ (x & MODE) == VECIND)
+@@ -1253,6 +1257,39 @@ compile (SIM_DESC sd, int pc)
+ h8_set_cache_idx (sd, pc, idx);
+ }
+
++enum mem_access_type {MEM_RL,MEM_RW,MEM_RB,MEM_WL,MEM_WW,MEM_WB};
++
++struct memlog {
++ unsigned long pc;
++ unsigned long addr;
++ unsigned long data;
++ enum mem_access_type type;
++};
++
++static struct memlog *memlog_buffer;
++static int memlogtail;
++static int memlogsize;
++
++static add_memlog(unsigned long pc, unsigned long addr,
++ enum mem_access_type type, unsigned long data)
++{
++ if (!logging)
++ return;
++ if (memlogsize == memlogtail) {
++ memlog_buffer = (struct memlog *)realloc(memlog_buffer,
++ (memlogsize * sizeof(struct memlog) + 65536));
++ memlogsize += 65536 / sizeof(struct memlog);
++ }
++ if (memlog_buffer) {
++ memlog_buffer[memlogtail].pc = pc;
++ memlog_buffer[memlogtail].addr = addr;
++ memlog_buffer[memlogtail].type = type;
++ memlog_buffer[memlogtail].data = data;
++ memlogtail++;
++ }
++}
++
++static int pc;
+
+ static unsigned char *breg[32];
+ static unsigned short *wreg[16];
+@@ -1265,33 +1302,46 @@ static unsigned int *lreg[18];
+ #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)) \
+- : ((h8_get_eightbit (sd, ((X)+0) & 0xff) << 24) \
+- | (h8_get_eightbit (sd, ((X)+1) & 0xff) << 16) \
+- | (h8_get_eightbit (sd, ((X)+2) & 0xff) << 8) \
+- | (h8_get_eightbit (sd, ((X)+3) & 0xff) << 0)))
++#define GET_MEMORY_L(X) _get_memory_l(sd, X)
+
+-#define GET_MEMORY_W(X) \
+- ((X) < memory_size \
+- ? ((h8_get_memory (sd, (X)+0) << 8) \
+- | (h8_get_memory (sd, (X)+1) << 0)) \
+- : ((h8_get_eightbit (sd, ((X)+0) & 0xff) << 8) \
+- | (h8_get_eightbit (sd, ((X)+1) & 0xff) << 0)))
++static inline unsigned long _get_memory_l(SIM_DESC sd, unsigned long addr)
++{
++ unsigned long result;
++ result =
++ ((h8_get_memory (sd, addr+0) << 24) | (h8_get_memory (sd, addr+1) << 16)
++ | (h8_get_memory (sd, addr+2) << 8) | (h8_get_memory (sd, addr+3) << 0));
++ add_memlog(pc, addr, MEM_RL, result);
++ return result;
++}
+
++#define GET_MEMORY_W(X) _get_memory_w(sd, X)
+
+-#define GET_MEMORY_B(X) \
+- ((X) < memory_size ? (h8_get_memory (sd, (X))) \
+- : (h8_get_eightbit (sd, (X) & 0xff)))
++static inline unsigned short _get_memory_w(SIM_DESC sd, unsigned long addr)
++{
++ unsigned short result;
++ result =
++ (h8_get_memory (sd, addr+0) << 8) | (h8_get_memory (sd, addr+1) << 0);
++ add_memlog(pc, addr, MEM_RW, result);
++ return result;
++}
++
++#define GET_MEMORY_B(X) _get_memory_b(sd, X)
+
++static inline unsigned short _get_memory_b(SIM_DESC sd, unsigned long addr)
++{
++ unsigned short result;
++ result = h8_get_memory (sd, addr+0);
++ add_memlog(pc, addr, MEM_RB, result);
++ return result;
++}
++
+ #define SET_MEMORY_L(X, Y) \
+ { register unsigned char *_p; register int __y = (Y); \
+ _p = ((X) < memory_size ? h8_get_memory_buf (sd) + (X) : \
+ h8_get_eightbit_buf (sd) + ((X) & 0xff)); \
+ _p[0] = __y >> 24; _p[1] = __y >> 16; \
+ _p[2] = __y >> 8; _p[3] = __y >> 0; \
++ add_memlog(pc, X, MEM_WL, Y); \
+ }
+
+ #define SET_MEMORY_W(X, Y) \
+@@ -1299,11 +1349,13 @@ static unsigned int *lreg[18];
+ _p = ((X) < memory_size ? h8_get_memory_buf (sd) + (X) : \
+ h8_get_eightbit_buf (sd) + ((X) & 0xff)); \
+ _p[0] = __y >> 8; _p[1] = __y; \
++ add_memlog(pc, X, MEM_WW, Y); \
+ }
+
+ #define SET_MEMORY_B(X, Y) \
+ ((X) < memory_size ? (h8_set_memory (sd, (X), (Y))) \
+- : (h8_set_eightbit (sd, (X) & 0xff, (Y))))
++ : (h8_set_eightbit (sd, (X) & 0xff, (Y)))); \
++ add_memlog(pc, X, MEM_WB, Y)
+
+ /* Simulate a memory fetch.
+ Return 0 for success, -1 for failure.
+@@ -1792,15 +1844,13 @@ init_pointers (SIM_DESC sd)
+ free (h8_get_memory_buf (sd));
+ if (h8_get_cache_idx_buf (sd))
+ free (h8_get_cache_idx_buf (sd));
+- if (h8_get_eightbit_buf (sd))
+- free (h8_get_eightbit_buf (sd));
+
+ h8_set_memory_buf (sd, (unsigned char *)
+ calloc (sizeof (char), memory_size));
+ h8_set_cache_idx_buf (sd, (unsigned short *)
+ calloc (sizeof (short), memory_size));
+ sd->memory_size = memory_size;
+- h8_set_eightbit_buf (sd, (unsigned char *) calloc (sizeof (char), 256));
++ h8_set_eightbit_buf (sd, (unsigned char *)h8_get_memory_buf(sd) + 0xffff00);
+
+ h8_set_mask (sd, memory_size - 1);
+
+@@ -1886,6 +1936,105 @@ case O (name, SB): \
+ goto next; \
+ }
+
++static unsigned long *trace_buffer;
++static unsigned long tracesize;
++static unsigned long tracetail;
++
++static void add_trace(unsigned long pc)
++{
++ static unsigned long last_pc = 0xfffffff;
++
++ if (pc == last_pc || logging == 0)
++ return;
++ last_pc = pc;
++ if (tracesize == tracetail) {
++ trace_buffer = (unsigned long *)realloc(trace_buffer,
++ (tracesize * sizeof(unsigned long) + 65536));
++ tracesize += 65536 / sizeof(unsigned long);
++ }
++ if (trace_buffer)
++ trace_buffer[tracetail++] = pc;
++}
++
++static void init_history(void)
++{
++ if(trace_buffer) {
++ free(trace_buffer);
++ trace_buffer = NULL;
++ }
++ tracesize = tracetail = 0;
++ if(memlog_buffer) {
++ free(memlog_buffer);
++ memlog_buffer = NULL;
++ }
++ memlogsize = memlogtail = 0;
++}
++
++static int intlevel(SIM_DESC sd)
++{
++ if(h8300smode && (h8300_interrupt_mode == 2)) {
++ return h8_get_ccr (sd) & 0x80?0x100:h8_get_exr (sd) << 8;
++ } else if (h8300_interrupt_mode == 1) {
++ switch((h8_get_ccr (sd) >> 6) & 3) {
++ case 0:
++ case 1:
++ return -1;
++ case 2:
++ return 1 << 8;
++ case 3:
++ return 0x100 << 8;
++ }
++ } else {
++ return h8_get_ccr (sd) & 0x80?0x100 << 8:-1;
++ }
++}
++
++int iosimulation(SIM_DESC, int);
++
++#define exception(vector, pri) \
++do { \
++ unsigned int ccr; \
++ unsigned long vbr = 0; \
++ int tmp; \
++ if (verbose_interrupt) \
++ (*sim_callback->printf_filtered) \
++ (sim_callback, "sim_resume: interrupt occured %d\n", (vector)); \
++ BUILDSR (sd); \
++ ccr = h8_get_ccr (sd); \
++ tmp = h8_get_reg (sd, SP_REGNUM); \
++ tmp -= 4; \
++ if (h8300sxmode) \
++ vbr = h8_get_vbr(sd); \
++ if (!h8300hmode || h8300_normal_mode) \
++ { \
++ SET_MEMORY_W (tmp, (ccr << 8) | ccr); \
++ SET_MEMORY_W (tmp, pc); \
++ pc = GET_MEMORY_W (vbr + (vector) * 2) & 0xffff; \
++ } \
++ else \
++ { \
++ SET_MEMORY_L (tmp, (ccr << 24) | pc); \
++ pc=GET_MEMORY_L(vbr + (vector) * 4) & 0xffffff; \
++ } \
++ if (h8300smode && (h8300_interrupt_mode == 2)) \
++ { \
++ int exr; \
++ exr = h8_get_exr (sd); \
++ tmp -= 2; \
++ SET_MEMORY_W (tmp, exr << 8); \
++ if ((pri) >= 0) \
++ { \
++ exr = pri; \
++ h8_set_exr (sd, exr); \
++ intMask = pri; \
++ } \
++ } \
++ h8_set_reg (sd, SP_REGNUM, tmp); \
++ ccr |= (h8300_interrupt_mode == 1)?0xc0:0x80; \
++ h8_set_ccr (sd, ccr); \
++ GETSR(sd); \
++ } while(0)
++
+ void
+ sim_resume (SIM_DESC sd, int step, int siggnal)
+ {
+@@ -1899,12 +2048,12 @@ sim_resume (SIM_DESC sd, int step, int siggnal)
+ int rd;
+ int ea;
+ int bit;
+- int pc;
+ int c, nz, v, n, u, h, ui, intMaskBit;
+ int trace, intMask;
+ int oldmask;
+ enum sim_stop reason;
+ int sigrc;
++ int vector;
+
+ init_pointers (sd);
+
+@@ -1929,7 +2078,7 @@ sim_resume (SIM_DESC sd, int step, int siggnal)
+ /* Get Status Register (flags). */
+ GETSR (sd);
+
+- if (h8300smode) /* Get exr. */
++ if (h8300smode && h8300_interrupt_mode) /* Get exr. */
+ {
+ trace = (h8_get_exr (sd) >> 7) & 1;
+ intMask = h8_get_exr (sd) & 7;
+@@ -1944,6 +2093,7 @@ sim_resume (SIM_DESC sd, int step, int siggnal)
+ decoded_inst *code;
+
+ top:
++ add_trace(pc);
+ cidx = h8_get_cache_idx (sd, pc);
+ if (cidx == (unsigned short) -1 ||
+ cidx >= sd->sim_cache_size)
+@@ -1964,6 +2114,13 @@ sim_resume (SIM_DESC sd, int step, int siggnal)
+ {
+ cycles += code->cycles;
+ insts++;
++ add_trace(pc);
++ if ((vector = iosimulation (sd, cycles)) &&
++ (intlevel(sd) < (vector & 0xff00)))
++ {
++ exception(vector & 0xff, (vector & 0xff00) >> 8);
++ goto end;
++ }
+ }
+
+ switch (code->opcode)
+@@ -3569,16 +3726,20 @@ sim_resume (SIM_DESC sd, int step, int siggnal)
+ /* Pops exr and ccr before pc -- otherwise identical to rts. */
+ tmp = h8_get_reg (sd, SP_REGNUM);
+
+- if (h8300smode) /* pop exr */
++ if (h8300smode && (h8300_interrupt_mode == 2)) /* pop exr */
+ {
+- h8_set_exr (sd, GET_MEMORY_L (tmp));
+- tmp += 4;
++ unsigned char exr;
++ exr = GET_MEMORY_W (tmp) >> 8;
++ h8_set_exr (sd, exr);
++ intMask = exr & 7;
++ trace = exr & 0x80;
++ tmp += 2;
+ }
+ if (h8300hmode && !h8300_normal_mode)
+ {
+- h8_set_ccr (sd, GET_MEMORY_L (tmp));
+- tmp += 4;
+ pc = GET_MEMORY_L (tmp);
++ h8_set_ccr (sd, pc >> 24);
++ pc &= 0x00ffffff;
+ tmp += 4;
+ }
+ else
+@@ -3643,41 +3804,13 @@ sim_resume (SIM_DESC sd, int step, int siggnal)
+ }
+ goto end;
+
+- case O (O_TRAPA, SB): /* trapa */
++ case O (O_TRAPA, SB): { /* trapa */
+ if (fetch (sd, &code->src, &res))
+ goto end; /* res is vector number. */
+-
+- tmp = h8_get_reg (sd, SP_REGNUM);
+- if(h8300_normal_mode)
+- {
+- tmp -= 2;
+- SET_MEMORY_W (tmp, code->next_pc);
+- tmp -= 2;
+- SET_MEMORY_W (tmp, h8_get_ccr (sd));
+- }
+- else
+- {
+- tmp -= 4;
+- SET_MEMORY_L (tmp, code->next_pc);
+- tmp -= 4;
+- SET_MEMORY_L (tmp, h8_get_ccr (sd));
+- }
+- intMaskBit = 1;
+- BUILDSR (sd);
+-
+- if (h8300smode)
+- {
+- tmp -= 4;
+- SET_MEMORY_L (tmp, h8_get_exr (sd));
+- }
+-
+- h8_set_reg (sd, SP_REGNUM, tmp);
+-
+- if(h8300_normal_mode)
+- pc = GET_MEMORY_L (0x10 + res * 2); /* Vector addresses are 0x10,0x12,0x14 and 0x16 */
+- else
+- pc = GET_MEMORY_L (0x20 + res * 4);
++ res += 8;
++ exception(res, -1);
+ goto end;
++ }
+
+ case O (O_BPT, SN):
+ sim_engine_set_run_state (sd, sim_stopped, SIGTRAP);
+@@ -5038,15 +5171,13 @@ sim_load (SIM_DESC sd, const char *prog, bfd *abfd, int from_tty)
+ free (h8_get_memory_buf (sd));
+ if (h8_get_cache_idx_buf (sd))
+ free (h8_get_cache_idx_buf (sd));
+- if (h8_get_eightbit_buf (sd))
+- free (h8_get_eightbit_buf (sd));
+
+ h8_set_memory_buf (sd, (unsigned char *)
+ calloc (sizeof (char), memory_size));
+ h8_set_cache_idx_buf (sd, (unsigned short *)
+ calloc (sizeof (short), memory_size));
+ sd->memory_size = memory_size;
+- h8_set_eightbit_buf (sd, (unsigned char *) calloc (sizeof (char), 256));
++ h8_set_eightbit_buf (sd, (unsigned char *)h8_get_memory_buf(sd) + 0xffff00);
+
+ /* `msize' must be a power of two. */
+ if ((memory_size & (memory_size - 1)) != 0)
+@@ -5057,6 +5188,8 @@ sim_load (SIM_DESC sd, const char *prog, bfd *abfd, int from_tty)
+ }
+ h8_set_mask (sd, memory_size - 1);
+
++ init_history();
++ init_ioregs(sd);
+ if (sim_load_file (sd, myname, sim_callback, prog, prog_bfd,
+ sim_kind == SIM_OPEN_DEBUG,
+ 0, sim_write)
+@@ -5107,3 +5240,187 @@ sim_create_inferior (SIM_DESC sd, struct bfd *abfd, char **argv, char **env)
+
+ return SIM_RC_OK;
+ }
++
++static void show_trace(int lines)
++{
++ unsigned long idx;
++ idx = tracetail - lines;
++ for (; lines > 0; --lines)
++ {
++ if (trace_buffer[idx] != -1)
++ (*sim_callback->printf_filtered) (sim_callback,
++ "0x%06x\n", trace_buffer[idx]);
++ idx++;
++ }
++ (*sim_callback->printf_filtered) (sim_callback, "\n");
++}
++
++static void save_trace(const char *filename)
++{
++ FILE *fp;
++ unsigned long idx;
++ fp = fopen(filename, "w");
++ if (!fp)
++ {
++ (*sim_callback->printf_filtered) (sim_callback,
++ "save-history: file open failed.\n");
++ return ;
++ }
++ for (idx = 0; idx < tracetail; idx++)
++ fprintf(fp, "0x%06x\n", trace_buffer[idx]);
++ fclose(fp);
++}
++
++static const char *memtype_str[]={"RL","RW","RB","WL","WW","WB"};
++
++static void show_memlog(int lines)
++{
++ unsigned long idx;
++ idx = memlogtail - lines;
++ if (memlog_buffer == NULL)
++ {
++ (*sim_callback->printf_filtered) (sim_callback, "no memlog\n");
++ return;
++ }
++ for (; lines > 0; --lines)
++ {
++ (*sim_callback->printf_filtered) (sim_callback,
++ "0x%06x 0x%06x %s %08x\n",
++ memlog_buffer[idx].pc,
++ memlog_buffer[idx].addr,
++ memtype_str[memlog_buffer[idx].type],
++ memlog_buffer[idx].data);
++ idx++;
++ }
++ (*sim_callback->printf_filtered) (sim_callback, "\n");
++}
++
++static void save_memlog(const char *filename)
++{
++ FILE *fp;
++ unsigned long idx;
++ if (memlog_buffer == NULL)
++ {
++ (*sim_callback->printf_filtered) (sim_callback, "no memlog\n");
++ return;
++ }
++ fp = fopen(filename, "w");
++ if (!fp)
++ {
++ (*sim_callback->printf_filtered) (sim_callback,
++ "save-history: file open failed.\n");
++ return ;
++ }
++ for (idx = 0; idx < memlogtail; idx++)
++ fprintf(fp, "0x%06x 0x%06x %s %08x\n",
++ memlog_buffer[idx].pc,
++ memlog_buffer[idx].addr,
++ memtype_str[memlog_buffer[idx].type],
++ memlog_buffer[idx].data);
++ fclose(fp);
++}
++
++void
++sim_do_command (SIM_DESC sd, const char *cmd)
++{
++ if (cmd == NULL || *cmd == '\0')
++ cmd = "help";
++ if (strncmp(cmd, "show-trace", 10) == 0)
++ {
++ int lines = 16;
++ cmd += 10;
++ if (*cmd)
++ lines = atoi(cmd);
++ if (lines > 0)
++ show_trace(lines);
++ else
++ (*sim_callback->printf_filtered) (sim_callback,
++ "Invalid lines\n");
++ return;
++ }
++ else if (strncmp(cmd, "save-trace", 10) == 0)
++ {
++ cmd += 10;
++ while(isspace(*cmd))
++ cmd++;
++
++ if (*cmd)
++ save_trace(cmd);
++ else
++ (*sim_callback->printf_filtered) (sim_callback,
++ "Invalid filename\n");
++ }
++ else if (strncmp(cmd, "show-mem", 8) == 0)
++ {
++ int lines = 16;
++ cmd += 8;
++ if (*cmd)
++ lines = atoi(cmd);
++ if (lines > 0)
++ show_memlog(lines);
++ else
++ (*sim_callback->printf_filtered) (sim_callback,
++ "Invalid lines\n");
++ return;
++ }
++ else if (strncmp(cmd, "save-mem", 8) == 0)
++ {
++ cmd += 8;
++ while(isspace(*cmd))
++ cmd++;
++ if (*cmd)
++ save_memlog(cmd);
++ else
++ (*sim_callback->printf_filtered) (sim_callback,
++ "Invalid filename\n");
++ }
++ else if (strncmp (cmd, "sci", 3) == 0)
++ {
++ cmd += 3;
++ while(isspace(*cmd)) cmd++;
++ if (strncmp (cmd, "pty", 3) == 0)
++ sci_open_pty(sim_callback);
++ else if (strncmp(cmd, "net", 3) == 0)
++ {
++ cmd += 3;
++ while(isspace(*cmd)) cmd++;
++ sci_open_net(sim_callback, atoi(cmd));
++ }
++ }
++ else if (strncmp (cmd, "verbose-int", 11) == 0)
++ {
++ cmd += 11;
++ while(isspace(*cmd)) cmd++;
++ verbose_interrupt = atoi(cmd);
++ }
++ else if (strncmp(cmd, "help", 4) == 0)
++ (*sim_callback->printf_filtered) (sim_callback,
++ "List of H8/300 Simulator commands\n\n"
++ "show-trace <n> -- show trace history\n"
++ "save-trace filename -- save trace history\n"
++ "show-mem <n> -- show memory access log\n"
++ "save-mem filename -- save memory access log\n"
++ "sci [pty|net port] -- open sci port\n"
++ "intmode mode -- set interrupt mode\n"
++ "verbose-int -- verbose interrupt\n"
++ "trace [on|off] -- trace switch\n"
++ );
++ else if (strncmp(cmd, "intmode", 7) == 0)
++ {
++ cmd += 7;
++ while(isspace(*cmd)) cmd++;
++ h8300_interrupt_mode = atoi(cmd);
++ }
++ else if (strncmp (cmd, "trace", 5) == 0)
++ {
++ cmd += 5;
++ while(isspace(*cmd)) cmd++;
++ if (strncmp (cmd, "on", 2) == 0)
++ logging = 1;
++ else if (strncmp(cmd, "off", 3) == 0)
++ logging = 0;
++ }
++ else
++ (*sim_callback->printf_filtered) (sim_callback,
++ "Error: Unknown \"%s\" command\n", cmd);
++}
+diff --git a/sim/h8300/io.c b/sim/h8300/io.c
+new file mode 100644
+index 0000000..d1a12d3
+--- /dev/null
++++ b/sim/h8300/io.c
+@@ -0,0 +1,1058 @@
++/*
++ H8 simulator Internal Peripheral Support
++*/
++
++#include <unistd.h>
++#include <errno.h>
++#include <fcntl.h>
++#include <sys/time.h>
++#include <string.h>
++#define _XOPEN_SOURCE
++#include <stdlib.h>
++#include <sys/socket.h>
++#include <netinet/in.h>
++
++#include "sim-main.h"
++#undef CSIZE
++#include <termios.h>
++
++#define MAX_SCI_CH 3
++
++#define SMR(ch) (STATE_CPU(sd, 0)->eightbit[sci_base[ch]+0])
++#define BRR(ch) (STATE_CPU(sd, 0)->eightbit[sci_base[ch]+1])
++#define SCR(ch) (STATE_CPU(sd, 0)->eightbit[sci_base[ch]+2])
++#define TDR(ch) (STATE_CPU(sd, 0)->eightbit[sci_base[ch]+3])
++#define SSR(ch) (STATE_CPU(sd, 0)->eightbit[sci_base[ch]+4])
++#define RDR(ch) (STATE_CPU(sd, 0)->eightbit[sci_base[ch]+5])
++
++#define TCR8(ch) (STATE_CPU(sd, 0)->eightbit[timer8_base[ch] + 0])
++#define TCSR8(ch) (STATE_CPU(sd, 0)->eightbit[timer8_base[ch] + 2])
++#define TCORA8(ch) (STATE_CPU(sd, 0)->eightbit[timer8_base[ch] + 4])
++#define TCORB8(ch) (STATE_CPU(sd, 0)->eightbit[timer8_base[ch] + 6])
++#define TCNT8(ch) (STATE_CPU(sd, 0)->eightbit[timer8_base[ch] + 8])
++
++#define TSTR16 (STATE_CPU(sd, 0)->eightbit[0x60])
++#define TISRA16 (STATE_CPU(sd, 0)->eightbit[0x64])
++#define TISRB16 (STATE_CPU(sd, 0)->eightbit[0x65])
++#define TISRC16 (STATE_CPU(sd, 0)->eightbit[0x66])
++#define TCR16(ch) (STATE_CPU(sd, 0)->eightbit[0x68 + (ch) * 8])
++#define TCNT16H(ch) (STATE_CPU(sd, 0)->eightbit[0x6a + (ch) * 8])
++#define TCNT16L(ch) (STATE_CPU(sd, 0)->eightbit[0x6b + (ch) * 8])
++#define GRA16H(ch) (STATE_CPU(sd, 0)->eightbit[0x6c + (ch) * 8])
++#define GRA16L(ch) (STATE_CPU(sd, 0)->eightbit[0x6d + (ch) * 8])
++#define GRB16H(ch) (STATE_CPU(sd, 0)->eightbit[0x6e + (ch) * 8])
++#define GRB16L(ch) (STATE_CPU(sd, 0)->eightbit[0x6f + (ch) * 8])
++
++#define TPU_CH 6
++#define TPU_TSTR (STATE_CPU(sd, 0)->eightbit[0xc0])
++#define TPU_TCR(ch) (STATE_CPU(sd, 0)->memory[tpubase[ch] + 0])
++#define TPU_TSR(ch) (STATE_CPU(sd, 0)->memory[tpubase[ch] + 5])
++#define TPU_TCNTH(ch) (STATE_CPU(sd, 0)->memory[tpubase[ch] + 6])
++#define TPU_TCNTL(ch) (STATE_CPU(sd, 0)->memory[tpubase[ch] + 7])
++#define TPU_GRAH(ch) (STATE_CPU(sd, 0)->memory[tpubase[ch] + 8])
++#define TPU_GRAL(ch) (STATE_CPU(sd, 0)->memory[tpubase[ch] + 9])
++#define TPU_GRBH(ch) (STATE_CPU(sd, 0)->memory[tpubase[ch] + 10])
++#define TPU_GRBL(ch) (STATE_CPU(sd, 0)->memory[tpubase[ch] + 11])
++
++#define IPRA_H8300H 0xfee018
++#define IPRB_H8300H 0xfee019
++
++#define IPRA_H8300S 0xfffe00
++
++struct int_list_t {
++ int vector;
++ unsigned int isr_adr;
++ unsigned char isr_mask;
++ unsigned int ier_adr;
++ unsigned char ier_mask;
++};
++
++static const unsigned char *sci_base;
++static unsigned char ssr[MAX_SCI_CH];
++static const unsigned char *timer8_base;
++static const struct int_list_t *int_table;
++
++static const unsigned char h8300h_timer8_base[] = {0x80,0x81,0x90,0x91,0};
++static const unsigned char h8300s_timer8_base[] = {0xb0,0xb1,0};
++static const unsigned int tpubase[] = {0xffffd0,0xffffe0,0xfffff0,
++ 0xfffe80,0xfffe90,0xfffea0};
++static const unsigned char h8300h_sci_base[] = {0xb0,0xb8,0xc0};
++static const unsigned char h8300s_sci_base[] = {0x78,0x80,0x88};
++static const unsigned char h8300sx_sci_base[] = {0x80,0x88,0x60};
++
++extern int h8300hmode;
++extern int h8300smode;
++extern int h8300sxmode;
++
++static const struct int_list_t h8300h_int_table[]= {
++ {24,0xffff64,0x01,0xffff64,0x10}, /* IMIA0 */
++ {25,0xffff65,0x01,0xffff65,0x10}, /* IMIB0 */
++ {26,0xffff66,0x01,0xffff66,0x10}, /* OVI0 */
++ {28,0xffff64,0x02,0xffff64,0x20}, /* IMIA1 */
++ {29,0xffff65,0x02,0xffff65,0x20}, /* IMIB1 */
++ {30,0xffff66,0x02,0xffff66,0x20}, /* OVI1 */
++ {32,0xffff64,0x04,0xffff64,0x40}, /* IMIA2 */
++ {33,0xffff65,0x04,0xffff65,0x40}, /* IMIB2 */
++ {34,0xffff66,0x04,0xffff66,0x40}, /* OVI2 */
++ {36,0xffff82,0x40,0xffff80,0x40}, /* CMIA0 */
++ {37,0xffff82,0x80,0xffff80,0x80}, /* CMIB0 */
++ {38,0xffff83,0x40,0xffff81,0x40}, /* CMIA1 */
++ {38,0xffff83,0x80,0xffff81,0x40}, /* CMIB1 */
++ {39,0xffff82,0x20,0xffff80,0x20}, /* TOVI0 */
++ {39,0xffff83,0x20,0xffff81,0x20}, /* TOVI1 */
++ {40,0xffff92,0x40,0xffff90,0x40}, /* CMIA2 */
++ {41,0xffff92,0x80,0xffff90,0x80}, /* CMIB2 */
++ {42,0xffff93,0x40,0xffff91,0x40}, /* CMIA3 */
++ {42,0xffff93,0x80,0xffff91,0x40}, /* CMIB3 */
++ {43,0xffff92,0x20,0xffff90,0x20}, /* TOVI2 */
++ {43,0xffff93,0x20,0xffff91,0x20}, /* TOVI3 */
++ {52,0xffffb4,0x38,0xffffb2,0x40}, /* ERI0 */
++ {53,0xffffb4,0x40,0xffffb2,0x40}, /* RXI0 */
++ {54,0xffffb4,0x80,0xffffb2,0x80}, /* TXI0 */
++ {55,0xffffb4,0x04,0xffffb2,0x04}, /* TEI0 */
++ {56,0xffffbc,0x38,0xffffba,0x40}, /* ERI1 */
++ {57,0xffffbc,0x40,0xffffba,0x40}, /* RXI1 */
++ {58,0xffffbc,0x80,0xffffba,0x80}, /* TXI1 */
++ {59,0xffffbc,0x04,0xffffba,0x04}, /* TEI1 */
++ {60,0xffffc4,0x38,0xffffc2,0x40}, /* ERI2 */
++ {61,0xffffc4,0x40,0xffffc2,0x40}, /* RXI2 */
++ {62,0xffffc4,0x80,0xffffc2,0x80}, /* TXI2 */
++ {63,0xffffc4,0x04,0xffffc2,0x04}, /* TEI2 */
++ {-1,0,0,0,0}
++};
++
++static const struct int_list_t h8300s_int_table[]= {
++ {40,0xffffd5,0x01,0xffffd4,0x01}, /* TGI0A */
++ {41,0xffffd5,0x02,0xffffd4,0x02}, /* TGI0B */
++ {43,0xffffd5,0x10,0xffffd4,0x10}, /* TGI0V */
++ {48,0xffffe5,0x01,0xffffe4,0x01}, /* TGI1A */
++ {49,0xffffe5,0x01,0xffffe4,0x02}, /* TGI1B */
++ {50,0xffffe5,0x10,0xffffe4,0x10}, /* TGI1V */
++ {52,0xfffff5,0x01,0xfffff4,0x01}, /* TGI2A */
++ {53,0xfffff5,0x02,0xfffff4,0x02}, /* TGI2B */
++ {54,0xfffff5,0x10,0xfffff4,0x10}, /* TGI2V */
++ {56,0xfffe85,0x01,0xfffe84,0x01}, /* TGI3A */
++ {57,0xfffe85,0x02,0xfffe84,0x02}, /* TGI3B */
++ {60,0xfffe85,0x10,0xfffe84,0x10}, /* TGI3V */
++ {64,0xfffe95,0x01,0xfffe94,0x01}, /* TGI4A */
++ {65,0xfffe95,0x02,0xfffe94,0x02}, /* TGI4B */
++ {66,0xfffe95,0x10,0xfffe94,0x10}, /* TGI4V */
++ {68,0xfffea5,0x01,0xfffea4,0x01}, /* TGI5A */
++ {69,0xfffea5,0x02,0xfffea4,0x02}, /* TGI5B */
++ {70,0xfffea5,0x10,0xfffea4,0x10}, /* TGI5V */
++ {72,0xffffb2,0x40,0xffffb0,0x40}, /* CMIA0 */
++ {73,0xffffb2,0x80,0xffffb0,0x80}, /* CMIB0 */
++ {74,0xffffb2,0x20,0xffffb0,0x20}, /* CMIA1 */
++ {76,0xffffb3,0x40,0xffffb1,0x40}, /* CMIB1 */
++ {77,0xffffb3,0x80,0xffffb1,0x40}, /* TOVI0 */
++ {78,0xffffb3,0x20,0xffffb1,0x20}, /* TOVI1 */
++ {88,0xffff7c,0x38,0xffff7a,0x40}, /* ERI0 */
++ {89,0xffff7c,0x40,0xffff7a,0x40}, /* RXI0 */
++ {90,0xffff7c,0x80,0xffff7a,0x80}, /* TXI0 */
++ {91,0xffff7c,0x04,0xffff7a,0x04}, /* TEI0 */
++ {92,0xffff84,0x38,0xffff82,0x40}, /* ERI1 */
++ {93,0xffff84,0x40,0xffff82,0x40}, /* RXI1 */
++ {94,0xffff84,0x80,0xffff82,0x80}, /* TXI1 */
++ {95,0xffff84,0x04,0xffff82,0x04}, /* TEI1 */
++ {96,0xffff8c,0x38,0xffff8a,0x40}, /* ERI2 */
++ {97,0xffff8c,0x40,0xffff8a,0x40}, /* RXI2 */
++ {98,0xffff8c,0x80,0xffff8a,0x80}, /* TXI2 */
++ {99,0xffff8c,0x04,0xffff8a,0x04}, /* TEI2 */
++ {-1,0,0,0,0}
++};
++static const struct int_list_t h8300sx_int_table[]= {
++ {88,0xffffd5,0x01,0xffffd4,0x01}, /* TGI0A */
++ {89,0xffffd5,0x02,0xffffd4,0x02}, /* TGI0B */
++ {90,0xffffd5,0x01,0xffffd4,0x01}, /* TGI0C */
++ {91,0xffffd5,0x02,0xffffd4,0x02}, /* TGI0D */
++ {93,0xffffe5,0x01,0xffffe4,0x01}, /* TGI1A */
++ {94,0xffffe5,0x01,0xffffe4,0x02}, /* TGI1B */
++ {95,0xffffe5,0x10,0xffffe4,0x10}, /* TGI1V */
++ {96,0xffffe5,0x10,0xffffe4,0x10}, /* TGI1U */
++ {97,0xfffff5,0x01,0xfffff4,0x01}, /* TGI2A */
++ {98,0xfffff5,0x02,0xfffff4,0x02}, /* TGI2B */
++ {99,0xfffff5,0x10,0xfffff4,0x10}, /* TGI2V */
++ {100,0xfffff5,0x10,0xfffff4,0x10}, /* TGI2U */
++ {101,0xfffe85,0x01,0xfffe84,0x01}, /* TGI3A */
++ {102,0xfffe85,0x02,0xfffe84,0x02}, /* TGI3B */
++ {103,0xfffe85,0x01,0xfffe84,0x01}, /* TGI3A */
++ {104,0xfffe85,0x02,0xfffe84,0x02}, /* TGI3B */
++ {105,0xfffe85,0x10,0xfffe84,0x10}, /* TGI3V */
++ {106,0xfffe95,0x01,0xfffe94,0x01}, /* TGI4A */
++ {107,0xfffe95,0x02,0xfffe94,0x02}, /* TGI4B */
++ {108,0xfffe95,0x10,0xfffe94,0x10}, /* TGI4V */
++ {109,0xfffe95,0x10,0xfffe94,0x10}, /* TGI4U */
++ {110,0xfffea5,0x01,0xfffea4,0x01}, /* TGI5A */
++ {111,0xfffea5,0x02,0xfffea4,0x02}, /* TGI5B */
++ {112,0xfffea5,0x10,0xfffea4,0x10}, /* TGI5V */
++ {113,0xfffea5,0x10,0xfffea4,0x10}, /* TGI5V */
++ {116,0xffffb2,0x40,0xffffb0,0x40}, /* CMIA0 */
++ {117,0xffffb2,0x80,0xffffb0,0x80}, /* CMIB0 */
++ {118,0xffffb3,0x80,0xffffb1,0x40}, /* OVI0 */
++ {119,0xffffb2,0x20,0xffffb0,0x20}, /* CMIA1 */
++ {120,0xffffb3,0x40,0xffffb1,0x40}, /* CMIB1 */
++ {121,0xffffb3,0x20,0xffffb1,0x20}, /* OVI1 */
++ {144,0xffff7c,0x38,0xffff7a,0x40}, /* ERI0 */
++ {145,0xffff7c,0x40,0xffff7a,0x40}, /* RXI0 */
++ {146,0xffff7c,0x80,0xffff7a,0x80}, /* TXI0 */
++ {147,0xffff7c,0x04,0xffff7a,0x04}, /* TEI0 */
++ {148,0xffff84,0x38,0xffff82,0x40}, /* ERI1 */
++ {149,0xffff84,0x40,0xffff82,0x40}, /* RXI1 */
++ {150,0xffff84,0x80,0xffff82,0x80}, /* TXI1 */
++ {151,0xffff84,0x04,0xffff82,0x04}, /* TEI1 */
++ {152,0xffff8c,0x38,0xffff8a,0x40}, /* ERI2 */
++ {153,0xffff8c,0x40,0xffff8a,0x40}, /* RXI2 */
++ {154,0xffff8c,0x80,0xffff8a,0x80}, /* TXI2 */
++ {155,0xffff8c,0x04,0xffff8a,0x04}, /* TEI2 */
++ {-1,0,0,0,0}
++};
++
++void
++timer8(SIM_DESC sd, unsigned int cycles_diff)
++{
++ static int prescale[3]={8,64,8192};
++ const int prescale_div[3]={8,64,8192};
++ static unsigned char tcsr[4]={0x00,0x00,0x00,0x00};
++ int tm, cnt, pcnt, cor;
++ for (pcnt = 0; pcnt < 3; pcnt++)
++ {
++ prescale[pcnt] -= cycles_diff;
++
++ if (prescale[pcnt]<=0)
++ {
++ /* input time pulse */
++ for(tm=0; timer8_base[tm] != 0; tm++)
++ {
++ if ((TCR8(tm) & 0x07) == 0)
++ continue;
++ /* internal TCSR status clear */
++ tcsr[tm] &= (TCSR8(tm) & 0xf0);
++
++ if ((TCR8(tm & 2) & 0x7) == 0x04)
++ {
++ /* 16bit mode */
++ if (tm & 1)
++ continue;
++ tcsr[tm+1] &= (TCSR8(tm+1) & 0xf0);
++ cnt = TCNT8(tm) << 8 | TCNT8(tm+1);
++ cnt++;
++ if (cnt >= 0x10000)
++ {
++ tcsr[tm] |= 0x20;
++ cnt = 0;
++ }
++ TCNT8(tm) = cnt >> 8;
++ TCNT8(tm-1) = cnt & 0xff;
++ /* TCORA compare match check */
++ cor = TCORA8(tm) << 8 | TCORA8(tm+1);
++ if (cnt >= cor)
++ {
++ tcsr[tm]|=0x40;
++ if ((TCR8(tm) & 0x18) == 0x08)
++ cnt = 0;
++ }
++ if ((cnt & 0xff) >= (cor & 0xff))
++ tcsr[tm+1]|=0x40;
++ /* TCORB compare match check */
++ cor = TCORB8(tm) << 8 | TCORB8(tm+1);
++ if (cnt >= cor)
++ {
++ tcsr[tm]|=0x80;
++ if ((TCR8(tm) & 0x18) == 0x10)
++ cnt = 0;
++ }
++ if ((cnt & 0xff) >= (cor & 0xff))
++ tcsr[tm+1]|=0x80;
++ TCNT8(tm) = cnt >> 8;
++ TCNT8(tm+1) = cnt & 0xff;
++ /* update TSCR */
++ TCSR8(tm) &= 0x1f;
++ TCSR8(tm) |= (tcsr[tm] & 0xe0);
++ TCSR8(tm+1) &= 0x1f;
++ TCSR8(tm+1) |= (tcsr[tm+1] & 0xe0);
++ }
++ else
++ {
++ /* 8bit mode */
++ /* update counter */
++ if ((TCR8(tm) & 0x07) == (pcnt+1))
++ {
++ cnt = ++TCNT8(tm);
++ if (cnt>=0x100)
++ {
++ tcsr[tm] |= 0x20;
++ cnt = 0;
++ }
++ }
++ /* TCORA compare match check*/
++ if (cnt >= TCORA8(tm))
++ {
++ tcsr[tm]|=0x40;
++ if ((TCR8(tm) & 0x18) == 0x08)
++ cnt = 0;
++ }
++ /* TCORB compare match check*/
++ if (cnt >= TCORB8(tm))
++ {
++ tcsr[tm]|=0x80;
++ if ((TCR8(tm) & 0x18) == 0x10)
++ cnt = 0;
++ }
++ TCNT8(tm) = cnt;
++ /* update TSCR */
++ TCSR8(tm) &= 0x1f;
++ TCSR8(tm) |= (tcsr[tm] & 0xe0);
++ }
++ }
++ prescale[pcnt]+=prescale_div[pcnt];
++ }
++ }
++}
++
++static void
++h8300sx_timer16(SIM_DESC sd, unsigned int cycles_diff)
++{
++ static int prescale[4]={1,4,16,64};
++ const int prescale_div[4]={1,4,16,64};
++ static int tsr[TPU_CH];
++ int tm, cnt, pcnt, gr, pulse;
++ for (pcnt = 0; pcnt < 4; pcnt++) {
++ prescale[pcnt] -= cycles_diff;
++ pulse = -prescale[pcnt] / prescale_div[cnt] + 1;
++ if (prescale[pcnt]<=0)
++ {
++ /* input time pulse */
++ for(tm=0; tm < TPU_CH; tm++) {
++
++ /* Timer enable check */
++ if (!(TPU_TSTR & (1 << tm)))
++ continue;
++
++ /* internal TCSR status clear */
++ tsr[tm] &= TPU_TSR(tm);
++ /* update counter */
++ if ((TPU_TCR(tm) & 0x07) == pcnt)
++ {
++ cnt = ((TPU_TCNTH(tm) << 8) | TPU_TCNTL(tm));
++ cnt += pulse;
++
++ /* CNT overflow check */
++ if (cnt>=0x10000)
++ {
++ tsr[tm] |= 0x10;
++ cnt = 0;
++ }
++
++ /* GRA compare match check*/
++ gr = (TPU_GRAH(tm) << 8) | TPU_GRAL(tm);
++ if (cnt >= gr)
++ {
++ tsr[tm] |= 0x1;
++ if ((TPU_TCR(tm) & 0x60) == 0x20)
++ cnt = 0;
++ }
++
++ /* GRB compare match check*/
++ gr = (TPU_GRBH(tm) << 8) | TPU_GRBL(tm);
++ if (cnt >= gr)
++ {
++ tsr[tm] |= 0x2;
++ if ((TPU_TCR(tm) & 0x60) == 0x20)
++ cnt = 0;
++ }
++
++ /* update TCNT */
++ TPU_TCNTH(tm) = (cnt >> 8);
++ TPU_TCNTL(tm) = cnt & 0xff;
++ }
++
++ }
++ prescale[pcnt]+=prescale_div[pcnt];
++ /* update TSR */
++ TPU_TSR(tm) |= tsr[tm];
++ }
++ }
++}
++
++static void
++h8300s_timer16(SIM_DESC sd, unsigned int cycles_diff)
++{
++ static int prescale[4]={1,4,16,64};
++ const int prescale_div[4]={1,4,16,64};
++ static int tsr[TPU_CH];
++ int tm, cnt, pcnt, gr, pulse;
++ for (pcnt = 0; pcnt < 4; pcnt++) {
++ prescale[pcnt] -= cycles_diff;
++ pulse = -prescale[pcnt] / prescale_div[pcnt] + 1;
++ if (prescale[pcnt]<=0)
++ {
++ /* input time pulse */
++ for(tm=0; tm < TPU_CH; tm++) {
++
++ /* Timer enable check */
++ if (!(TPU_TSTR & (1 << tm)))
++ continue;
++
++ /* internal TCSR status clear */
++ tsr[tm] &= TPU_TSR(tm);
++ /* update counter */
++ if ((TPU_TCR(tm) & 0x0f) == pcnt)
++ {
++ cnt = ((TPU_TCNTH(tm) << 8) | TPU_TCNTL(tm));
++ cnt += pulse;
++
++ /* CNT overflow check */
++ if (cnt>=0x10000)
++ {
++ int cascade_low = tm % 3;
++ tsr[tm] |= 0x10;
++ cnt -= 0x10000;
++ if (cascade_low == 2)
++ {
++ int cascade_high = tm - cascade_low + 1;
++ if (TPU_TCR(cascade_high) & 0x0f == 0x0f)
++ {
++ int cascade_cnt;
++ cascade_cnt = ((TPU_TCNTH(cascade_high) << 8) |
++ TPU_TCNTL(cascade_high));
++ cascade_cnt++;
++ TPU_TCNTH(cascade_high) = (cascade_cnt >> 8);
++ TPU_TCNTL(cascade_high) = cascade_cnt & 0xff;
++ }
++ }
++ }
++
++ /* GRA compare match check*/
++ gr = (TPU_GRAH(tm) << 8) | TPU_GRAL(tm);
++ if (cnt >= gr)
++ {
++ tsr[tm] |= 0x1;
++ if ((TPU_TCR(tm) & 0xe0) == 0x20)
++ cnt = 0;
++ }
++
++ /* GRB compare match check*/
++ gr = (TPU_GRBH(tm) << 8) | TPU_GRBL(tm);
++ if (cnt >= gr)
++ {
++ tsr[tm] |= 0x2;
++ if ((TPU_TCR(tm) & 0xe0) == 0x40)
++ cnt = 0;
++ }
++
++ /* update TCNT */
++ TPU_TCNTH(tm) = (cnt >> 8);
++ TPU_TCNTL(tm) = cnt & 0xff;
++ }
++
++ }
++ prescale[pcnt]+=prescale_div[pcnt];
++ /* update TSR */
++ TPU_TSR(tm) |= tsr[tm];
++ }
++ }
++}
++
++static void
++h8300h_timer16(SIM_DESC sd, unsigned int cycles_diff)
++{
++ static int prescale[4]={1,2,4,8};
++ const int prescale_div[4]={1,2,4,8};
++ static int tisra, tisrb, tisrc;
++ int tm, cnt, pcnt, gr, pulse;
++ for (pcnt = 0; pcnt < 4; pcnt++) {
++ prescale[pcnt] -= cycles_diff;
++ if (prescale[pcnt]<=0)
++ {
++ pulse = -prescale[pcnt] / prescale_div[pcnt] + 1;
++ prescale[pcnt]+=prescale_div[pcnt];
++ /* input time pulse */
++ for(tm=0; tm < 3; tm++) {
++
++ /* Timer enable check */
++ if (!(TSTR16 & (1 << tm)))
++ continue;
++
++ /* internal TCSR status clear */
++ tisra &= (0x07 & (TISRA16 & (1 << tm)));
++ tisrb &= (0x07 & (TISRB16 & (1 << tm)));
++ tisrc &= (0x07 & (TISRC16 & (1 << tm)));
++ /* update counter */
++ if ((TCR16(tm) & 0x07) == pcnt)
++ {
++ cnt = ((TCNT16H(tm) << 8) | TCNT16L(tm));
++ cnt += pulse;
++
++ /* CNT overflow check */
++ if (cnt>=0x10000)
++ {
++ tisrc |= (1 << tm);
++ cnt = 0;
++ }
++
++ /* GRA compare match check*/
++ gr = (GRA16H(tm) << 8) | GRA16L(tm);
++ if (cnt >= gr)
++ {
++ tisra |= (1 << tm);
++ if ((TCR16(tm) & 0x60) == 0x20)
++ cnt = 0;
++ }
++
++ /* GRB compare match check*/
++ gr = (GRB16H(tm) << 8) | GRB16L(tm);
++ if (cnt >= gr)
++ {
++ tisrb |= (1 << tm);
++ if ((TCR16(tm) & 0x60) == 0x40)
++ cnt = 0;
++ }
++ /* update TCNT */
++ TCNT16H(tm) = (cnt >> 8);
++ TCNT16L(tm) = cnt & 0xff;
++ }
++
++ }
++ /* update TSCR */
++ TISRA16 &= 0x70;
++ TISRA16 |= tisra;
++ TISRB16 &= 0x70;
++ TISRB16 |= tisrb;
++ TISRC16 &= 0x70;
++ TISRC16 |= tisrc;
++ }
++ }
++}
++
++static struct {
++ int fd;
++ int socket;
++ int iac;
++ unsigned char cmd;
++ struct sockaddr_in local;
++ struct sockaddr_in remote;
++ struct termios old_attr;
++} sci_port[MAX_SCI_CH];
++
++enum {PORT_NONE, PORT_PTY,PORT_NET};
++static int sci_port_type = PORT_NONE;
++
++static unsigned int
++sci_complete_time(SIM_DESC sd, int ch)
++{
++ int length;
++ int div[]={1,4,16,64};
++ length = (SMR(ch) & 0x40)?7:8;
++ length += (SMR(ch) & 0x20)?1:0;
++ length += (SMR(ch) & 0x08)?1:0;
++ length += 2;
++ return length * 32 * div[SMR(ch) & 0x03] * BRR(ch);
++}
++
++static void
++sci_send_data(int ch, int txd)
++{
++ char dt = txd;
++ if (sci_port[ch].fd >= 0) {
++ if (write(sci_port[ch].fd, &dt, 1) > 0)
++ fsync(sci_port[ch].fd);
++ else
++ if (errno != EAGAIN)
++ sci_port[ch].fd = -1;
++ }
++}
++
++static void
++telnet_escape(int ch, char rd)
++{
++ unsigned char cmd = sci_port[ch].cmd;
++ unsigned char rep[3];
++ switch(sci_port[ch].iac)
++ {
++ case 1:
++ sci_port[ch].cmd = rd;
++ sci_port[ch].iac++;
++ break;
++ case 2:
++ if ((rd == 1 || rd == 3) && cmd == 0xfd)
++ {
++ sci_port[ch].iac = 0;
++ return;
++ }
++ else if (rd == 1 || rd == 3)
++ {
++ if (cmd == 0xfb)
++ cmd = 0xfd;
++ else if (cmd == 0xfd)
++ cmd = 0xfb;
++ }
++ else
++ {
++ if (cmd == 0xfb)
++ cmd = 0xfe;
++ else if (cmd == 0xfd)
++ cmd = 0xfc;
++ }
++ rep[0] = 0xff;
++ rep[1] = cmd;
++ rep[2] = rd;
++ write(sci_port[ch].fd, rep, sizeof(rep));
++ sci_port[ch].iac = 0;
++ break;
++ }
++}
++
++static void
++telnet_request(int fd)
++{
++ static unsigned char req[6] = {0xff, 0xfb, 0x03, 0xff, 0xfb, 0x01};
++ write(fd, req, sizeof(req));
++}
++
++
++int
++sci_rcv_data(int ch, int *rxd)
++{
++ unsigned char rd;
++ if (sci_port[ch].fd >= 0)
++ {
++ if( read(sci_port[ch].fd, &rd , 1) > 0 )
++ {
++ if (sci_port_type == PORT_NET)
++ {
++ if (sci_port[ch].iac > 0)
++ {
++ telnet_escape(ch, rd);
++ return 0;
++ }
++ else
++ if (rd == 0xff)
++ {
++ sci_port[ch].iac = 1;
++ return 0;
++ }
++ }
++ *rxd = rd;
++ return 1;
++ }
++ else
++ {
++ if (errno == EAGAIN)
++ {
++ return 0;
++ }
++ else
++ {
++ close(sci_port[ch].fd);
++ sci_port[ch].fd = -1;
++ }
++ }
++ }
++ return 0;
++}
++
++static int net_accept(void)
++{
++ int ch;
++ for (ch = 0; ch < MAX_SCI_CH; ch++)
++ {
++ if(sci_port[ch].fd == -1)
++ {
++ int connectfd;
++ socklen_t rem_size = sizeof(sci_port[ch].remote);
++ connectfd = accept(sci_port[ch].socket,
++ (struct sockaddr *)&sci_port[ch].remote,
++ &rem_size);
++ if (connectfd > 0)
++ {
++ unsigned char rd;
++ int flag;
++ sci_port[ch].fd = connectfd;
++ telnet_request(connectfd);
++ sci_port[ch].iac = 0;
++ flag = fcntl(sci_port[ch].fd, F_GETFL, 0);
++ fcntl(sci_port[ch].fd, F_SETFL, flag | O_NONBLOCK);
++
++ while ( read(sci_port[ch].fd, &rd , 1) > 0 )
++ {
++ if (sci_port[ch].iac > 0)
++ {
++ telnet_escape(ch, rd);
++ return 1;
++ }
++ else
++ if (rd == 0xff)
++ {
++ sci_port[ch].iac = 1;
++ return 1;
++ }
++ }
++ }
++ }
++ }
++ return 0;
++}
++
++static void
++sci(SIM_DESC sd, unsigned int cycles_diff)
++{
++ static int tx_end_time[MAX_SCI_CH];
++ static int rx_end_time[MAX_SCI_CH];
++ static int txstate = 0;
++ int data;
++ int ch;
++
++ if (sci_port_type == PORT_NET && net_accept())
++ return;
++
++ for (ch = 0; ch < MAX_SCI_CH; ch++)
++ {
++ /* clear internal ssr */
++ ssr[ch] &= SSR(ch);
++
++ /* Tx request */
++ if((SCR(ch) & 0x20) && !(ssr[ch] & 0x80) && (txstate == 0))
++ {
++ sci_send_data(ch,TDR(ch));
++ ssr[ch] &= ~0x04;
++ /* TSR shift time */
++ tx_end_time[ch] = 1;
++ txstate = 1;
++ }
++ tx_end_time[ch] -= cycles_diff;
++ /* Tx complete check */
++ if(((ssr[ch] & 0x84) != 0x84) && (tx_end_time[ch] <= 0))
++ if (!(ssr[ch] & 0x80))
++ {
++ ssr[ch] |= 0x80;
++ tx_end_time[ch] = sci_complete_time(sd, ch);
++ txstate = 0;
++ }
++ else
++ ssr[ch] |= 0x04; /* All data transmit done */
++ rx_end_time[ch] -= cycles_diff;
++ /* Rx check */
++ if (rx_end_time[ch] <= 0)
++ /* RSR free & Rx Enabled */
++ if ((SCR(ch) & 0x10) && sci_rcv_data(ch, &data))
++ {
++ /* Rx Overrun */
++ if(ssr[ch] & 0x40)
++ ssr[ch] |= 0x20;
++ else
++ /* Rx ok */
++ {
++ RDR(ch)=data;
++ ssr[ch] |= 0x40;
++ }
++ /* RSR shift time */
++ rx_end_time[ch] = sci_complete_time(sd, ch);
++ }
++
++ /* update SSR */
++ SSR(ch) = ssr[ch];
++ }
++}
++
++static int
++get_priority(SIM_DESC sd, int vec)
++{
++ const static int ipr_bit[] = {
++ -1, -1, -1, -1, -1, -1, -1, -1,
++ -1, -1, -1, -1, 7, 6, 5, 5,
++ 4, 4, 4, 4, 3, 3, 3, 3,
++ 2, 2, 2, 2, 1, 1, 1, 1,
++ 0, 0, 0, 0, 15, 15, 15, 15,
++ 14, 14, 14, 14, 13, 13, 13, 13,
++ -1, -1, -1, -1, 11, 11, 11, 11,
++ 10, 10, 10, 10, 9, 9, 9, 9,
++ };
++ const static unsigned char ipr_table[] = {
++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, /* 0 - 7 */
++ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, /* 8 - 15 */
++ 0x03, 0x02, 0x01, 0x00, 0x13, 0x12, 0x11, 0x10, /* 16 - 23 */
++ 0x23, 0x22, 0x21, 0x20, 0x33, 0x32, 0x31, 0x30, /* 24 - 31 */
++ 0x43, 0x42, 0x41, 0x40, 0x53, 0x53, 0x52, 0x52, /* 32 - 39 */
++ 0x51, 0x51, 0x51, 0x51, 0x51, 0x51, 0x51, 0x51, /* 40 - 47 */
++ 0x50, 0x50, 0x50, 0x50, 0x63, 0x63, 0x63, 0x63, /* 48 - 55 */
++ 0x62, 0x62, 0x62, 0x62, 0x62, 0x62, 0x62, 0x62, /* 56 - 63 */
++ 0x61, 0x61, 0x61, 0x61, 0x60, 0x60, 0x60, 0x60, /* 64 - 71 */
++ 0x73, 0x73, 0x73, 0x73, 0x72, 0x72, 0x72, 0x72, /* 72 - 79 */
++ 0x71, 0x71, 0x71, 0x71, 0x70, 0x83, 0x82, 0x81, /* 80 - 87 */
++ 0x80, 0x80, 0x80, 0x80, 0x93, 0x93, 0x93, 0x93, /* 88 - 95 */
++ 0x92, 0x92, 0x92, 0x92, 0x91, 0x91, 0x91, 0x91, /* 96 - 103 */
++ 0x90, 0x90, 0x90, 0x90, 0xa3, 0xa3, 0xa3, 0xa3, /* 104 - 111 */
++ 0xa2, 0xa2, 0xa2, 0xa2, 0xa1, 0xa1, 0xa1, 0xa1, /* 112 - 119 */
++ 0xa0, 0xa0, 0xa0, 0xa0, 0xa0, 0xa0, 0xa0, 0xa0, /* 120 - 127 */
++ };
++
++
++ if (h8300smode)
++ {
++ unsigned short ipr;
++ int pos;
++ if ((pos = ipr_table[vec]) == 0xff)
++ return 0;
++ ipr = (STATE_CPU(sd, 0)->memory[IPRA_H8300S + ((pos & 0xf0) >> 3)] << 8) |
++ (STATE_CPU(sd, 0)->memory[IPRA_H8300S + ((pos & 0xf0) >> 3) + 1]);
++ return vec + ((ipr >> ((pos & 0x0f) * 4)) & 7) * 0x100;
++ }
++ else if (h8300hmode)
++ {
++ int b;
++ unsigned char ipr;
++ if ((b = ipr_bit[vec]) < 0)
++ return 0;
++ ipr = (b < 8)?STATE_CPU(sd, 0)->memory[IPRA_H8300H]:
++ STATE_CPU(sd, 0)->memory[IPRB_H8300H];
++ b = 1 << (b & 7);
++ if (ipr & b)
++ return vec + 0x100;
++ else
++ return vec;
++ }
++}
++
++static int
++intcont(SIM_DESC sd)
++{
++ int irqno;
++ for (irqno=0; int_table[irqno].vector > 0; irqno++)
++ {
++ if((STATE_CPU(sd, 0)->memory[int_table[irqno].ier_adr] &
++ int_table[irqno].ier_mask) &&
++ (STATE_CPU(sd, 0)->memory[int_table[irqno].isr_adr] &
++ int_table[irqno].isr_mask))
++ return get_priority(sd, int_table[irqno].vector);
++ }
++ return 0;
++}
++
++int
++iosimulation(SIM_DESC sd, int cycles)
++{
++ static unsigned int prev_cycles = 0;
++ unsigned int cycles_diff;
++ cycles_diff = (cycles < prev_cycles)?cycles:(cycles - prev_cycles);
++ prev_cycles = cycles;
++ timer8(sd, cycles_diff);
++ if (h8300smode)
++ h8300s_timer16(sd, cycles_diff);
++ else if (h8300hmode)
++ h8300h_timer16(sd, cycles_diff);
++ sci(sd, cycles_diff);
++ return intcont(sd);
++}
++
++void init_ioregs(SIM_DESC sd)
++{
++ struct INITTABLE {
++ unsigned char addr;
++ unsigned char data;
++ };
++ const struct INITTABLE h8300h_reg_ini[] = {
++ 0x80,0x00,
++ 0x81,0x00,
++ 0x82,0x00,
++ 0x83,0x00,
++ 0x84,0xff,
++ 0x85,0xff,
++ 0x86,0xff,
++ 0x87,0xff,
++ 0x88,0x00,
++ 0x89,0x00,
++ 0x90,0x00,
++ 0x91,0x00,
++ 0x92,0x00,
++ 0x93,0x00,
++ 0x94,0xff,
++ 0x95,0xff,
++ 0x96,0xff,
++ 0x97,0xff,
++ 0x98,0x00,
++ 0x99,0x00,
++ 0xb0,0x00,
++ 0xb1,0xff,
++ 0xb2,0x00,
++ 0xb3,0xff,
++ 0xb4,0x84,
++ 0xb8,0x00,
++ 0xb9,0xff,
++ 0xba,0x00,
++ 0xbb,0xff,
++ 0xbc,0x84,
++ 0xc0,0x00,
++ 0xc1,0xff,
++ 0xc2,0x00,
++ 0xc3,0xff,
++ 0xc4,0x84,
++ };
++ const struct INITTABLE h8300s_reg_ini[] = {
++ 0xb0,0x00,
++ 0xb1,0x00,
++ 0xb2,0x00,
++ 0xb3,0x00,
++ 0xb4,0xff,
++ 0xb5,0xff,
++ 0xb6,0xff,
++ 0xb7,0xff,
++ 0xb8,0x00,
++ 0xb9,0x00,
++ 0x78,0x00,
++ 0x79,0xff,
++ 0x7a,0x00,
++ 0x7b,0xff,
++ 0x7c,0x84,
++ 0x80,0x00,
++ 0x81,0xff,
++ 0x82,0x00,
++ 0x83,0xff,
++ 0x84,0x84,
++ 0x88,0x00,
++ 0x89,0xff,
++ 0x8a,0x00,
++ 0x8b,0xff,
++ 0x8c,0x84,
++ };
++ const struct INITTABLE h8300sx_reg_ini[] = {
++ 0xb0,0x00,
++ 0xb1,0x00,
++ 0xb2,0x00,
++ 0xb3,0x00,
++ 0xb4,0xff,
++ 0xb5,0xff,
++ 0xb6,0xff,
++ 0xb7,0xff,
++ 0xb8,0x00,
++ 0xb9,0x00,
++ 0x80,0x00,
++ 0x81,0xff,
++ 0x82,0x00,
++ 0x83,0xff,
++ 0x84,0x84,
++ 0x88,0x00,
++ 0x89,0xff,
++ 0x8a,0x00,
++ 0x8b,0xff,
++ 0x8c,0x84,
++ 0x60,0x00,
++ 0x61,0xff,
++ 0x62,0x00,
++ 0x63,0xff,
++ 0x64,0x84,
++ };
++ int c;
++ if (h8300sxmode) {
++ sci_base = h8300sx_sci_base;
++ timer8_base = h8300s_timer8_base;
++ int_table = h8300sx_int_table;
++ for(c=0;c<sizeof(h8300sx_reg_ini)/sizeof(struct INITTABLE);c++)
++ STATE_CPU(sd, 0)->eightbit[h8300sx_reg_ini[c].addr]=h8300sx_reg_ini[c].data;
++ }
++ else if (h8300smode) {
++ sci_base = h8300s_sci_base;
++ timer8_base = h8300s_timer8_base;
++ int_table = h8300s_int_table;
++ for(c=0;c<sizeof(h8300s_reg_ini)/sizeof(struct INITTABLE);c++)
++ STATE_CPU(sd, 0)->eightbit[h8300s_reg_ini[c].addr]=h8300s_reg_ini[c].data;
++ }
++ else if (h8300hmode) {
++ sci_base = h8300h_sci_base;
++ timer8_base = h8300h_timer8_base;
++ int_table = h8300h_int_table;
++ for(c=0;c<sizeof(h8300h_reg_ini)/sizeof(struct INITTABLE);c++)
++ STATE_CPU(sd, 0)->eightbit[h8300h_reg_ini[c].addr]=h8300h_reg_ini[c].data;
++ }
++ for(c = 0; c< MAX_SCI_CH; c++)
++ ssr[c] = 0x84;
++}
++
++static char *openpty(int ch)
++{
++ const char nm[]="0123456789ABCDEF";
++ static char ptyname[16];
++ int c1,c2,fd;
++ struct termios attr;
++ fd = open("/dev/ptmx",O_RDWR|O_NONBLOCK);
++ if(fd >= 0) {
++ grantpt(fd);
++ unlockpt(fd);
++ ptsname_r(fd, ptyname, sizeof(ptyname));
++ } else {
++ for(c1='a';c1<='z';c1++)
++ for(c2=0;c2<sizeof(nm)-1;c2++) {
++ sprintf(ptyname,"/dev/pty%c%c",c1,nm[c2]);
++ fd=open(ptyname,O_RDWR|O_NONBLOCK);
++ if(fd != -1)
++ break ;
++ }
++ ptyname[5]='t';
++ }
++ if (fd >= 0) {
++ sci_port[ch].fd = fd;
++ tcgetattr(fd, &attr);
++ memcpy(&sci_port[ch].old_attr, &attr, sizeof(struct termios));
++ attr.c_lflag &= ~ICANON;
++ attr.c_cc[VMIN] = 0;
++ attr.c_cc[VTIME] =0;
++ tcsetattr(fd, TCSAFLUSH, &attr);
++ return ptyname;
++ } else {
++ sci_port[ch].fd = -1;
++ return NULL;
++ }
++}
++
++void sci_open_pty(struct host_callback_struct *callback)
++{
++ int ch;
++ int max_ch;
++ char *pty;
++ for (ch = 0; ch < MAX_SCI_CH; ch++)
++ {
++ pty = openpty(ch);
++ if (pty)
++ (*callback->printf_filtered) (callback, "SCI%d = %s\n",ch ,pty);
++ }
++}
++
++void sci_open_net(struct host_callback_struct *callback, int port)
++{
++ int c;
++ int flag;
++ int socketfd;
++ sci_port_type = PORT_NET;
++ for (c = 0; c < MAX_SCI_CH; c++) {
++ memset(&sci_port[c].local, 0, sizeof(sci_port[c].local));
++ sci_port[c].local.sin_family = AF_INET;
++ sci_port[c].local.sin_addr.s_addr = htonl(INADDR_ANY);
++ sci_port[c].local.sin_port = htons(port + c);
++ sci_port[c].fd = -1;
++ socketfd = socket(AF_INET, SOCK_STREAM, 0);
++ if (socketfd >= 0)
++ {
++ bind(socketfd, (struct sockaddr *)&sci_port[c].local, sizeof(sci_port[c].local));
++ flag = fcntl(socketfd, F_GETFL, 0);
++ fcntl(socketfd, F_SETFL, flag | O_NONBLOCK);
++ listen(socketfd, 1);
++ sci_port[c].socket = socketfd;
++ (*callback->printf_filtered) (callback, "SCI%d = %d\n",c ,port+c);
++ }
++ }
++}
++
++void sci_close(void)
++{
++ int ch;
++ if (sci_port_type == PORT_NONE)
++ return;
++ for (ch = 0; ch < MAX_SCI_CH; ch++) {
++ if(sci_port[ch].fd != -1) {
++ if (sci_port_type == PORT_PTY)
++ tcsetattr(sci_port[ch].fd, TCSAFLUSH, &sci_port[ch].old_attr);
++ close(sci_port[ch].fd);
++ if (sci_port_type == PORT_NET)
++ close(sci_port[ch].socket);
++ }
++ }
++}