1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744 |
- diff --git a/gdb/h8300-tdep.c b/gdb/h8300-tdep.c
- index 4567d19..ea4064c 100644
- --- a/gdb/h8300-tdep.c
- +++ b/gdb/h8300-tdep.c
- @@ -1249,8 +1249,8 @@ static const unsigned char *
- h8300_breakpoint_from_pc (struct gdbarch *gdbarch, CORE_ADDR *pcptr,
- int *lenptr)
- {
- - /*static unsigned char breakpoint[] = { 0x7A, 0xFF }; *//* ??? */
- - static unsigned char breakpoint[] = { 0x01, 0x80 }; /* Sleep */
- + static unsigned char breakpoint[] = { 0x7A, 0xFF }; /* ??? */
- + /*static unsigned char breakpoint[] = { 0x01, 0x80 };*/ /* Sleep */
-
- *lenptr = sizeof (breakpoint);
- return breakpoint;
- 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..00b381e 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,15 @@ 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)))
- + {
- + if (code->opcode == O (O_SLEEP, SN))
- + pc += 2;
- + exception(vector & 0xff, (vector & 0xff00) >> 8);
- + goto end;
- + }
- }
-
- switch (code->opcode)
- @@ -3274,7 +3433,7 @@ sim_resume (SIM_DESC sd, int step, int siggnal)
- goto end;
-
- if (code->src.type == X (OP_IMM, SB))
- - fetch (sd, &code->src, &ea);
- + fetch (sd, &code->src, &ea);
- else
- ea = 1;
-
- @@ -3569,16 +3728,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
- @@ -3635,49 +3798,25 @@ sim_resume (SIM_DESC sd, int step, int siggnal)
- sim_engine_set_run_state (sd, sim_stopped,
- SIM_WSTOPSIG (h8_get_reg (sd, 0)));
- }
- -#endif
- else
- {
- /* Treat it as a sigtrap. */
- sim_engine_set_run_state (sd, sim_stopped, SIGTRAP);
- }
- +#else
- + else
- + sleep(0);
- +#endif
- 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;
- + pc += 2;
- + exception(res, -1);
- goto end;
- + }
-
- case O (O_BPT, SN):
- sim_engine_set_run_state (sd, sim_stopped, SIGTRAP);
- @@ -5038,15 +5177,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 +5194,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 +5246,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);
- + }
- + }
- +}
|