X-Git-Url: http://j8takagi.net/cgi-bin/gitweb.cgi?p=YACASL2.git;a=blobdiff_plain;f=src%2Fexec.c;h=65bd3a77d00d9ba630c24de81278e9993c56b103;hp=aa99076b72168519d513664d9768d4af4c780793;hb=1866f147802418826c9386c755a9d6ba1d5cff89;hpb=3242e69dd21cc00458447c231ef63f876ea54ad1 diff --git a/src/exec.c b/src/exec.c index aa99076..65bd3a7 100644 --- a/src/exec.c +++ b/src/exec.c @@ -1,101 +1,114 @@ -#include -#include -#include - #include "exec.h" -#include "cerr.h" /** - * 実行エラーの定義 + * @brief プログラムレジスタ(PR)を表すWORD値を文字列に変換 + * + * @return 文字列「PR:XXXX」(Xは16進数の数字) + * + * @param pr プログラムレジスタ(PR)を表すWORD値 */ -static CERR cerr_exec[] = { - { 201, "Program Register (PR) - memory overflow" }, - { 202, "Stack Pointer (SP) - stack overflow" }, - { 203, "Stack Pointer (SP) - stack underflow" }, - { 204, "OP in word #1 - not command code" }, - { 205, "r/r1 in word #1 - not GR" }, - { 206, "x/r2 in word #1 - not GR" }, - { 207, "address in word #2 - out of memory" }, - { 208, "SVC input - memory overflow" }, - { 209, "SVC output - memory overflow" }, -}; +char *pr2str(WORD pr); /** - * アセンブル結果読み込みエラーの定義 + * @brief 標準入力から文字データを読込(SVC 1) + * + * @return なし */ -static CERR cerr_load[] = { - { 210, "load - memory overflow" }, - { 211, "object file not specified" }, -}; +void svcin(); /** - * 実行モード: trace, logical, dump + * @brief 標準出力へ文字データを書出(SVC 2) + * + * @return なし */ -EXECMODE execmode = {false, false, false}; +void svcout(); /** - * アセンブル結果読み込みエラーをエラーリストに追加 + * @brief ロード/論理積/論理和/排他的論理和のフラグ設定。OFは常に0 + * + * @return なし + * + * @param adr アドレス */ -void addcerrlist_load() -{ - addcerrlist(ARRAYSIZE(cerr_load), cerr_load); -} +void setfr(WORD adr); /** - * 実行エラーをエラーリストに追加 + * @brief WORD値からr/r1を取得 + * + * @return r/r1を表すWORD値 + * + * @param oprx オペランドを表すWORD値 */ -void addcerrlist_exec() -{ - addcerrlist(ARRAYSIZE(cerr_exec), cerr_exec); -} +WORD get_r_r1(WORD oprx); + /** - * 指定されたファイルからアセンブル結果を読み込む + * @brief WORD値からx/r2を取得 + * + * @return x/r2を表すWORD値 + * + * @param oprx オペランドを表すWORD値 */ -bool loadassemble(const char *file) -{ - FILE *fp; - bool stat = true; +WORD get_x_r2(WORD oprx); - assert(file != NULL); - if((fp = fopen(file, "r")) == NULL) { - perror(file); - return false; - } - execptr->end = execptr->start + - fread(sys->memory, sizeof(WORD), sys->memsize - execptr->start, fp); - if(execptr->end == sys->memsize) { - setcerr(210, file); /* load - memory overflow */ - fprintf(stderr, "Load error - %d: %s\n", cerr->num, cerr->msg); - stat = false; - } - fclose(fp); - return stat; -} +/** + * @brief 2つのWORD値からadr[,x]を取得 + * + * @return adr[,x]を表すWORD値 + * + * @param adr アドレスを表すWORD値 + * @param oprx オペランドを表すWORD値 + */ +WORD get_adr_x(WORD adr, WORD oprx); + +/** + * @brief 2つのWORD値からadr[,x]のアドレスに格納されている値を取得 + * + * @return adr[,x]のアドレスに格納されている値を表すWORD値 + * + * @param adr アドレスを表すWORD値 + * @param oprx オペランドを表すWORD値 + */ +WORD get_val_adr_x(WORD adr, WORD oprx); /** - * プログラムレジスタ(PR)を表す文字列を返す + * @brief 実行エラーの定義 */ -char *pr2str(WORD pr) { +static CERR cerr_exec[] = { + { 201, "Program Register (PR) - memory overflow" }, + { 202, "Stack Pointer (SP) - stack overflow" }, + { 203, "Stack Pointer (SP) - stack underflow" }, + { 204, "OP in word #1 - not command code" }, + { 205, "r/r1 in word #1 - not GR" }, + { 206, "x/r2 in word #1 - not GR" }, + { 207, "address in word #2 - out of memory" }, + { 208, "SVC input - memory overflow" }, + { 209, "SVC output - memory overflow" }, +}; + +/** + * @brief 実行モード: trace, logical, dump, dump_start, dump_end, monitor, step + */ +EXECMODE execmode = {false, false, false, 0, 0xFFFF, false, false}; + +char *pr2str(WORD pr) +{ char *str = malloc_chk(CERRSTRSIZE + 1, "pr2str.pr"); sprintf(str, "PR:#%04X", pr); return str; } -/** - * 標準入力から文字データを読込(SVC 1) - */ void svcin() { int i; - char *buffer = malloc_chk(INSIZE + 1, "svcin.buffer"); + char *buf = malloc_chk(INSIZE + 1, "svcin.buf"); - if(fgets(buffer, INSIZE, stdin) == NULL) { + if(fgets(buf, INSIZE, stdin) == NULL) { sys->memory[sys->cpu->gr[1]] = sys->memory[sys->cpu->gr[2]] = 0x0; return; } for(i = 0; i < INSIZE; i++) { - if(*(buffer + i) == '\0' || *(buffer + i) == '\n') { + if(!buf[i] || buf[i] == '\n') { --i; break; } @@ -103,15 +116,12 @@ void svcin() setcerr(208, ""); /* SVC input - memory overflow */ break; } - sys->memory[sys->cpu->gr[1]+i] = *(buffer + i); + sys->memory[sys->cpu->gr[1] + i] = buf[i]; } sys->memory[sys->cpu->gr[2]] = i + 1; - FREE(buffer); + FREE(buf); } -/** - * 標準出力へ文字データを書出(SVC 2) - */ void svcout() { int i; @@ -136,9 +146,6 @@ void svcout() } } -/** - * ロード/論理積/論理和/排他的論理和のフラグ設定。OFは常に0 - */ void setfr(WORD adr) { sys->cpu->fr = 0x0; @@ -152,122 +159,95 @@ void setfr(WORD adr) } } -/** - * WORD値からr/r1を取得 - */ WORD get_r_r1(WORD oprx) { - WORD r; + WORD r = 0; + char *s = NULL; + if((r = ((oprx & 0x00F0) >>4)) > GRSIZE - 1) { - setcerr(205, pr2str(sys->cpu->pr)); /* r/r1 in word #1 - not GR */ + setcerr(205, s = pr2str(sys->cpu->pr)); /* r/r1 in word #1 - not GR */ + FREE(s); return 0x0; } return r; } -/** - * WORD値からx/r2を取得 - */ WORD get_x_r2(WORD oprx) { - WORD x; + WORD x = 0; + char *s = NULL; + if((x = (oprx & 0x000F)) > GRSIZE - 1) { - setcerr(206, pr2str(sys->cpu->pr)); /* r/r1 in word #1 - not GR */ + setcerr(206, s = pr2str(sys->cpu->pr)); /* r/r1 in word #1 - not GR */ + FREE(s); return 0x0; } return x; } -/** - * 2つのWORD値からadr[,x]を取得 - */ WORD get_adr_x(WORD adr, WORD oprx) { - WORD a = adr, x; - if((x = get_x_r2(oprx)) > 0) { + WORD a = adr; + WORD x = get_x_r2(oprx); + + if(x > 0) { a += sys->cpu->gr[x]; } return a; } - -/** - * 2つのWORD値からadr[,x]のアドレスに格納されている内容を取得 - */ WORD get_val_adr_x(WORD adr, WORD oprx) { - WORD a; + WORD a = 0; + char *s = NULL; + if((a = get_adr_x(adr, oprx)) >= sys->memsize) { - setcerr(207, pr2str(sys->cpu->pr + 1)); /* address in word #2 - out of memory */ + setcerr(207, s = pr2str(sys->cpu->pr + 1)); /* address in word #2 - out of memory */ + FREE(s); return 0x0; } return sys->memory[a]; } -/** - * NOP命令。語長1(OPのみ) - * \relates exec - */ +/* exec.hで定義された関数群 */ +void addcerrlist_exec() +{ + addcerrlist(ARRAYSIZE(cerr_exec), cerr_exec); +} + void nop() { sys->cpu->pr += 1; } -/** - * LD命令 - オペランドr,adr,x。語長2 - * \relates exec - */ void ld_r_adr_x() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; setfr(sys->cpu->gr[get_r_r1(w[0])] = get_val_adr_x(w[1], w[0])); sys->cpu->pr += 2; } -/** - * LD命令 - オペランドr1,r2。語長1 - * \relates exec - */ void ld_r1_r2() { - WORD w[1]; - w[0] = sys->memory[sys->cpu->pr]; + WORD w[] = {sys->memory[sys->cpu->pr]}; setfr(sys->cpu->gr[get_r_r1(w[0])] = sys->cpu->gr[get_x_r2(w[0])]); sys->cpu->pr += 1; } -/** - * ST命令。語長2 - * \relates exec - */ void st() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; sys->memory[get_adr_x(w[1], w[0])] = sys->cpu->gr[get_r_r1(w[0])]; sys->cpu->pr += 2; } -/** - * LAD命令。語長2 - * \relates exec - */ void lad() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; sys->cpu->gr[get_r_r1(w[0])] = get_adr_x(w[1], w[0]); sys->cpu->pr += 2; } -/** - * ADDA命令のテンプレート\n - * 汎用レジスタrに値valを算術加算 - */ void adda(WORD r, WORD val) { long tmp; @@ -287,208 +267,138 @@ void adda(WORD r, WORD val) } } -/** - * ADDA命令 - オペランドr,adr,x。語長2 - * \relates exec - */ void adda_r_adr_x() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; adda(get_r_r1(w[0]), get_val_adr_x(w[1], w[0])); sys->cpu->pr += 2; } -/** - * ADDA命令 - オペランドr1,r2。語長1 - * \relates exec - */ void adda_r1_r2() { - WORD w[1]; - w[0] = sys->memory[sys->cpu->pr]; + WORD w[] = {sys->memory[sys->cpu->pr]}; adda(get_r_r1(w[0]), sys->cpu->gr[get_x_r2(w[0])]); sys->cpu->pr += 1; } -/** - * SUBA命令 - オペランドr,adr,x。語長2 - * \relates exec - */ void suba_r_adr_x() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; adda(get_r_r1(w[0]), ~(get_val_adr_x(w[1], w[0])) + 1); sys->cpu->pr += 2; } -/** - * SUBA命令 - オペランドr1,r2。語長1 - * \relates exec - */ void suba_r1_r2() { - WORD w[1]; - w[0] = sys->memory[sys->cpu->pr]; + WORD w[] = {sys->memory[sys->cpu->pr]}; adda(get_r_r1(w[0]), ~(sys->cpu->gr[get_x_r2(w[0])]) + 1); sys->cpu->pr += 1; } -/** - * ADDL命令のテンプレート\n - * 汎用レジスタrに値valを論理加算 - */ -void addl(WORD r, WORD val) +void addl_gr(WORD r, WORD val, bool add) { - long tmp; - sys->cpu->fr = 0x0; + unsigned long o, s; - if((tmp = sys->cpu->gr[r] + val) < 0 || tmp > 65535) { - sys->cpu->fr += OF; + o = sys->cpu->gr[r]; + sys->cpu->fr = 0x0; /* flag initialize */ + + if(add == true) { + s = o + val; + if(s > 0xFFFF) { + sys->cpu->fr += OF; + } + } else { + if(o < val) { + sys->cpu->fr += OF; + } + s = o + (~val + 1); + if(s > 0xFFFF) { + s &= 0xFFFF; + } } - if(((sys->cpu->gr[r] = (WORD)(tmp & 0xFFFF)) & 0x8000) == 0x8000) { + sys->cpu->gr[r] = (WORD)s; + + if((s & 0x8000) == 0x8000) { sys->cpu->fr += SF; - } else if(sys->cpu->gr[r] == 0x0) { + } + else if(s == 0x0) { sys->cpu->fr += ZF; } } -/** - * ADDL命令 - オペランドr,adr,x。語長2 - * \relates exec - */ void addl_r_adr_x() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; - addl(get_r_r1(w[0]), get_val_adr_x(w[1], w[0])); + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; + addl_gr(get_r_r1(w[0]), get_val_adr_x(w[1], w[0]), true); sys->cpu->pr += 2; } -/** - * ADDL命令 - オペランドr1,r2。語長1 - * \relates exec - */ void addl_r1_r2() { - WORD w[1]; - w[0] = sys->memory[sys->cpu->pr]; - addl(get_r_r1(w[0]), sys->cpu->gr[get_x_r2(w[0])]); + WORD w[] = {sys->memory[sys->cpu->pr]}; + addl_gr(get_r_r1(w[0]), sys->cpu->gr[get_x_r2(w[0])], true); sys->cpu->pr += 1; } -/** - * SUBL命令 - オペランドr,adr,x。語長2 - * \relates exec - */ void subl_r_adr_x() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; - addl(get_r_r1(w[0]), ~(get_val_adr_x(w[1], w[0])) + 1); + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; + addl_gr(get_r_r1(w[0]), get_val_adr_x(w[1], w[0]), false); sys->cpu->pr += 2; } - -/** - * SUBL命令 - オペランドr1,r2。語長1 - * \relates exec - */ void subl_r1_r2() { - WORD w[1]; - w[0] = sys->memory[sys->cpu->pr]; - addl(get_r_r1(w[0]), ~(sys->cpu->gr[get_x_r2(w[0])]) + 1); + WORD w[] = {sys->memory[sys->cpu->pr]}; + addl_gr(get_r_r1(w[0]), sys->cpu->gr[get_x_r2(w[0])], false); sys->cpu->pr += 1; } -/** - * AND命令 - オペランドr,adr,x。語長2 - * \relates exec - */ void and_r_adr_x() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; setfr(sys->cpu->gr[get_r_r1(w[0])] &= get_val_adr_x(w[1], w[0])); sys->cpu->pr += 2; } -/** - * AND命令 - オペランドr1,r2。語長1 - * \relates exec - */ void and_r1_r2() { - WORD w[1]; - w[0] = sys->memory[sys->cpu->pr]; + WORD w[] = {sys->memory[sys->cpu->pr]}; setfr(sys->cpu->gr[get_r_r1(w[0])] &= sys->cpu->gr[get_x_r2(w[0])]); sys->cpu->pr += 1; } -/** - * OR命令 - オペランドr,adr,x。語長2 - * \relates exec - */ void or_r_adr_x() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; setfr(sys->cpu->gr[get_r_r1(w[0])] |= get_val_adr_x(w[1], w[0])); sys->cpu->pr += 2; } -/** - * OR命令 - オペランドr1,r2。語長1 - * \relates exec - */ void or_r1_r2() { - WORD w[1]; - w[0] = sys->memory[sys->cpu->pr]; + WORD w[] = {sys->memory[sys->cpu->pr]}; setfr(sys->cpu->gr[get_r_r1(w[0])] |= sys->cpu->gr[get_x_r2(w[0])]); sys->cpu->pr += 1; } -/** - * XOR命令 - オペランドr,adr,x。語長2 - * \relates exec - */ void xor_r_adr_x() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; setfr(sys->cpu->gr[get_r_r1(w[0])] ^= get_val_adr_x(w[1], w[0])); sys->cpu->pr += 2; } -/** - * XOR命令 - オペランドr1,r2。語長1 - * \relates exec - */ void xor_r1_r2() { - WORD w[1]; - w[0] = sys->memory[sys->cpu->pr]; + WORD w[] = {sys->memory[sys->cpu->pr]}; setfr(sys->cpu->gr[get_r_r1(w[0])] ^= sys->cpu->gr[get_x_r2(w[0])]); sys->cpu->pr += 1; } -/** - * CPA命令のテンプレート\n - * 汎用レジスタrの内容と値valを算術比較 - */ void cpa(WORD r, WORD val) { - sys->cpu->fr = 0x0; + sys->cpu->fr = 0; if((short)sys->cpu->gr[r] < (short)val) { sys->cpu->fr = SF; } else if(sys->cpu->gr[r] == val) { @@ -496,35 +406,20 @@ void cpa(WORD r, WORD val) } } -/** - * CPA命令 - オペランドr,adr,x。語長2 - * \relates exec - */ void cpa_r_adr_x() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; cpa(get_r_r1(w[0]), get_val_adr_x(w[1], w[0])); sys->cpu->pr += 2; } -/** - * CPA命令 - オペランドr1,r2。語長1 - * \relates exec - */ void cpa_r1_r2() { - WORD w[1]; - w[0] = sys->memory[sys->cpu->pr]; + WORD w[] = {sys->memory[sys->cpu->pr]}; cpa(get_r_r1(w[0]), sys->cpu->gr[get_x_r2(w[0])]); sys->cpu->pr += 1; } -/** - * CPL命令のテンプレート\n - * 汎用レジスタrの内容と値valを論理比較 - */ void cpl(WORD r, WORD val) { sys->cpu->fr = 0x0; @@ -535,48 +430,30 @@ void cpl(WORD r, WORD val) } } - -/** - * CPL命令 - オペランドr,adr,x。語長2 - * \relates exec - */ void cpl_r_adr_x() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; cpl(get_r_r1(w[0]), get_val_adr_x(w[1], w[0])); sys->cpu->pr += 2; } -/** - * CPL命令 - オペランドr1,r2。語長1 - * \relates exec - */ void cpl_r1_r2() { - WORD w[1]; - w[0] = sys->memory[sys->cpu->pr]; + WORD w[] = {sys->memory[sys->cpu->pr]}; cpl(get_r_r1(w[0]), sys->cpu->gr[get_x_r2(w[0])]); sys->cpu->pr += 1; } -/** - * SLA命令 - オペランドr,adr,x。語長2\n - * 算術演算なので、第15ビットは送り出されない - * \relates exec - */ void sla() { - WORD w[2], sign, last = 0x0, r; - int i; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; + WORD r = get_r_r1(w[0]); + WORD sign = sys->cpu->gr[r] & 0x8000; + WORD last = 0; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; - sys->cpu->fr = 0x0; - sign = sys->cpu->gr[(r = get_r_r1(w[0]))] & 0x8000; + sys->cpu->fr = 0; sys->cpu->gr[r] &= 0x7FFF; - for(i = 0; i < get_adr_x(w[1], w[0]); i++) { + for(int i = 0; i < get_adr_x(w[1], w[0]); i++) { last = sys->cpu->gr[r] & 0x4000; sys->cpu->gr[r] <<= 1; } @@ -596,23 +473,16 @@ void sla() sys->cpu->pr += 2; } -/** - * SRA命令 - オペランドr,adr,x。語長2\n - * 算術演算なので、第15ビットは送り出されない\n - * 空いたビット位置には符号と同じものが入る - * \relates exec - */ void sra() { - WORD w[2], sign, last = 0x0, r; - int i; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; + WORD r = get_r_r1(w[0]); + WORD sign = sys->cpu->gr[r] & 0x8000; + WORD last = 0; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; - sys->cpu->fr = 0x0; - sign = sys->cpu->gr[(r = get_r_r1(w[0]))] & 0x8000; + sys->cpu->fr = 0; sys->cpu->gr[r] &= 0x7FFF; - for(i = 0; i < get_adr_x(w[1], w[0]); i++) { + for(int i = 0; i < get_adr_x(w[1], w[0]); i++) { last = sys->cpu->gr[r] & 0x1; sys->cpu->gr[r] >>= 1; if(sign > 0) { @@ -635,20 +505,15 @@ void sra() sys->cpu->pr += 2; } -/** - * SLL命令 - オペランドr,adr,x。語長2 - * \relates exec - */ void sll() { - WORD w[2], last = 0x0, r; - int i; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; + WORD last = 0; + WORD r = get_r_r1(w[0]); - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; sys->cpu->fr = 0x0; - for(i = 0; i < get_adr_x(w[1], w[0]); i++) { - last = sys->cpu->gr[(r = get_r_r1(w[0]))] & 0x8000; + for(int i = 0; i < get_adr_x(w[1], w[0]); i++) { + last = sys->cpu->gr[r] & 0x8000; sys->cpu->gr[r] <<= 1; } /* OFに、レジスタから最後に送り出されたビットの値を設定 */ @@ -666,20 +531,14 @@ void sll() sys->cpu->pr += 2; } -/** - * SRL命令 - オペランドr,adr,x。語長2 - * \relates exec - */ void srl() { - WORD w[2], last = 0x0, r; - int i; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; + WORD last = 0; + WORD r = get_r_r1(w[0]); - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; sys->cpu->fr = 0x0; - r = get_r_r1(w[0]); - for(i = 0; i < get_adr_x(w[1], w[0]); i++) { + for(int i = 0; i < get_adr_x(w[1], w[0]); i++) { last = sys->cpu->gr[r] & 0x0001; sys->cpu->gr[r] >>= 1; } @@ -698,15 +557,9 @@ void srl() sys->cpu->pr += 2; } -/** - * JPL命令。語長2 - * \relates exec - */ void jpl() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; if((sys->cpu->fr & (SF | ZF)) == 0) { sys->cpu->pr = get_adr_x(w[1], w[0]); } else { @@ -714,15 +567,9 @@ void jpl() } } -/** - * JMI命令。語長2 - * \relates exec - */ void jmi() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; if((sys->cpu->fr & SF) > 0) { sys->cpu->pr = get_adr_x(w[1], w[0]); } else { @@ -730,15 +577,9 @@ void jmi() } } -/** - * JNZ命令。語長2 - * \relates exec - */ void jnz() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; if((sys->cpu->fr & ZF) == 0) { sys->cpu->pr = get_adr_x(w[1], w[0]); } else { @@ -746,15 +587,9 @@ void jnz() } } -/** - * JZE命令。語長2 - * \relates exec - */ void jze() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; if((sys->cpu->fr & ZF) > 0) { sys->cpu->pr = get_adr_x(w[1], w[0]); } else { @@ -762,15 +597,9 @@ void jze() } } -/** - * JOV命令。語長2 - * \relates exec - */ void jov() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; if((sys->cpu->fr & OF) > 0) { sys->cpu->pr = get_adr_x(w[1], w[0]); } else { @@ -778,63 +607,43 @@ void jov() } } -/** - * JUMP命令。語長2 - * \relates exec - */ void jump() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; sys->cpu->pr = get_adr_x(w[1], w[0]); } -/** - * PUSH命令。語長2 - * \relates exec - */ void push() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; assert(sys->cpu->sp > execptr->end && sys->cpu->sp <= sys->memsize); + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; sys->memory[--(sys->cpu->sp)] = get_adr_x(w[1], w[0]); sys->cpu->pr += 2; } -/** - * POP命令。語長1 - * \relates exec - */ void pop() { - assert(sys->cpu->sp > execptr->end && sys->cpu->sp <= sys->memsize); - WORD w[1]; - w[0] = sys->memory[sys->cpu->pr]; - sys->cpu->gr[get_r_r1(w[0])] = sys->memory[(sys->cpu->sp)++]; - sys->cpu->pr += 1; + assert(sys->cpu->sp > execptr->end); + WORD w[] = {sys->memory[sys->cpu->pr]}; + char *s = NULL; + + if(sys->cpu->sp >= sys->memsize) { + setcerr(203, s = pr2str(sys->cpu->pr)); /* Stack Pointer (SP) - stack underflow */ + FREE(s); + } else { + sys->cpu->gr[get_r_r1(w[0])] = sys->memory[(sys->cpu->sp)++]; + sys->cpu->pr += 1; + } } -/** - * CALL命令。語長2 - * \relates exec - */ void call() { assert(sys->cpu->sp > execptr->end && sys->cpu->sp <= sys->memsize); - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; sys->memory[--(sys->cpu->sp)] = sys->cpu->pr + 1; sys->cpu->pr = get_adr_x(w[1], w[0]); } -/** - * RET命令。語長1(OPのみ) - * \relates exec - */ void ret() { assert(sys->cpu->sp <= sys->memsize); @@ -845,15 +654,9 @@ void ret() } } -/** - * SVC命令。語長2 - * \relates exec - */ void svc() { - WORD w[2]; - w[0] = sys->memory[sys->cpu->pr]; - w[1] = sys->memory[sys->cpu->pr + 1]; + WORD w[] = {sys->memory[sys->cpu->pr], sys->memory[sys->cpu->pr + 1]}; switch(get_adr_x(w[1], w[0])) { case 0x0: /* STOP */ @@ -869,16 +672,16 @@ void svc() sys->cpu->pr += 2; } -/** - * 仮想マシンCOMET IIの実行 - * \class exec - */ void exec() { - clock_t clock_begin, clock_end; - void (*cmdptr)(); + clock_t clock_begin = 0; + clock_t clock_end = 0; + void (*cmdptr)() = NULL; + char *s = NULL; + const char *monmsg = "COMET II machine code monitor. Type ? for help.\n"; + + create_cmdtable(HASH_CODE); /* 命令のコードとタイプがキーのハッシュ表を作成 */ - create_code_type(); /* 命令のコードとタイプがキーのハッシュ表を作成 */ if(execmode.trace == true) { fprintf(stdout, "\nExecuting machine codes\n"); } @@ -892,25 +695,34 @@ void exec() } if(execmode.dump) { /* dumpオプション指定時、メモリを出力 */ fprintf(stdout, "#%04X: Memory::::\n", sys->cpu->pr); - dumpmemory(); + dumpmemory(execmode.dump_start, execmode.dump_end); } fprintf(stdout, "\n"); } - /* プログラムレジスタとスタックポインタをチェック */ - if(sys->cpu->pr >= sys->memsize || sys->cpu->sp > sys->memsize || sys->cpu->sp <= execptr->end) { - if(sys->cpu->pr >= sys->memsize) { - setcerr(201, pr2str(sys->cpu->pr)); /* Program Register (PR) - memory overflow */ - } else if(sys->cpu->sp <= execptr->end) { - setcerr(202, pr2str(sys->cpu->pr)); /* Stack Pointer (SP) - stack overflow */ - } else if(sys->cpu->sp > sys->memsize) { - setcerr(203, pr2str(sys->cpu->pr)); /* Stack Pointer (SP) - stack underflow */ + /* ステップモードまたはブレークポイントの場合、モニターを起動 */ + if( + (execmode.monitor == true && sys->cpu->pr == execptr->start) || + execmode.step == true || getbps(sys->cpu->pr) == true) + { + if(sys->cpu->pr == execptr->start) { + fprintf(stdout, "%s", monmsg); } + monitor(); + } + /* プログラムレジスタをチェック */ + if(sys->cpu->pr >= sys->memsize) { + setcerr(201, s = pr2str(sys->cpu->pr)); /* Program Register (PR) - memory overflow */ + goto execfin; + } + /* スタックポインタをチェック */ + if(sys->cpu->sp <= execptr->end) { + setcerr(202, s = pr2str(sys->cpu->pr)); /* Stack Pointer (SP) - stack overflow */ goto execfin; } /* コードから命令を取得 */ /* 取得できない場合はエラー終了 */ if((cmdptr = getcmdptr(sys->memory[sys->cpu->pr] & 0xFF00)) == NULL) { - setcerr(204, pr2str(sys->cpu->pr)); /* OP in word #1 - not command code */ + setcerr(204, s = pr2str(sys->cpu->pr)); /* OP in word #1 - not command code */ goto execfin; } /* 命令の実行 */ @@ -919,9 +731,14 @@ void exec() if(cerr->num > 0) { goto execfin; } - /* 終了フラグがtrueの場合は、正常終了 */ + /* 終了フラグがtrueの場合は、モニターまたは正常終了 */ if(execptr->stop == true) { - break; + if(execmode.monitor == true) { + fprintf(stdout, "Return to top.\n"); + monitor(); + } else { + break; + } } /* クロック周波数の設定 */ do { @@ -929,7 +746,9 @@ void exec() } while(clock_end - clock_begin < CLOCKS_PER_SEC / sys->clocks); } execfin: - free_code_type(); /* 命令のコードとタイプがキーのハッシュ表を解放 */ + FREE(s); + freebps(); + free_cmdtable(HASH_CODE); /* 命令のコードとタイプがキーのハッシュ表を解放 */ if(cerr->num > 0) { fprintf(stderr, "Execute error - %d: %s\n", cerr->num, cerr->msg); }