src/exec.c

   1 #include "exec.h"
   2
   3 /**
   4  * @brief プログラムレジスタ（PR）を表すWORD値を文字列に変換
   5  *
   6  * @return 文字列「PR:XXXX」（Xは16進数の数字）
   7  *
   8  * @param pr プログラムレジスタ（PR）を表すWORD値
   9  */
  10 char *pr2str(WORD pr);
  11
  12 /**
  13  * @brief 標準入力から文字データを読込（SVC 1）
  14  *
  15  * @return なし
  16  */
  17 void svcin();
  18
  19 /**
  20  * @brief 標準出力へ文字データを書出（SVC 2）
  21  *
  22  * @return なし
  23  */
  24 void svcout();
  25
  26 /**
  27  * @brief ロード／論理積／論理和／排他的論理和のフラグ設定。OFは常に0
  28  *
  29  * @return なし
  30  *
  31  * @param adr アドレス
  32  */
  33 void setfr(WORD adr);
  34
  35 /**
  36  * @brief WORD値からr/r1を取得
  37  *
  38  * @return r/r1を表すWORD値
  39  *
  40  * @param oprx オペランドを表すWORD値
  41  */
  42 WORD get_r_r1(WORD oprx);
  43
  44 /**
  45  * @brief WORD値からx/r2を取得
  46  *
  47  * @return x/r2を表すWORD値
  48  *
  49  * @param oprx オペランドを表すWORD値
  50  */
  51 WORD get_x_r2(WORD oprx);
  52
  53 /**
  54  * @brief 2つのWORD値からadr[,x]を取得
  55  *
  56  * @return adr[,x]を表すWORD値
  57  *
  58  * @param adr アドレスを表すWORD値
  59  * @param oprx オペランドを表すWORD値
  60  */
  61 WORD get_adr_x(WORD adr, WORD oprx);
  62
  63 /**
  64  * @brief 2つのWORD値からadr[,x]のアドレスに格納されている値を取得
  65  *
  66  * @return adr[,x]のアドレスに格納されている値を表すWORD値
  67  *
  68  * @param adr アドレスを表すWORD値
  69  * @param oprx オペランドを表すWORD値
  70  */
  71 WORD get_val_adr_x(WORD adr, WORD oprx);
  72
  73 /**
  74  * @brief 実行エラーの定義
  75  */
  76 static CERR cerr_exec[] = {
  77     { 201, "Program Register (PR) - memory overflow" },
  78     { 202, "Stack Pointer (SP) - stack overflow" },
  79     { 203, "Stack Pointer (SP) - stack underflow" },
  80     { 204, "OP in word #1 - not command code" },
  81     { 205, "r/r1 in word #1 - not GR" },
  82     { 206, "x/r2 in word #1 - not GR" },
  83     { 207, "address in word #2 - out of memory" },
  84     { 208, "SVC input - memory overflow" },
  85     { 209, "SVC output - memory overflow" },
  86 };
  87
  88 /**
  89  * @brief 実行モード: trace, logical, dump, dump_start, dump_end,  monitor, step
  90  */
  91 EXECMODE execmode = {false, false, false, 0, 0xFFFF, false, false};
  92
  93 char *pr2str(WORD pr)
  94 {
  95     char *str = malloc_chk(CERRSTRSIZE + 1, "pr2str.pr");
  96
  97     sprintf(str, "PR:#%04X", pr);
  98     return str;
  99 }
 100
 101 void svcin()
 102 {
 103     int i;
 104     char *buf = malloc_chk(INSIZE + 1, "svcin.buf");
 105
 106     if(fgets(buf, INSIZE, stdin) == NULL) {
 107         sys->memory[sys->cpu->gr[1]] = sys->memory[sys->cpu->gr[2]] = 0x0;
 108         return;
 109     }
 110     for(i = 0; i < INSIZE; i++) {
 111         if(!buf[i] || buf[i] == '\n') {
 112             --i;
 113             break;
 114         }
 115         if(sys->cpu->gr[1] + i > execptr->end) {
 116             setcerr(208, "");    /* SVC input - memory overflow */
 117             break;
 118         }
 119         sys->memory[sys->cpu->gr[1] + i] = buf[i];
 120     }
 121     sys->memory[sys->cpu->gr[2]] = i + 1;
 122     FREE(buf);
 123 }
 124
 125 void svcout()
 126 {
 127     int i;
 128     WORD w;
 129
 130     for(i = 0; i < sys->memory[sys->cpu->gr[2]]; i++) {
 131         if(sys->cpu->gr[1] + i > execptr->end) {
 132             setcerr(209, "");    /* SVC output - memory overflow */
 133             return;
 134         }
 135         /* 「JIS X 0201ラテン文字・片仮名用8ビット符号で規定する文字の符号表」
 136            に記載された文字と、改行（CR）／タブを表示 */
 137         /* それ以外の文字は、「.」で表す */
 138         if(((w = sys->memory[sys->cpu->gr[1]+i]) >= 0x20 && w <= 0x7E) ||    /* JIS X 0201ラテン文字 */
 139            (w >= 0xA0 && w <= 0xFE) ||                                       /* JIS X 0201片仮名用8ビット符号 */
 140            w == 0xA || w == '\t')
 141         {
 142             putchar((char)w);
 143         } else {
 144             putchar('.');
 145         }
 146     }
 147 }
 148
 149 void setfr(WORD adr)
 150 {
 151     sys->cpu->fr = 0x0;
 152     /* 第15ビットが1のとき、SFは1 */
 153     if((adr & 0x8000) == 0x8000) {
 154         sys->cpu->fr += SF;
 155     }
 156     /* 演算結果が0のとき、ZFは1 */
 157     if(adr == 0x0) {
 158         sys->cpu->fr += ZF;
 159     }
 160 }
 161
 162 WORD get_r_r1(WORD oprx)
 163 {
 164     WORD r = 0;
 165     char *s = NULL;
 166
 167     if((r = ((oprx & 0x00F0) >>4)) > GRSIZE - 1) {
 168         setcerr(205, s = pr2str(sys->cpu->pr));    /* r/r1 in word #1 - not GR */
 169         FREE(s);
 170         return 0x0;
 171     }
 172     return r;
 173 }
 174
 175 WORD get_x_r2(WORD oprx)
 176 {
 177     WORD x = 0;
 178     char *s = NULL;
 179
 180     if((x = (oprx & 0x000F)) > GRSIZE - 1) {
 181         setcerr(206, s = pr2str(sys->cpu->pr));    /* r/r1 in word #1 - not GR */
 182         FREE(s);
 183         return 0x0;
 184     }
 185     return x;
 186 }
 187
 188 WORD get_adr_x(WORD adr, WORD oprx)
 189 {
 190     WORD a = adr;
 191     WORD x = get_x_r2(oprx);
 192
 193     if(x > 0) {
 194         a += sys->cpu->gr[x];
 195     }
 196     return a;
 197 }
 198
 199 WORD get_val_adr_x(WORD adr, WORD oprx)
 200 {
 201     WORD a = 0;
 202     char *s = NULL;
 203
 204     if((a = get_adr_x(adr, oprx)) >= sys->memsize) {
 205         setcerr(207, s = pr2str(sys->cpu->pr + 1));    /* address in word #2 - out of memory */
 206         FREE(s);
 207         return 0x0;
 208     }
 209     return sys->memory[a];
 210 }
 211
 212 /* exec.hで定義された関数群 */
 213 void addcerrlist_exec()
 214 {
 215     addcerrlist(ARRAYSIZE(cerr_exec), cerr_exec);
 216 }
 217
 218 void nop()
 219 {
 220     sys->cpu->pr += 1;
 221 }
 222
 223 void ld_r_adr_x()
 224 {
 225     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 226     setfr(sys->cpu->gr[get_r_r1(w[0])] = get_val_adr_x(w[1], w[0]));
 227     sys->cpu->pr += 2;
 228 }
 229
 230 void ld_r1_r2()
 231 {
 232     WORD w[] = {sys->memory[sys->cpu->pr]};
 233     setfr(sys->cpu->gr[get_r_r1(w[0])] = sys->cpu->gr[get_x_r2(w[0])]);
 234     sys->cpu->pr += 1;
 235 }
 236
 237 void st()
 238 {
 239     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 240     sys->memory[get_adr_x(w[1], w[0])] = sys->cpu->gr[get_r_r1(w[0])];
 241     sys->cpu->pr += 2;
 242 }
 243
 244 void lad()
 245 {
 246     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 247     sys->cpu->gr[get_r_r1(w[0])] = get_adr_x(w[1], w[0]);
 248     sys->cpu->pr += 2;
 249 }
 250
 251 void adda(WORD r, WORD val)
 252 {
 253     long tmp;
 254
 255     sys->cpu->fr = 0x0;
 256     /* 引数の値を16ビット符号付整数として加算し、オーバーフローをチェック */
 257     assert(sizeof(short) * 8 == 16 && (short)0xFFFF == -1);
 258     if((tmp = (short)(sys->cpu->gr[r]) + (short)val) > 32767 || tmp < -32768) {
 259         sys->cpu->fr += OF;
 260     }
 261     /* 加算した結果を、WORD値に戻す */
 262     sys->cpu->gr[r] = (WORD)(tmp & 0xFFFF);
 263     if((sys->cpu->gr[r] & 0x8000) == 0x8000) {
 264         sys->cpu->fr += SF;
 265     } else if(sys->cpu->gr[r] == 0x0) {
 266         sys->cpu->fr += ZF;
 267     }
 268 }
 269
 270 void adda_r_adr_x()
 271 {
 272     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 273     adda(get_r_r1(w[0]), get_val_adr_x(w[1], w[0]));
 274     sys->cpu->pr += 2;
 275 }
 276
 277 void adda_r1_r2()
 278 {
 279     WORD w[] = {sys->memory[sys->cpu->pr]};
 280     adda(get_r_r1(w[0]), sys->cpu->gr[get_x_r2(w[0])]);
 281     sys->cpu->pr += 1;
 282 }
 283
 284 void suba_r_adr_x()
 285 {
 286     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 287     adda(get_r_r1(w[0]), ~(get_val_adr_x(w[1], w[0])) + 1);
 288     sys->cpu->pr += 2;
 289 }
 290
 291 void suba_r1_r2()
 292 {
 293     WORD w[] = {sys->memory[sys->cpu->pr]};
 294     adda(get_r_r1(w[0]), ~(sys->cpu->gr[get_x_r2(w[0])]) + 1);
 295     sys->cpu->pr += 1;
 296 }
 297
 298 void addl_gr(WORD r, WORD val, bool add)
 299 {
 300     unsigned long o, s;
 301
 302     o = sys->cpu->gr[r];
 303     sys->cpu->fr = 0x0;    /* flag initialize */
 304
 305     if(add == true) {
 306         s = o + val;
 307         if(s > 0xFFFF) {
 308             sys->cpu->fr += OF;
 309         }
 310     } else {
 311         if(o < val) {
 312             sys->cpu->fr += OF;
 313         }
 314         s = o + (~val + 1);
 315         if(s > 0xFFFF) {
 316             s &= 0xFFFF;
 317         }
 318     }
 319     sys->cpu->gr[r] = (WORD)s;
 320
 321     if((s & 0x8000) == 0x8000) {
 322         sys->cpu->fr += SF;
 323     }
 324     else if(s == 0x0) {
 325         sys->cpu->fr += ZF;
 326     }
 327 }
 328
 329 void addl_r_adr_x()
 330 {
 331     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 332     addl_gr(get_r_r1(w[0]), get_val_adr_x(w[1], w[0]), true);
 333     sys->cpu->pr += 2;
 334 }
 335
 336 void addl_r1_r2()
 337 {
 338     WORD w[] = {sys->memory[sys->cpu->pr]};
 339     addl_gr(get_r_r1(w[0]), sys->cpu->gr[get_x_r2(w[0])], true);
 340     sys->cpu->pr += 1;
 341 }
 342
 343 void subl_r_adr_x()
 344 {
 345     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 346     addl_gr(get_r_r1(w[0]), get_val_adr_x(w[1], w[0]), false);
 347     sys->cpu->pr += 2;
 348 }
 349
 350 void subl_r1_r2()
 351 {
 352     WORD w[] = {sys->memory[sys->cpu->pr]};
 353     addl_gr(get_r_r1(w[0]), sys->cpu->gr[get_x_r2(w[0])], false);
 354     sys->cpu->pr += 1;
 355 }
 356
 357 void and_r_adr_x()
 358 {
 359     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 360     setfr(sys->cpu->gr[get_r_r1(w[0])] &= get_val_adr_x(w[1], w[0]));
 361     sys->cpu->pr += 2;
 362 }
 363
 364 void and_r1_r2()
 365 {
 366     WORD w[] = {sys->memory[sys->cpu->pr]};
 367     setfr(sys->cpu->gr[get_r_r1(w[0])] &= sys->cpu->gr[get_x_r2(w[0])]);
 368     sys->cpu->pr += 1;
 369 }
 370
 371 void or_r_adr_x()
 372 {
 373     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 374     setfr(sys->cpu->gr[get_r_r1(w[0])] |= get_val_adr_x(w[1], w[0]));
 375     sys->cpu->pr += 2;
 376 }
 377
 378 void or_r1_r2()
 379 {
 380     WORD w[] = {sys->memory[sys->cpu->pr]};
 381     setfr(sys->cpu->gr[get_r_r1(w[0])] |= sys->cpu->gr[get_x_r2(w[0])]);
 382     sys->cpu->pr += 1;
 383 }
 384
 385 void xor_r_adr_x()
 386 {
 387     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 388     setfr(sys->cpu->gr[get_r_r1(w[0])] ^= get_val_adr_x(w[1], w[0]));
 389     sys->cpu->pr += 2;
 390 }
 391
 392 void xor_r1_r2()
 393 {
 394     WORD w[] = {sys->memory[sys->cpu->pr]};
 395     setfr(sys->cpu->gr[get_r_r1(w[0])] ^= sys->cpu->gr[get_x_r2(w[0])]);
 396     sys->cpu->pr += 1;
 397 }
 398
 399 void cpa(WORD r, WORD val)
 400 {
 401     sys->cpu->fr = 0;
 402     if((short)sys->cpu->gr[r] < (short)val) {
 403         sys->cpu->fr = SF;
 404     } else if(sys->cpu->gr[r] == val) {
 405         sys->cpu->fr = ZF;
 406     }
 407 }
 408
 409 void cpa_r_adr_x()
 410 {
 411     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 412     cpa(get_r_r1(w[0]), get_val_adr_x(w[1], w[0]));
 413     sys->cpu->pr += 2;
 414 }
 415
 416 void cpa_r1_r2()
 417 {
 418     WORD w[] = {sys->memory[sys->cpu->pr]};
 419     cpa(get_r_r1(w[0]), sys->cpu->gr[get_x_r2(w[0])]);
 420     sys->cpu->pr += 1;
 421 }
 422
 423 void cpl(WORD r, WORD val)
 424 {
 425     sys->cpu->fr = 0x0;
 426     if(sys->cpu->gr[r] < val) {
 427         sys->cpu->fr = SF;
 428     } else if(sys->cpu->gr[r] == val) {
 429         sys->cpu->fr = ZF;
 430     }
 431 }
 432
 433 void cpl_r_adr_x()
 434 {
 435     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 436     cpl(get_r_r1(w[0]), get_val_adr_x(w[1], w[0]));
 437     sys->cpu->pr += 2;
 438 }
 439
 440 void cpl_r1_r2()
 441 {
 442     WORD w[] = {sys->memory[sys->cpu->pr]};
 443     cpl(get_r_r1(w[0]), sys->cpu->gr[get_x_r2(w[0])]);
 444     sys->cpu->pr += 1;
 445 }
 446
 447 void sla()
 448 {
 449     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 450     WORD r = get_r_r1(w[0]);
 451     WORD sign = sys->cpu->gr[r] & 0x8000;
 452     WORD last = 0;
 453
 454     sys->cpu->fr = 0;
 455     sys->cpu->gr[r] &= 0x7FFF;
 456     for(int i = 0; i < get_adr_x(w[1], w[0]); i++) {
 457         last = sys->cpu->gr[r] & 0x4000;
 458         sys->cpu->gr[r] <<= 1;
 459     }
 460     sys->cpu->gr[r] = sign | (sys->cpu->gr[r] & 0x7FFF);
 461     /* OFに、レジスタから最後に送り出されたビットの値を設定 */
 462     if(last > 0x0) {
 463         sys->cpu->fr += OF;
 464     }
 465     /* 符号（第15ビット）が1のとき、SFは1 */
 466     if(sign > 0x0) {
 467         sys->cpu->fr += SF;
 468     }
 469     /* 演算結果が0のとき、ZFは1 */
 470     if(sys->cpu->gr[r] == 0x0) {
 471         sys->cpu->fr += ZF;
 472     }
 473     sys->cpu->pr += 2;
 474 }
 475
 476 void sra()
 477 {
 478     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 479     WORD r = get_r_r1(w[0]);
 480     WORD sign = sys->cpu->gr[r] & 0x8000;
 481     WORD last = 0;
 482
 483     sys->cpu->fr = 0;
 484     sys->cpu->gr[r] &= 0x7FFF;
 485     for(int i = 0; i < get_adr_x(w[1], w[0]); i++) {
 486         last = sys->cpu->gr[r] & 0x1;
 487         sys->cpu->gr[r] >>= 1;
 488         if(sign > 0) {
 489             sys->cpu->gr[r] |= 0x4000;
 490         }
 491     }
 492     sys->cpu->gr[r] = sign | sys->cpu->gr[r];
 493     /* OFに、レジスタから最後に送り出されたビットの値を設定 */
 494     if(last > 0x0) {
 495         sys->cpu->fr += OF;
 496     }
 497     /* 符号（第15ビット）が1のとき、SFは1 */
 498     if(sign > 0x0) {
 499         sys->cpu->fr += SF;
 500     }
 501     /* 演算結果が0のとき、ZFは1 */
 502     if(sys->cpu->gr[r] == 0x0) {
 503         sys->cpu->fr += ZF;
 504     }
 505     sys->cpu->pr += 2;
 506 }
 507
 508 void sll()
 509 {
 510     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 511     WORD last = 0;
 512     WORD r = get_r_r1(w[0]);
 513
 514     sys->cpu->fr = 0x0;
 515     for(int i = 0; i < get_adr_x(w[1], w[0]); i++) {
 516         last = sys->cpu->gr[r] & 0x8000;
 517         sys->cpu->gr[r] <<= 1;
 518     }
 519     /* OFに、レジスタから最後に送り出されたビットの値を設定 */
 520     if(last > 0x0) {
 521         sys->cpu->fr += OF;
 522     }
 523     /* 第15ビットが1のとき、SFは1 */
 524     if((sys->cpu->gr[r] & 0x8000) > 0x0) {
 525         sys->cpu->fr += SF;
 526     }
 527     /* 演算結果が0のとき、ZFは1 */
 528     if(sys->cpu->gr[r] == 0x0) {
 529         sys->cpu->fr += ZF;
 530     }
 531     sys->cpu->pr += 2;
 532 }
 533
 534 void srl()
 535 {
 536     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 537     WORD last = 0;
 538     WORD r = get_r_r1(w[0]);
 539
 540     sys->cpu->fr = 0x0;
 541     for(int i = 0; i < get_adr_x(w[1], w[0]); i++) {
 542         last = sys->cpu->gr[r] & 0x0001;
 543         sys->cpu->gr[r] >>= 1;
 544     }
 545     /* OFに、レジスタから最後に送り出されたビットの値を設定 */
 546     if(last > 0x0) {
 547         sys->cpu->fr += OF;
 548     }
 549     /* 第15ビットが1のとき、SFは1 */
 550     if((sys->cpu->gr[r] & 0x8000) > 0x0) {
 551         sys->cpu->fr += SF;
 552     }
 553     /* 演算結果が0のとき、ZFは1 */
 554     if(sys->cpu->gr[r] == 0x0) {
 555         sys->cpu->fr += ZF;
 556     }
 557     sys->cpu->pr += 2;
 558 }
 559
 560 void jpl()
 561 {
 562     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 563     if((sys->cpu->fr & (SF | ZF)) == 0) {
 564         sys->cpu->pr = get_adr_x(w[1], w[0]);
 565     } else {
 566         sys->cpu->pr += 2;
 567     }
 568 }
 569
 570 void jmi()
 571 {
 572     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 573     if((sys->cpu->fr & SF) > 0) {
 574         sys->cpu->pr = get_adr_x(w[1], w[0]);
 575     } else {
 576         sys->cpu->pr += 2;
 577     }
 578 }
 579
 580 void jnz()
 581 {
 582     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 583     if((sys->cpu->fr & ZF) == 0) {
 584         sys->cpu->pr = get_adr_x(w[1], w[0]);
 585     } else {
 586         sys->cpu->pr += 2;
 587     }
 588 }
 589
 590 void jze()
 591 {
 592     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 593     if((sys->cpu->fr & ZF) > 0) {
 594         sys->cpu->pr = get_adr_x(w[1], w[0]);
 595     } else {
 596         sys->cpu->pr += 2;
 597     }
 598 }
 599
 600 void jov()
 601 {
 602     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 603     if((sys->cpu->fr & OF) > 0) {
 604         sys->cpu->pr = get_adr_x(w[1], w[0]);
 605     } else {
 606         sys->cpu->pr += 2;
 607     }
 608 }
 609
 610 void jump()
 611 {
 612     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 613     sys->cpu->pr = get_adr_x(w[1], w[0]);
 614 }
 615
 616 void push()
 617 {
 618     assert(sys->cpu->sp > execptr->end && sys->cpu->sp <= sys->memsize);
 619     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 620     sys->memory[--(sys->cpu->sp)] = get_adr_x(w[1], w[0]);
 621     sys->cpu->pr += 2;
 622 }
 623
 624 void pop()
 625 {
 626     assert(sys->cpu->sp > execptr->end);
 627     WORD w[] = {sys->memory[sys->cpu->pr]};
 628     char *s = NULL;
 629
 630     if(sys->cpu->sp >= sys->memsize) {
 631         setcerr(203, s = pr2str(sys->cpu->pr));        /* Stack Pointer (SP) - stack underflow */
 632         FREE(s);
 633     } else {
 634         sys->cpu->gr[get_r_r1(w[0])] = sys->memory[(sys->cpu->sp)++];
 635         sys->cpu->pr += 1;
 636     }
 637 }
 638
 639 void call()
 640 {
 641     assert(sys->cpu->sp > execptr->end && sys->cpu->sp <= sys->memsize);
 642     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 643     sys->memory[--(sys->cpu->sp)] = sys->cpu->pr + 1;
 644     sys->cpu->pr = get_adr_x(w[1], w[0]);
 645 }
 646
 647 void ret()
 648 {
 649     assert(sys->cpu->sp <= sys->memsize);
 650     if(sys->cpu->sp == sys->memsize) {
 651         execptr->stop = true;
 652     } else if(sys->cpu->sp < sys->memsize) {
 653         sys->cpu->pr = sys->memory[(sys->cpu->sp)++] + 1;
 654     }
 655 }
 656
 657 void svc()
 658 {
 659     WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]};
 660     switch(get_adr_x(w[1], w[0]))
 661     {
 662     case 0x0:                   /* STOP */
 663         execptr->stop = true;
 664         break;
 665     case 0x1:                   /* IN */
 666         svcin();
 667         break;
 668     case 0x2:                   /* OUT */
 669         svcout();
 670         break;
 671     }
 672     sys->cpu->pr += 2;
 673 }
 674
 675 void exec()
 676 {
 677     clock_t clock_begin = 0;
 678     clock_t clock_end = 0;
 679     void (*cmdptr)() = NULL;
 680     char *s = NULL;
 681     const char *monmsg = "COMET II machine code monitor. Type ? for help.\n";
 682
 683     create_cmdtable(HASH_CODE);                 /* 命令のコードとタイプがキーのハッシュ表を作成 */
 684
 685     if(execmode.trace == true) {
 686         fprintf(stdout, "\nExecuting machine codes\n");
 687     }
 688     /* 機械語の実行 */
 689     for (sys->cpu->pr = execptr->start; ; ) {
 690         clock_begin = clock();                     /* クロック周波数設定のため、実行開始時間を格納 */
 691         if(execmode.dump || execmode.trace) {      /* traceまたはdumpオプション指定時、改行を出力 */
 692             if(execmode.trace) {                   /* traceオプション指定時、レジスタを出力 */
 693                 fprintf(stdout, "#%04X: Register::::\n", sys->cpu->pr);
 694                 dspregister();
 695             }
 696             if(execmode.dump) {                    /* dumpオプション指定時、メモリを出力 */
 697                 fprintf(stdout, "#%04X: Memory::::\n", sys->cpu->pr);
 698                 dumpmemory(execmode.dump_start, execmode.dump_end);
 699             }
 700             fprintf(stdout, "\n");
 701         }
 702         /* ステップモードまたはブレークポイントの場合、モニターを起動 */
 703         if(
 704             (execmode.monitor == true && sys->cpu->pr == execptr->start) ||
 705             execmode.step == true || getbps(sys->cpu->pr) == true)
 706         {
 707             if(sys->cpu->pr == execptr->start) {
 708                 fprintf(stdout, "%s", monmsg);
 709             }
 710             monitor();
 711         }
 712         /* プログラムレジスタをチェック */
 713         if(sys->cpu->pr >= sys->memsize) {
 714             setcerr(201, s = pr2str(sys->cpu->pr));        /* Program Register (PR) - memory overflow */
 715             goto execfin;
 716         }
 717         /* スタックポインタをチェック */
 718         if(sys->cpu->sp <= execptr->end) {
 719             setcerr(202, s = pr2str(sys->cpu->pr));        /* Stack Pointer (SP) - stack overflow */
 720             goto execfin;
 721         }
 722         /* コードから命令を取得 */
 723         /* 取得できない場合はエラー終了 */
 724         if((cmdptr = getcmdptr(sys->memory[sys->cpu->pr] & 0xFF00)) == NULL) {
 725             setcerr(204, s = pr2str(sys->cpu->pr));            /* OP in word #1 - not command code */
 726             goto execfin;
 727         }
 728         /* 命令の実行 */
 729         (*cmdptr)();
 730         /* エラー発生時はエラー終了 */
 731         if(cerr->num > 0) {
 732             goto execfin;
 733         }
 734         /* 終了フラグがtrueの場合は、モニターまたは正常終了 */
 735         if(execptr->stop == true) {
 736             if(execmode.monitor == true) {
 737                 fprintf(stdout, "Return to top.\n");
 738                 monitor();
 739             } else {
 740                 break;
 741             }
 742         }
 743         /* クロック周波数の設定 */
 744         do {
 745             clock_end = clock();
 746         } while(clock_end - clock_begin < CLOCKS_PER_SEC / sys->clocks);
 747     }
 748 execfin:
 749     FREE(s);
 750     freebps();
 751     free_cmdtable(HASH_CODE);              /* 命令のコードとタイプがキーのハッシュ表を解放 */
 752     if(cerr->num > 0) {
 753         fprintf(stderr, "Execute error - %d: %s\n", cerr->num, cerr->msg);
 754     }
 755 }