jb302@28: #include <stdio.h>
jb302@28: #include <stdlib.h>
jb302@28: 
jb302@28: #define MAIN
jb302@28: #include "mem.h"
jb302@28: #include "iset.h"
jb302@28: 
jb302@28: /* fill instruction table 
jb302@28:  * MCS-51 - this needs to be stored in code memory */
jb302@34: FUNCTION_TABLE const iset = {
jb302@28:     NOP, NOP, NOP, NOP, NOP, NOP, NOP, NOP,
jb302@28:     SET, CLR, SET, CLR, SET, CLR, CPL, CPL,
jb302@28:     XCSD, SFA, LAF, MOV, MOV, MOV, MOV, MOV,
jb302@28:     MOV, MOV, MOV, MOV, MOV, MOV, MOV, MOV,
jb302@28:     MOV, MOV, MOV, MOV, MOV, MOV, MOV, MOV,
jb302@28:     MOV, MOV, MOV, MOV, MOV, MOV, MOV, MOV,
jb302@28:     MOV, MOV, MOV, MOV, MOV, MOV, MOV, MOV,
jb302@28:     MOV, MOV, MOV, MOV, MOV, MOV, MOV, MOV,
jb302@28:     MOV, MOV, MOV, MOV, MOV, MOV, MOV, MOV,
jb302@28:     MOV, MOV, MOV, MOV, MOV, MOV, MOV, MOV,
jb302@28:     MOV, MOV, MOV, MOV, MOV, MOV, MOV, MOV,
jb302@28:     MOV, MOV, MOV, MOV, MOV, MOV, MOV, MOV,
jb302@28:     MOV, MOV, MOV, MOV, MOV, MOV, MOV, MOV,
jb302@28:     MOV, MOV, MOV, MOV, MOV, MOV, MOV, MOV,
jb302@28:     MOV, MOV, MOV, MOV, MOV, MOV, MOV, MOV,
jb302@28:     MOV, MOV, MOV, MOV, MOV, MOV, MOV, MOV,
jb302@28:     ANL, ANL, ANL, ANL, ANL, ANL, ANL, ANL,
jb302@28:     ORL, ORL, ORL, ORL, ORL, ORL, ORL, ORL,
jb302@28:     XRL, XRL, XRL, XRL, XRL, XRL, XRL, XRL,
jb302@28:     RL, RLC, RR, RRC, INC, DEC, INC, DEC,
jb302@28:     ADD, ADD, ADD, ADD, ADD, ADD, ADD, ADD,
jb302@28:     ADDC, ADDC, ADDC, ADDC, ADDC, ADDC, ADDC, ADDC,
jb302@28:     SUB, SUB, SUB, SUB, SUB, SUB, SUB, SUB,
jb302@28:     SUBB, SUBB, SUBB, SUBB, SUBB, SUBB, SUBB, SUBB,
jb302@28:     PJMP, PJMP, PJMP, PJMP, PJMP, PJMP, PJMP, PJMP,
jb302@28:     PCALL, PCALL, PCALL, PCALL, PCALL, PCALL, PCALL, PCALL,
jb302@28:     DJNZ, DJNZ, DJNZ, DJNZ, CJNE, CJNE, CJNE, CJNE,
jb302@28:     LJMP, LCALL, RET, RETI, SJMP, JMP, JMP, CJNE,
jb302@28:     JZ, JNZ, JC, JNC, JPO, JPE, JS, JNS,
jb302@28:     PUSH, PUSH, PUSH, PUSH, PUSH, PUSH, PUSH, PUSH,
jb302@28:     POP, POP, POP, POP, POP, POP, POP, POP,
jb302@28:     MUL, DIV, DA, NOP, IN, OUT, INT, HLT
jb302@28: };
jb302@28: 
jb302@34: BYTE pause;     /* becomes 1 when we hit a break point in run mode */
jb302@29: BYTE free_run;  /* free run if not 0 */
jb302@34: BYTE pause;     /* pause flag */
jb302@29: WIDE ac;        /* address counter */
jb302@29: BYTE args[4];   /* dbg args */
jb302@28: 
jb302@34: WIDE bp[8] = {  0xFFFF,
jb302@34:                 0xFFFF,
jb302@34:                 0xFFFF,
jb302@34:                 0xFFFF,
jb302@34:                 0xFFFF,
jb302@34:                 0xFFFF,
jb302@34:                 0xFFFF,
jb302@34:                 0xFFFF
jb302@34: };
jb302@34: 
jb302@28: /* don't need the file on the MCS-51 version */
jb302@28: FILE *fp;
jb302@28: void
jb302@28: snd(BYTE c) {
jb302@28:     /* putchar(c); */
jb302@28:     fp = fopen("out", "a");
jb302@28:     fputc(c, fp);
jb302@28:     fclose(fp);
jb302@28: }
jb302@28: 
jb302@28: BYTE
jb302@28: rcv(void) {
jb302@28:     return getchar();
jb302@28: }
jb302@28: 
jb302@28: void
jb302@28: step(void) {
jb302@28:     IR = fetch();
jb302@34:     iset.ops[IR]();
jb302@28: }
jb302@28: 
jb302@34: void
jb302@34: run(void) {
jb302@34:     while (pause != 1) {
jb302@34:         step();
jb302@34:         for (ac = 0; ac < 8; ac++) {
jb302@34:             if (bp[ac] == get_wide(PC)) {
jb302@34:                 pause = 1;
jb302@34:             }
jb302@34:         }
jb302@34:     }
jb302@34: }
jb302@34: 
jb302@34: void controller() {
jb302@29:     if (free_run == 0) {
jb302@34:             switch (rcv()) {
jb302@28: 
jb302@34:                 /* step */
jb302@34:                 case 0x00:
jb302@34:                     step();
jb302@34:                     break;
jb302@28: 
jb302@34:                 /* run for length steps*/
jb302@34:                 case 0x01:
jb302@34:                     run();
jb302@34:                     break;
jb302@28: 
jb302@34:                 /* set reg */
jb302@34:                 case 0x02:
jb302@34:                     args[0] = rcv(); /* reg */
jb302@34:                     args[1] = rcv(); /* val */
jb302@34:                     regs[args[0]] = args[1];
jb302@34:                     break;
jb302@28: 
jb302@34:                 /* get reg */
jb302@34:                 case 0x03:
jb302@34:                     args[0] = rcv(); /* reg */
jb302@34:                     snd(regs[args[0]]);
jb302@34:                     break;
jb302@28: 
jb302@34:                 /* set flag */
jb302@34:                 case 0x04:
jb302@34:                     args[0] = rcv(); /* flag */
jb302@34:                     args[1] = rcv(); /* on? */
jb302@34:                     set_flag(args[0], args[1]);
jb302@34:                     break;
jb302@34:         
jb302@34:                 /* get flag */
jb302@34:                 case 0x05:
jb302@34:                     args[0] = rcv(); /* flag */
jb302@34:                     snd(get_flag(args[0]));
jb302@34:                     break;
jb302@28: 
jb302@34:                 /* write mem block */
jb302@34:                 case 0x06:
jb302@34:                     args[0] = rcv(); /* addr high */
jb302@34:                     args[1] = rcv(); /* addr low */
jb302@34:                     args[2] = rcv(); /* length high */
jb302@34:                     args[3] = rcv(); /* length low */
jb302@34:                     tmpw = MWIDE(args[0], args[1]);         
jb302@34:                     for (ac = tmpw; ac < tmpw + MWIDE(args[2], args[3]); ac++) { 
jb302@34:                         if (ac >= 0xFFFF) {
jb302@34:                             break;
jb302@34:                         }
jb302@34:                         mem[ac] = rcv();
jb302@34:                     }
jb302@34:                     break;
jb302@34: 
jb302@34:                 /* read mem block */
jb302@34:                 case 0x07:
jb302@34:                     args[0] = rcv(); /* addr high */
jb302@34:                     args[1] = rcv(); /* addr low */
jb302@34:                     args[2] = rcv(); /* length high */
jb302@34:                     args[3] = rcv(); /* length low */
jb302@34:                     tmpw = MWIDE(args[0], args[1]);         
jb302@34:                     for (ac = tmpw; ac < tmpw + MWIDE(args[2], args[3]); ac++) { 
jb302@34:                         if (ac >= 0xFFFF) {
jb302@34:                             break;
jb302@34:                         }
jb302@34:                         snd(mem[ac]);
jb302@34:                     }
jb302@34:                     break;
jb302@34: 
jb302@34:                 /* get A */
jb302@37:                 case 0x08:
jb302@34:                     snd(A);
jb302@34:                     break;
jb302@34:                 
jb302@34:                 /* get flags */
jb302@37:                 case 0x09:
jb302@34:                     snd(flags);
jb302@34:                     break;
jb302@34:                 
jb302@34:                 /* get instruction register */
jb302@37:                 case 0x0A:
jb302@34:                     snd(IR);
jb302@34:                     break;
jb302@34:                 
jb302@37:                 /* run for length */
jb302@37:                 case 0x0B:
jb302@34:                     args[0] = rcv(); /* length high */
jb302@34:                     args[1] = rcv(); /* length low */
jb302@39:                     for (tmpw = 0 ; tmpw < MWIDE(args[0], args[1]) ; tmpw++) {
jb302@34:                         step();
jb302@34:                     }
jb302@34:                     break;
jb302@34: 
jb302@37:                 case 0x0C:
jb302@34:                     free_run = 1;
jb302@34:                     break;
jb302@34:                 
jb302@34:                 /* set break point */
jb302@37:                 case 0x0D:
jb302@34:                     args[0] = rcv(); /* bp index */
jb302@34:                     args[1] = rcv(); /* address high */
jb302@34:                     args[2] = rcv(); /* address low */
jb302@34:                     if (args[0] > 7) {
jb302@28:                         break;
jb302@28:                     }
jb302@34:                     bp[args[0]] = MWIDE(args[1], args[2]);
jb302@34:                     break;
jb302@34:                 
jb302@34:                 /* test cmd */
jb302@34:                 case 0x54:
jb302@34:                     snd('A');
jb302@34:                     break;
jb302@34:            }
jb302@34:         }
jb302@34:     else {
jb302@34:         step();
jb302@28:     }
jb302@28: }
jb302@28: 
jb302@28: void 
jb302@28: main(void) {
jb302@29:     /* dont go into free run on restart */
jb302@29:     free_run = 0;
jb302@29:     for (;;) {
jb302@34:         controller();
jb302@28:     }
jb302@28: }
jb302@28: