From f925850726e8cd1e429abe88fc5d96bdc74b987a Mon Sep 17 00:00:00 2001
From: j8takagi <j8takagi@nifty.com>
Date: Thu, 31 Mar 2011 07:56:30 +0900
Subject: [PATCH] =?utf8?q?=E5=AE=9F=E8=A1=8C=E6=99=82=E3=81=AE=E5=87=A6?=
 =?utf8?q?=E7=90=86=E3=82=92=E4=BF=AE=E6=AD=A3?=
MIME-Version: 1.0
Content-Type: text/plain; charset=utf8
Content-Transfer-Encoding: 8bit

---
 include/struct.h |  1 +
 src/exec.c       | 41 +++++++++++++++++++++++++++--------------
 2 files changed, 28 insertions(+), 14 deletions(-)

diff --git a/include/struct.h b/include/struct.h
index de1aa4b..ec4f52b 100644
--- a/include/struct.h
+++ b/include/struct.h
@@ -114,6 +114,7 @@ typedef struct _CMDTAB {
 typedef struct {
     WORD start;   /**<開始アドレス */
     WORD end;     /**<終了アドレス */
+    bool stop;    /**<終了フラグ */
 } EXECPTR;
 
 extern EXECPTR *execptr;
diff --git a/src/exec.c b/src/exec.c
index 62d0b13..68717d8 100644
--- a/src/exec.c
+++ b/src/exec.c
@@ -496,7 +496,10 @@ void call(const WORD r, const WORD v)
  */
 void ret(const WORD r, const WORD v)
 {
-    if(sys->cpu->sp < sys->memsize) {
+    assert(sys->cpu->sp <= sys->memsize);
+    if(sys->cpu->sp == sys->memsize) {
+        execptr->stop = true;
+    } else if(sys->cpu->sp < sys->memsize) {
         sys->cpu->pr = sys->memory[(sys->cpu->sp)++];
     }
 }
@@ -508,6 +511,9 @@ void svc(const WORD r, const WORD v)
 {
     switch(v)
     {
+    case 0x0:
+        execptr->stop = true;
+        break;
     case 0x1:                   /* IN */
         svcin();
         break;
@@ -532,33 +538,37 @@ bool exec()
     }
     /* フラグレジスタの初期値設定 */
     sys->cpu->fr = 0x0;
+    /* スタックポインタの初期値設定 */
     sys->cpu->sp = sys->memsize;
-    sys->cpu->pr = execptr->start;
+    /* 終了フラグの初期値設定 */
+    execptr->stop = false;
     /* 機械語の実行 */
-    for (; ; ) {
+    for (sys->cpu->pr = execptr->start; ; ) {
         clock_begin = clock();
-        /* プログラムレジスタのアドレスが主記憶の範囲外の場合はエラー */
+        /* プログラムレジスタのアドレスが主記憶の範囲外の場合はエラー終了 */
         if(sys->cpu->pr >= sys->memsize) {
             setcerr(204, pr2str(sys->cpu->pr));    /* Program Register (PR) - out of COMET II memory */
+            goto execerr;
         }
-        /* スタック領域を確保できない場合はエラー */
+        /* スタック領域を確保できない場合はエラー終了 */
         else if(sys->cpu->sp <= execptr->end) {
             setcerr(205, pr2str(sys->cpu->pr));    /* Stack Pointer (SP) - cannot allocate stack buffer */
+            goto execerr;
         }
-        /* スタック領域のアドレスが主記憶の範囲外の場合はエラー */
+        /* スタック領域のアドレスが主記憶の範囲外の場合はエラー終了 */
         else if(sys->cpu->sp > sys->memsize) {
             setcerr(207, pr2str(sys->cpu->pr));    /* Stack Pointer (SP) - out of COMET II memory */
+            goto execerr;
         }
         /* 命令の取り出し */
         op = sys->memory[sys->cpu->pr] & 0xFF00;
         /* 命令の解読 */
+        /* 命令がCOMET II命令ではない場合はエラー終了 */
         if((cmdtype = getcmdtype(op)) == NOTCMD) {
             setcerr(210, pr2str(sys->cpu->pr));          /* not command code of COMET II */
-        }
-        /* エラー発生時は終了 */
-        if(cerr->num > 0) {
             goto execerr;
         }
+        cmdptr = getcmdptr(op);
         r_r1 = (sys->memory[sys->cpu->pr] >> 4) & 0xF;
         x_r2 = sys->memory[sys->cpu->pr] & 0xF;
         /* traceオプション指定時、レジスタを出力 */
@@ -611,11 +621,14 @@ bool exec()
             op &= 0xFB00;
         }
         /* 命令の実行 */
-        if((op == 0x8100 && sys->cpu->sp == sys->memsize) || (op == 0xF000 && val == 0x0)) {
-            return true;
-        } else {
-            cmdptr = getcmdptr(op);
-            (*cmdptr)(r_r1, val);
+        (*cmdptr)(r_r1, val);
+        /* エラー発生時はエラー終了 */
+        if(cerr->num > 0) {
+            goto execerr;
+        }
+        /* 終了フラグがtrueの場合は、正常終了 */
+        if(execptr->stop == true) {
+            break;
         }
         /* クロック周波数の設定 */
         do {
-- 
2.18.0