SVC 1の動作を、領域が満ちるまで文字が入力されるよう修正。
[YACASL2.git] / src / exec.c
index 19be801..4851aea 100644 (file)
@@ -1,6 +1,9 @@
 #include "casl2.h"
 #include "exec.h"
 
+/* 実行モード: trace, logical, dump */
+EXECMODE execmode = {false, false, false};
+
 /* 標準入力から文字データを読込(SVC 1) */
 void svcin()
 {
@@ -8,16 +11,15 @@ void svcin()
     char *buffer = malloc(INSIZE + 1);
 
     if(fgets(buffer, INSIZE, stdin) == NULL) {
-        memory[GR[1]] = 0x0;
-        memory[GR[2]] = 0x0;
+        memory[GR[1]] = memory[GR[2]] = 0x0;
         return;
     }
-    for(i = 0; i < GR[1] && i < INSIZE; i++) {
+    for(i = 0; i < INSIZE; i++) {
         if(*(buffer + i) == '\0' || *(buffer + i) == '\n') {
             --i;
             break;
         }
-        if(GR[1] + i >= MEMSIZE - 1) {
+        if(GR[1] + i >= memsize - 1) {
             setcerr(202, NULL);    /* SVC input - out of Input memory */
             break;
         }
@@ -30,20 +32,20 @@ void svcin()
 void svcout()
 {
     int i;
-    char c;
+    WORD w;
 
-    for(i = 0; i < GR[2]; i++) {
-        if(GR[1] + i >= MEMSIZE - 1) {
+    for(i = 0; i < memory[GR[2]]; i++) {
+        if(GR[1] + i >= memsize - 1) {
             setcerr(203, NULL);    /* SVC output - out of Comet II memory */
             return;
         }
-        if(memory[GR[1]+i] == '\0') {
+        if((w = memory[GR[1]+i]) == '\0') {
             break;
         }
-        /* 「文字の組」の符号表に記載された文字と、改行(CR)/タブを表示
-           それ以外の文字は、「.」で表す */
-        if(((c = (char)(memory[GR[1]+i])) >= 0x20 && c <= 0x7E) || c == 0xA || c == '\t') {
-            putchar(c);
+        /* 「文字の組」の符号表に記載された文字と、改行(CR)/タブを表示 */
+        /* それ以外の文字は、「.」で表す */
+        if((w >= 0x20 && w <= 0x7E) || w == 0xA || w == '\t') {
+            putchar((char)w);
         } else {
             putchar('.');
         }
@@ -71,12 +73,11 @@ WORD adda(WORD val0, WORD val1)
     long temp;
     FR = 0x0;
 
-    temp = (short)val0 + (short)val1;
+    temp = (signed short)val0 + (signed short)val1;
     if(temp > 32767 || temp < -32768) {
         FR += OF;
     }
-    res = (WORD)(temp & 0xFFFF);
-    if((res & 0x8000) > 0x0) {
+    if(((res = (WORD)(temp & 0xFFFF)) & 0x8000) == 0x8000) {
         FR += SF;
     } else if(res == 0x0) {
         FR += ZF;
@@ -97,12 +98,10 @@ WORD addl(WORD val0, WORD val1)
     WORD res;
     FR = 0x0;
 
-    temp = val0 + val1;
-    if(temp > 65535) {
+    if((temp = val0 + val1) < 0 || temp > 65535) {
         FR += OF;
     }
-    res = (WORD)(temp & 0xFFFF);
-    if((res & 0x8000) > 0x0) {
+    if(((res = (WORD)(temp & 0xFFFF)) & 0x8000) == 0x8000) {
         FR += SF;
     } else if(res == 0x0) {
         FR += ZF;
@@ -113,21 +112,7 @@ WORD addl(WORD val0, WORD val1)
 /* 論理減算。フラグを設定して値を返す */
 WORD subl(WORD val0, WORD val1)
 {
-    long temp;
-    WORD res;
-    FR = 0x0;
-
-    temp = val0 - val1;
-    if(temp < 0) {
-        FR += OF;
-    }
-    res = (WORD)(temp & 0xFFFF);
-    if((res & 0x8000) > 0) {
-        FR += SF;
-    } else if(res == 0) {
-        FR += ZF;
-    }
-    return res;
+    return addl(val0, (~val1 + 1));
 }
 
 /* 算術比較のフラグ設定。OFは常に0 */
@@ -152,16 +137,23 @@ void cpl(WORD val0, WORD val1)
     }
 }
 
-/* 算術左シフト。フラグを設定して値を返す。
-   算術演算なので、第15ビットは送り出されない */
+/* 算術左シフト。フラグを設定して値を返す。 */
+/* 算術演算なので、第15ビットは送り出されない */
 WORD sla(WORD val0, WORD val1)
 {
+    WORD sign, res, last;
+    int i;
+
     FR = 0x0;
-    WORD sign, res;
     sign = val0 & 0x8000;
-    res = ((val0 << val1) & 0x7FFF) | sign;
+    res = val0 & 0x7FFF;
+    for(i = 0; i < val1; i++) {
+        last = res & 0x4000;
+        res <<= 1;
+    }
+    res = sign | (res & 0x7FFF);
     /* OFに、レジスタから最後に送り出されたビットの値を設定 */
-    if((val0 & (0x4000 >> (val1 - 1))) > 0x0) {
+    if(last > 0x0) {
         FR += OF;
     }
     /* 符号(第15ビット)が1のとき、SFは1 */
@@ -176,22 +168,26 @@ WORD sla(WORD val0, WORD val1)
 }
 
 /* 算術右シフト。フラグを設定して値を返す */
+/* 算術演算なので、第15ビットは送り出されない */
+/* 空いたビット位置には符号と同じものが入る */
 WORD sra(WORD val0, WORD val1)
 {
-    WORD sign, res, onbit = 0x8000;
+    WORD sign, res, last;
     int i;
+
     FR = 0x0;
-    res = (val0 & 0x7FFF) >> val1;
-    /* 符号(第15ビット)が1の場合、符号と空いたビット位置に1を設定
-       COMET IIの仕様で、シフトの結果空いたビット位置には符号と同じものが入る */
-    if((sign = val0 & 0x8000) > 0x0) {
-        for(i = 0; i <= val1; i++) {
-            res |= onbit;
-            onbit >>= 1;
+    sign = val0 & 0x8000;
+    res = val0 & 0x7FFF;
+    for(i = 0; i < val1; i++) {
+        last = res & 0x1;
+        res >>= 1;
+        if(sign > 0) {
+            res |= 0x4000;
         }
     }
+    res = sign | res;
     /* OFに、レジスタから最後に送り出されたビットの値を設定 */
-    if((val0 & (0x1 << (val1 - 1))) > 0x0) {
+    if(last > 0x0) {
         FR += OF;
     }
     /* 符号(第15ビット)が1のとき、SFは1 */
@@ -208,11 +204,16 @@ WORD sra(WORD val0, WORD val1)
 /* 論理左シフト。フラグを設定して値を返す */
 WORD sll(WORD val0, WORD val1)
 {
+    WORD res = val0, last;
+    int i;
+
     FR = 0x0;
-    WORD res;
-    res = val0 << val1;
+    for(i = 0; i < val1; i++) {
+        last = res & 0x8000;
+        res <<= 1;
+    }
     /* OFに、レジスタから最後に送り出されたビットの値を設定 */
-    if((val0 & (0x8000 >> (val1 - 1))) > 0x0) {
+    if(last > 0x0) {
         FR += OF;
     }
     /* 第15ビットが1のとき、SFは1 */
@@ -229,11 +230,16 @@ WORD sll(WORD val0, WORD val1)
 /* 論理右シフト。フラグを設定して値を返す */
 WORD srl(WORD val0, WORD val1)
 {
+    WORD res = val0, last;
+    int i;
+
     FR = 0x0;
-    WORD res;
-    res = val0 >> val1;
+    for(i = 0; i < val1; i++) {
+        last = res & 0x0001;
+        res >>= 1;
+    }
     /* OFに、レジスタから最後に送り出されたビットの値を設定 */
-    if((val0 & (0x1 << (val1 - 1))) > 0x0) {
+    if(last > 0x0) {
         FR += OF;
     }
     /* 第15ビットが1のとき、SFは1 */
@@ -247,15 +253,16 @@ WORD srl(WORD val0, WORD val1)
     return res;
 }
 
-/* 仮想マシンのリセット */
+/* COMET II仮想マシンのリセット */
 void reset()
 {
     int i;
-    for(i = 0; i <= 7; i++) {
+    for(i = 0; i < REGSIZE; i++) {
         GR[i] = 0x0;
     }
     SP = PR = FR = 0x0;
-    for(i = 0; i < MEMSIZE; i++) {
+    memory = malloc(memsize);
+    for(i = 0; i < memsize; i++) {
         memory[i] = 0x0;
     }
 }
@@ -268,12 +275,12 @@ void exec()
     char *errpr = malloc(8);
     clock_t clock_begin, clock_end;
 
-    if(tracemode) {
+    if((&execmode)->trace) {
         fprintf(stdout, "\nExecuting machine codes\n");
     }
     /* フラグレジスタの初期値設定 */
     FR = 0x0;
-    SP = MEMSIZE;
+    SP = memsize;
     PR = startptr;
     if(create_code_type() == false) {
         goto execerr;
@@ -282,10 +289,15 @@ void exec()
     for (; ; ) {
         clock_begin = clock();
         /* プログラムレジスタのアドレスが主記憶の範囲外の場合はエラー */
-        if(PR >= MEMSIZE) {
+        if(PR >= memsize) {
             sprintf(errpr, "PR:#%04X", PR);
             setcerr(204, errpr);    /* Program Register (PR) - out of COMET II memory */
         }
+        /* スタック領域のアドレスが主記憶の範囲外の場合はエラー */
+        if(SP > memsize) {
+            sprintf(errpr, "PR:#%04X", PR);
+            setcerr(207, errpr);    /* Stack Pointer (SP) - out of COMET II memory */
+        }
         /* スタック領域を確保できない場合はエラー */
         if(SP <= endptr) {
             sprintf(errpr, "PR:#%04X", PR);
@@ -299,15 +311,15 @@ void exec()
         if(cerrno > 0) {
             goto execerr;
         }
-        if(tracemode){
+        if((&execmode)->trace){
             fprintf(stdout, "#%04X: Register::::\n", PR);
             dspregister();
         }
-        if(dumpmode){
+        if((&execmode)->dump){
             fprintf(stdout, "#%04X: Memory::::\n", PR);
             dumpmemory();
         }
-        if(dumpmode || tracemode) {
+        if((&execmode)->dump || (&execmode)->trace) {
             fprintf(stdout, "\n");
         }
         PR++;
@@ -325,7 +337,7 @@ void exec()
             }
             /* ロード/算術論理演算命令/比較演算命令では、アドレスに格納されている内容を取得 */
             if(cmdtype == R_ADR_X_) {
-                if(val >= MEMSIZE) {
+                if(val >= memsize) {
                     sprintf(errpr, "PR:#%04X", PR-1);
                     setcerr(206, errpr);    /* Address - out of COMET II memory */
                     goto execerr;
@@ -419,18 +431,21 @@ void exec()
             }
             break;
         case 0x7000:  /* PUSH */
+            assert(SP > endptr && SP <= memsize);
             memory[--SP] = val;
             break;
         case 0x7100:  /* POP */
+            assert(SP > endptr && SP <= memsize);
             GR[r_r1] = memory[SP++];
             break;
         case 0x8000:  /* CALL */
+            assert(SP > endptr && SP <= memsize);
             memory[--SP] = PR;
             PR = val;
             break;
         case 0x8100:  /* RET */
-            assert(SP > endptr && SP <= MEMSIZE);
-            if(SP == MEMSIZE) {
+            assert(SP > endptr && SP <= memsize);
+            if(SP == memsize) {
                 return;
             } else {
                 PR = memory[SP++];
@@ -453,7 +468,8 @@ void exec()
         }
         do {
             clock_end = clock();
-        } while(clock_end - clock_begin < CLOCKS_PER_SEC / CLOCKS);
+        } while(clock_end - clock_begin < CLOCKS_PER_SEC / clocks);
+/*        printf("PR:%04X; time: %f\n", PR, (double)((clock_end - clock_begin) * CLOCKS_PER_SEC)); */
     }
 execerr:
     fprintf(stderr, "Execute error - %d: %s\n", cerrno, cerrmsg);