src/exec.c

   1 #include "casl2.h"
   2 #include "exec.h"
   3
   4 /* 実行のエラー定義 */
   5 CERR cerr_exec[] = {
   6     { 202, "SVC input - out of Input memory" },
   7     { 203, "SVC output - out of COMET II memory" },
   8     { 204, "Program Register (PR) - out of COMET II memory" },
   9     { 205, "Stack Pointer (SP) - cannot allocate stack buffer" },
  10     { 206, "Address - out of COMET II memory" },
  11     { 207, "Stack Pointer (SP) - out of COMET II memory" },
  12 };
  13
  14 bool addcerrlist_exec()
  15 {
  16     return addcerrlist(ARRAYSIZE(cerr_exec), cerr_exec);
  17 }
  18
  19 /* 実行モード: trace, logical, dump */
  20 EXECMODE execmode = {false, false, false};
  21
  22 /* 標準入力から文字データを読込（SVC 1） */
  23 void svcin()
  24 {
  25     int i;
  26     char *buffer = malloc_chk(INSIZE + 1,"svcin.buffer");
  27
  28     if(fgets(buffer, INSIZE, stdin) == NULL) {
  29         memory[cpu->gr[1]] = memory[cpu->gr[2]] = 0x0;
  30         return;
  31     }
  32     for(i = 0; i < INSIZE; i++) {
  33         if(*(buffer + i) == '\0' || *(buffer + i) == '\n') {
  34             --i;
  35             break;
  36         }
  37         if(cpu->gr[1] + i >= memsize - 1) {
  38             setcerr(202, NULL);    /* SVC input - out of Input memory */
  39             break;
  40         }
  41         memory[cpu->gr[1]+i] = *(buffer + i);
  42     }
  43     memory[cpu->gr[2]] = i + 1;
  44 }
  45
  46 /* 標準出力へ文字データを書出（SVC 2） */
  47 void svcout()
  48 {
  49     int i;
  50     WORD w;
  51
  52     for(i = 0; i < memory[cpu->gr[2]]; i++) {
  53         if(cpu->gr[1] + i >= memsize - 1) {
  54             setcerr(203, NULL);    /* SVC output - out of Comet II memory */
  55             return;
  56         }
  57         /* 「文字の組」の符号表に記載された文字と、改行（CR）／タブを表示 */
  58         /* それ以外の文字は、「.」で表す */
  59         if(((w = memory[cpu->gr[1]+i]) >= 0x20 && w <= 0x7E) || w == 0xA || w == '\t') {
  60             putchar((char)w);
  61         } else {
  62             putchar('.');
  63         }
  64     }
  65 }
  66
  67 /* ロード／論理積／論理和／排他的論理和のフラグ設定。OFは常に0 */
  68 void setfr(WORD val)
  69 {
  70     cpu->fr = 0x0;
  71     /* 第15ビットが1のとき、SFは1 */
  72     if((val & 0x8000) > 0x0) {
  73         cpu->fr += SF;
  74     }
  75     /* 演算結果が0のとき、ZFは1 */
  76     if(val == 0x0) {
  77         cpu->fr += ZF;
  78     }
  79 }
  80
  81 /* 算術加算。フラグを設定して値を返す */
  82 WORD adda(WORD val0, WORD val1)
  83 {
  84     WORD res;
  85     long temp;
  86     cpu->fr = 0x0;
  87
  88     temp = (signed short)val0 + (signed short)val1;
  89     if(temp > 32767 || temp < -32768) {
  90         cpu->fr += OF;
  91     }
  92     if(((res = (WORD)(temp & 0xFFFF)) & 0x8000) == 0x8000) {
  93         cpu->fr += SF;
  94     } else if(res == 0x0) {
  95         cpu->fr += ZF;
  96     }
  97     return res;
  98 }
  99
 100 /* 算術減算。フラグを設定して値を返す */
 101 WORD suba(WORD val0, WORD val1)
 102 {
 103     return adda(val0, (~val1 + 1));
 104 }
 105
 106 /* 論理加算。フラグを設定して値を返す */
 107 WORD addl(WORD val0, WORD val1)
 108 {
 109     long temp;
 110     WORD res;
 111     cpu->fr = 0x0;
 112
 113     if((temp = val0 + val1) < 0 || temp > 65535) {
 114         cpu->fr += OF;
 115     }
 116     if(((res = (WORD)(temp & 0xFFFF)) & 0x8000) == 0x8000) {
 117         cpu->fr += SF;
 118     } else if(res == 0x0) {
 119         cpu->fr += ZF;
 120     }
 121     return res;
 122 }
 123
 124 /* 論理減算。フラグを設定して値を返す */
 125 WORD subl(WORD val0, WORD val1)
 126 {
 127     return addl(val0, (~val1 + 1));
 128 }
 129
 130 /* 算術比較のフラグ設定。OFは常に0 */
 131 void cpa(WORD val0, WORD val1)
 132 {
 133     cpu->fr = 0x0;
 134     if((short)val0 < (short)val1) {
 135         cpu->fr = SF;
 136     } else if(val0 == val1) {
 137         cpu->fr = ZF;
 138     }
 139 }
 140
 141 /* 論理比較のフラグ設定。OFは常に0 */
 142 void cpl(WORD val0, WORD val1)
 143 {
 144     cpu->fr = 0x0;
 145     if(val0 < val1) {
 146         cpu->fr = SF;
 147     } else if(val0 == val1) {
 148         cpu->fr = ZF;
 149     }
 150 }
 151
 152 /* 算術左シフト。フラグを設定して値を返す。 */
 153 /* 算術演算なので、第15ビットは送り出されない */
 154 WORD sla(WORD val0, WORD val1)
 155 {
 156     WORD sign, res, last = 0x0;
 157     int i;
 158
 159     cpu->fr = 0x0;
 160     sign = val0 & 0x8000;
 161     res = val0 & 0x7FFF;
 162     for(i = 0; i < val1; i++) {
 163         last = res & 0x4000;
 164         res <<= 1;
 165     }
 166     res = sign | (res & 0x7FFF);
 167     /* OFに、レジスタから最後に送り出されたビットの値を設定 */
 168     if(last > 0x0) {
 169         cpu->fr += OF;
 170     }
 171     /* 符号（第15ビット）が1のとき、SFは1 */
 172     if(sign > 0x0) {
 173         cpu->fr += SF;
 174     }
 175     /* 演算結果が0のとき、ZFは1 */
 176     if(res == 0x0) {
 177         cpu->fr += ZF;
 178     }
 179     return res;
 180 }
 181
 182 /* 算術右シフト。フラグを設定して値を返す */
 183 /* 算術演算なので、第15ビットは送り出されない */
 184 /* 空いたビット位置には符号と同じものが入る */
 185 WORD sra(WORD val0, WORD val1)
 186 {
 187     WORD sign, res, last = 0x0;
 188     int i;
 189
 190     cpu->fr = 0x0;
 191     sign = val0 & 0x8000;
 192     res = val0 & 0x7FFF;
 193     for(i = 0; i < val1; i++) {
 194         last = res & 0x1;
 195         res >>= 1;
 196         if(sign > 0) {
 197             res |= 0x4000;
 198         }
 199     }
 200     res = sign | res;
 201     /* OFに、レジスタから最後に送り出されたビットの値を設定 */
 202     if(last > 0x0) {
 203         cpu->fr += OF;
 204     }
 205     /* 符号（第15ビット）が1のとき、SFは1 */
 206     if(sign > 0x0) {
 207         cpu->fr += SF;
 208     }
 209     /* 演算結果が0のとき、ZFは1 */
 210     if(res == 0x0) {
 211         cpu->fr += ZF;
 212     }
 213     return res;
 214 }
 215
 216 /* 論理左シフト。フラグを設定して値を返す */
 217 WORD sll(WORD val0, WORD val1)
 218 {
 219     WORD res = val0, last = 0x0;
 220     int i;
 221
 222     cpu->fr = 0x0;
 223     for(i = 0; i < val1; i++) {
 224         last = res & 0x8000;
 225         res <<= 1;
 226     }
 227     /* OFに、レジスタから最後に送り出されたビットの値を設定 */
 228     if(last > 0x0) {
 229         cpu->fr += OF;
 230     }
 231     /* 第15ビットが1のとき、SFは1 */
 232     if((res & 0x8000) > 0x0) {
 233         cpu->fr += SF;
 234     }
 235     /* 演算結果が0のとき、ZFは1 */
 236     if(res == 0x0) {
 237         cpu->fr += ZF;
 238     }
 239     return res;
 240 }
 241
 242 /* 論理右シフト。フラグを設定して値を返す */
 243 WORD srl(WORD val0, WORD val1)
 244 {
 245     WORD res = val0, last = 0x0;
 246     int i;
 247
 248     cpu->fr = 0x0;
 249     for(i = 0; i < val1; i++) {
 250         last = res & 0x0001;
 251         res >>= 1;
 252     }
 253     /* OFに、レジスタから最後に送り出されたビットの値を設定 */
 254     if(last > 0x0) {
 255         cpu->fr += OF;
 256     }
 257     /* 第15ビットが1のとき、SFは1 */
 258     if((res & 0x8000) > 0x0) {
 259         cpu->fr += SF;
 260     }
 261     /* 演算結果が0のとき、ZFは1 */
 262     if(res == 0x0) {
 263         cpu->fr += ZF;
 264     }
 265     return res;
 266 }
 267
 268 /* 仮想マシンCOMET IIでの実行 */
 269 bool exec()
 270 {
 271     WORD op, r_r1, x_r2, val;
 272     CMDTYPE cmdtype;
 273     char *errpr = malloc_chk(CERRSTRSIZE + 1, "exec.errpr");
 274     clock_t clock_begin, clock_end;
 275
 276     addcerrlist_exec();
 277     if(execmode.trace == true) {
 278         fprintf(stdout, "\nExecuting machine codes\n");
 279     }
 280     /* フラグレジスタの初期値設定 */
 281     cpu->fr = 0x0;
 282     cpu->sp = memsize;
 283     cpu->pr = progprop->start;
 284     /* 機械語の実行 */
 285     for (; ; ) {
 286         clock_begin = clock();
 287         /* プログラムレジスタのアドレスが主記憶の範囲外の場合はエラー */
 288         if(cpu->pr >= memsize) {
 289             sprintf(errpr, "PR:#%04X", cpu->pr);
 290             setcerr(204, errpr);    /* Program Register (PR) - out of COMET II memory */
 291         }
 292         /* スタック領域のアドレスが主記憶の範囲外の場合はエラー */
 293         if(cpu->sp > memsize) {
 294             sprintf(errpr, "PR:#%04X", cpu->pr);
 295             setcerr(207, errpr);    /* Stack Pointer (SP) - out of COMET II memory */
 296         }
 297         /* スタック領域を確保できない場合はエラー */
 298         if(cpu->sp <= progprop->end) {
 299             sprintf(errpr, "PR:#%04X", cpu->pr);
 300             setcerr(205, errpr);    /* Stack Pointer (SP) - cannot allocate stack buffer */
 301         }
 302         /* 命令の取り出し */
 303         op = memory[cpu->pr] & 0xFF00;
 304         /* 命令の解読 */
 305         cmdtype = getcmdtype(op);
 306         r_r1 = (memory[cpu->pr] >> 4) & 0xF;
 307         x_r2 = memory[cpu->pr] & 0xF;
 308         /* エラー発生時は終了 */
 309         if(cerr->num > 0) {
 310             goto execerr;
 311         }
 312         /* traceオプション指定時、レジスタを出力 */
 313         if(execmode.trace){
 314             fprintf(stdout, "#%04X: Register::::\n", cpu->pr);
 315             dspregister();
 316         }
 317         /* dumpオプション指定時、メモリを出力 */
 318         if(execmode.dump){
 319             fprintf(stdout, "#%04X: Memory::::\n", cpu->pr);
 320             dumpmemory();
 321         }
 322         /* どちらかのオプション指定時、改行を出力 */
 323         if(execmode.dump || execmode.trace) {
 324             fprintf(stdout, "\n");
 325         }
 326         cpu->pr++;
 327         /* オペランドの取り出し */
 328         if(cmdtype == R1_R2) {
 329             assert(x_r2 < GRSIZE);
 330             val = cpu->gr[x_r2];
 331         }
 332         else if(cmdtype ==  R_ADR_X || cmdtype == R_ADR_X_ || cmdtype == ADR_X) {
 333             assert(x_r2 < GRSIZE);
 334             /* 実効アドレス（値または値が示す番地）を取得  */
 335             val = memory[cpu->pr++];
 336             /* 指標アドレスを加算  */
 337             if(x_r2 > 0x0) {
 338                 val += cpu->gr[x_r2];
 339             }
 340             /* ロード／算術論理演算命令／比較演算命令では、アドレスに格納されている内容を取得 */
 341             if(cmdtype == R_ADR_X_) {
 342                 if(val >= memsize) {
 343                     sprintf(errpr, "PR:#%04X", cpu->pr-1);
 344                     setcerr(206, errpr);    /* Address - out of COMET II memory */
 345                     goto execerr;
 346                 }
 347                 val = memory[val];
 348             }
 349         }
 350         /* 主オペランドが1〜4の場合、第2ビットを無視 */
 351         if(op >= 0x1000 && op <= 0x4FFF) {
 352             op &= 0xFB00;
 353         }
 354         /* 命令の実行 */
 355         switch(op)
 356         {
 357         case 0x0:       /* NOP */
 358             break;
 359         case 0x1000:    /* LD */
 360             setfr(cpu->gr[r_r1] = val);
 361             break;
 362         case 0x1100:    /* ST */
 363             memory[val] = cpu->gr[r_r1];
 364             break;
 365         case 0x1200:    /* LAD */
 366             cpu->gr[r_r1] = val;
 367             break;
 368         case 0x2000:    /* ADDA */
 369             cpu->gr[r_r1] = adda(cpu->gr[r_r1], val);
 370             break;
 371         case 0x2100:    /* SUBA */
 372             cpu->gr[r_r1] = suba(cpu->gr[r_r1], val);
 373             break;
 374         case 0x2200:    /* ADDL */
 375             cpu->gr[r_r1] = addl(cpu->gr[r_r1], val);
 376             break;
 377         case 0x2300:    /* SUBL */
 378             cpu->gr[r_r1] = subl(cpu->gr[r_r1], val);
 379             break;
 380         case 0x3000:    /* AND */
 381             setfr(cpu->gr[r_r1] &= val);
 382             break;
 383         case 0x3100:    /* OR */
 384             setfr(cpu->gr[r_r1] |= val);
 385             break;
 386         case 0x3200:    /* XOR */
 387             setfr(cpu->gr[r_r1] ^= val);
 388             break;
 389         case 0x4000:    /* CPA */
 390             cpa(cpu->gr[r_r1], val);
 391             break;
 392         case 0x4100:    /* CPL */
 393             cpl(cpu->gr[r_r1], val);
 394             break;
 395         case 0x5000:    /* SLA */
 396             cpu->gr[r_r1] = sla(cpu->gr[r_r1], val);
 397             break;
 398         case 0x5100:    /* SRA */
 399             cpu->gr[r_r1] = sra(cpu->gr[r_r1], val);
 400             break;
 401         case 0x5200:    /* SLL */
 402             cpu->gr[r_r1] = sll(cpu->gr[r_r1], val);
 403             break;
 404         case 0x5300:    /* SRL */
 405             cpu->gr[r_r1] = srl(cpu->gr[r_r1], val);
 406             break;
 407         case 0x6100:    /* JMI */
 408             if((cpu->fr & SF) > 0) {
 409                 cpu->pr = val;
 410             }
 411             break;
 412         case 0x6200:    /* JNZ */
 413             if((cpu->fr & ZF) == 0) {
 414                 cpu->pr = val;
 415             }
 416             break;
 417         case 0x6300:    /* JZE */
 418             if((cpu->fr & ZF) > 0) {
 419                 cpu->pr = val;
 420             }
 421             break;
 422         case 0x6400:    /* JUMP */
 423             cpu->pr = val;
 424             break;
 425         case 0x6500:    /* JPL */
 426             if((cpu->fr & (SF | ZF)) == 0) {
 427                 cpu->pr = val;
 428             }
 429             break;
 430         case 0x6600:    /* JOV */
 431             if((cpu->fr & OF) > 0) {
 432                 cpu->pr = val;
 433             }
 434             break;
 435         case 0x7000:    /* PUSH */
 436             assert(cpu->sp > progprop->end && cpu->sp <= memsize);
 437             memory[--cpu->sp] = val;
 438             break;
 439         case 0x7100:    /* POP */
 440             assert(cpu->sp > progprop->end && cpu->sp <= memsize);
 441             cpu->gr[r_r1] = memory[cpu->sp++];
 442             break;
 443         case 0x8000:    /* CALL */
 444             assert(cpu->sp > progprop->end && cpu->sp <= memsize);
 445             memory[--(cpu->sp)] = cpu->pr;
 446             cpu->pr = val;
 447             break;
 448         case 0x8100:    /* RET */
 449             assert(cpu->sp > progprop->end && cpu->sp <= memsize);
 450             if(cpu->sp == memsize) {
 451                 return true;
 452             } else {
 453                 cpu->pr = memory[(cpu->sp)++];
 454                 break;
 455             }
 456         case 0xF000:    /* SVC */
 457             switch(val)
 458             {
 459             case 0x0: /* EXIT */
 460                 return true;
 461             case 0x1: /* IN */
 462                 svcin();
 463                 break;
 464             case 0x2: /* OUT */
 465                 svcout();
 466                 break;
 467             }
 468         default:
 469             break;
 470         }
 471         do {
 472             clock_end = clock();
 473         } while(clock_end - clock_begin < CLOCKS_PER_SEC / clocks);
 474     }
 475     return true;
 476 execerr:
 477     fprintf(stderr, "Execute error - %d: %s\n", cerr->num, cerr->msg);
 478     return false;
 479 }