--- /dev/null
+#include "monitor.h"
+
+/**
+ * @brief ブレークポイント表
+ */
+static BPSLIST *bps[BPSTABSIZE];
+
+/**
+ * @brief ブレークポイントのエラー
+ */
+static CERR cerr_bps[] = {
+ { 101, "break point already defined" },
+ { 102, "break point table is full" },
+ { 103, "break point not found" },
+ { 104, "break point address not set" },
+ { 105, "illegal break point address" },
+};
+
+/**
+ * @brief ブレークポイントのエラーをエラーリストに追加する
+ *
+ * @return なし
+ */
+void addcerrlist_bps();
+
+
+unsigned adrhash(WORD adr)
+{
+ HKEY *key[1];
+ unsigned h;
+ key[0] = malloc_chk(sizeof(HKEY), "adrhash.key");
+ key[0]->type = INT;
+ key[0]->val.i = adr;
+ h = hash(1, key, BPSTABSIZE);
+ FREE(key[0]);
+ return h;
+}
+
+void addcerrlist_bps()
+{
+ addcerrlist(ARRAYSIZE(cerr_bps), cerr_bps);
+}
+
+bool getbps(WORD adr)
+{
+ BPSLIST *p;
+
+ for(p = bps[adrhash(adr)]; p != NULL; p = p->next) {
+ if(p->adr == adr) {
+ return true;
+ }
+ }
+ return false;
+}
+
+bool addbps(WORD adr)
+{
+ BPSLIST *p;
+ unsigned h;
+
+ /* 登録されたラベルを検索。すでに登録されている場合は終了 */
+ if(getbps(adr) == true) {
+ fprintf(stderr, "%04X: Breakpoint is already defined.\n", adr);
+ return false;
+ }
+ /* メモリを確保 */
+ p = malloc_chk(sizeof(BPSLIST), "bps.next");
+ /* アドレスを設定 */
+ p->adr = adr;
+ /* ハッシュ表へ追加 */
+ p->next = bps[h = adrhash(adr)];
+ bps[h] = p;
+ return true;
+}
+
+bool delbps(WORD adr)
+{
+ BPSLIST *p, *q;
+ unsigned h;
+ bool res = false;
+
+ p = bps[h = adrhash(adr)];
+ if(p != NULL) {
+ if(p->adr == adr) {
+ if(p->next == NULL) {
+ FREE(bps[h]);
+ } else {
+ bps[h] = p->next;
+ FREE(p);
+ }
+ res = true;
+ } else {
+ for(; p->next != NULL; p = p->next) {
+ q = p->next;
+ if(q->adr == adr) {
+ p->next = q->next;
+ FREE(q);
+ res = true;
+ break;
+ }
+ }
+ }
+ }
+ return res;
+}
+
+void listbps()
+{
+ int i, cnt = 0;
+ BPSLIST *p;
+
+ fprintf(stdout, "List of breakpoints\n");
+ for(i = 0; i < BPSTABSIZE; i++) {
+ for(p = bps[i]; p != NULL; p = p->next) {
+ fprintf(stdout, "#%04X\n", p->adr);
+ cnt++;
+ }
+ }
+ if(cnt == 0) {
+ fprintf(stdout, "(No breakpoints.)\n");
+ }
+}
+
+void freebpslist(BPSLIST *head)
+{
+ BPSLIST *p, *q;
+ for(p = head; p != NULL; p = q) {
+ q = p->next;
+ FREE(p);
+ }
+}
+
+void freebps()
+{
+ int i;
+ for(i = 0; i < BPSTABSIZE; i++) {
+ freebpslist(bps[i]);
+ bps[i] = NULL;
+ }
+}
+
+MONARGS *monargstok(const char *str)
+{
+ MONARGS *args = malloc_chk(sizeof(MONARGS), "args");
+ char *p, *q, *r, *sepp; /* pは文字列全体の先頭位置、qはトークンの先頭位置、rは文字の位置 */
+ int sepc = ' ';
+
+ args->argc = 0;
+ if(str == NULL) {
+ return args;
+ }
+ p = q = r = strdup_chk(str, "argstok.p");
+ do {
+ while(*q == ' ' || *q == '\t'){
+ q = ++r;
+ }
+ sepp = r + strcspn(r, " ");
+ sepc = *sepp;
+ *sepp = '\0';
+ args->argv[++(args->argc)-1] = strdup_chk(q, "args.argv[]");
+ q = r = sepp + 1;
+ } while(sepc == ' ');
+ FREE(p);
+ return args;
+}
+
+MONCMDLINE *monlinetok(const char *line)
+{
+ char *tokens, *p;
+ long l;
+ MONCMDLINE *moncmdl = NULL;
+
+ if(*line == '\n' || *line == '\0') {
+ return NULL;
+ }
+ p = tokens = strdup_chk(line, "tokens");
+ moncmdl = malloc_chk(sizeof(MONCMDLINE), "moncmdl");
+ /* コマンドの取得 */
+ moncmdl->cmd = malloc_chk((l = strcspn(p, " \t\n")) + 1, "moncmdl.cmd");
+ strncpy(moncmdl->cmd, p, l);
+ /* コマンドと引数の間の空白をスキップ */
+ p += l;
+ while(*p == ' ' || *p == '\t') {
+ p++;
+ }
+ /* 引数として、改行までの文字列を取得 */
+ if((l = strcspn(p, "\n")) > 0) {
+ moncmdl->args = monargstok(p);
+ } else {
+ moncmdl->args = malloc_chk(sizeof(MONARGS), "moncmdl.args");
+ moncmdl->args->argc = 0;
+ }
+ FREE(tokens);
+ return moncmdl;
+}
+
+bool stracmp(char *str1, int str2c, char *str2v[])
+{
+ int i;
+ if(str1 == NULL) {
+ return false;
+ }
+ for(i = 0; i < str2c; i++) {
+ if(strcmp(str1, str2v[i]) == 0) {
+ return true;
+ }
+ }
+ return false;
+}
+
+void mon_break(int argc, char *argv[])
+{
+ WORD w;
+ if(stracmp(argv[0], 2, (char* []){"l", "list"})) {
+ listbps();
+ } else if(stracmp(argv[0], 2, (char* []){"r", "reset"})) {
+ freebps();
+ fprintf(stdout, "All breakpoints are deleted.\n");
+ } else {
+ if(argc > 1) {
+ if((w = nh2word(argv[1])) == 0x0) {
+ fprintf(stderr, "%s: address error\n", argv[1]);
+ }
+ }
+ if(stracmp(argv[0], 2, (char* []){"a", "add"})) {
+ if(addbps(w) == true) {
+ fprintf(stdout, "#%04X: breakpoint added\n", w);
+ } else {
+ fprintf(stdout, "No breakpoint added\n");
+ }
+ } else if(stracmp(argv[0], 2, (char* []){"d", "del"})) {
+ if(delbps(w) == true) {
+ fprintf(stdout, "#%04X: breakpoint deleted\n", w);
+ } else {
+ fprintf(stdout, "No breakpoint deleted\n");
+ }
+ } else if(stracmp(argv[0], 3, (char* []){"?", "h", "help"})) {
+ fprintf(stdout, "breakpoint manipulate:\n");
+ fprintf(stdout, " b[reak] a[dd] <address>\n");
+ fprintf(stdout, " b[reak] d[el] <address>\n");
+ fprintf(stdout, " b[reak] l[ist]\n");
+ fprintf(stdout, " b[reak] r[eset]\n");
+ } else {
+ fprintf(stderr, "%s: Not breakpoint manipulate command. see `b ?'.\n", argv[0]);
+ }
+ }
+}
+
+bool monitorcmd(char *cmd, MONARGS *args)
+{
+ bool next = false;
+ if(stracmp(cmd, 2, (char* []){"s", "step"})) {
+ execmode.step = true;
+ next = true;
+ } else if(stracmp(cmd, 2, (char* []){"b", "break"})) {
+ mon_break(args->argc, args->argv);
+ } else if(stracmp(cmd, 2, (char* []){"c", "continue"})) {
+ execmode.step = false;
+ next = true;
+ } else if(stracmp(cmd, 2, (char* []){"t", "trace"})) {
+ if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"a", "auto"})) {
+ execmode.logical = false;
+ execmode.trace = true;
+ } else if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"no", "noauto"})) {
+ execmode.trace = false;
+ } else {
+ fprintf(stdout, "#%04X: Register::::\n", sys->cpu->pr);
+ dspregister();
+ }
+ } else if(stracmp(cmd, 2, (char* []){"T", "tracelogical"})) {
+ if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"a", "auto"})) {
+ execmode.logical = true;
+ execmode.trace = true;
+ } else if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"no", "noauto"})) {
+ execmode.trace = false;
+ } else {
+ fprintf(stdout, "#%04X: Register::::\n", sys->cpu->pr);
+ dspregister();
+ }
+ } else if(stracmp(cmd, 2, (char* []){"d", "dump"})) {
+ if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"a", "auto"})) {
+ execmode.dump = true;
+ } else if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"no", "noauto"})) {
+ execmode.dump = false;
+ } else {
+ dumpmemory();
+ }
+ } else if(stracmp(cmd, 3, (char* []){"?", "h", "help"})) {
+ fprintf(stdout, "b[reak] -- Manipulate Breakpoints. Details in `b ?'.\n");
+ fprintf(stdout, "s[tep] -- Step by step running your program until next interaction.\n");
+ fprintf(stdout, "c[ontinue] -- Continue running your program.\n");
+ fprintf(stdout, "t[race] -- Display CPU register. `t[race] a[uto]/n[oauto]' set auto/noauto display. \n");
+ fprintf(stdout, "d[ump] -- Display memory dump. `d[ump] a[uto]/n[oauto]' set auto/noauto display.\n");
+ fprintf(stdout, "?/h[elp] -- Display this help.\n");
+ }
+ return next;
+}
+
+void free_moncmdline(MONCMDLINE *moncmdl)
+{
+ int i;
+ assert(moncmdl != NULL);
+ if(moncmdl->args != NULL) {
+ for(i = 0; i < moncmdl->args->argc; i++) {
+ FREE(moncmdl->args->argv[i]);
+ }
+ FREE(moncmdl->args);
+ }
+ if(moncmdl->cmd != NULL) {
+ FREE(moncmdl->cmd);
+ }
+ if(moncmdl != NULL) {
+ FREE(moncmdl);
+ }
+}
+
+void monitor()
+{
+ char *buf, *p;
+ MONCMDLINE *moncmdl;
+ bool next = false;
+ do {
+ fprintf(stdout, "COMET II (Type ? for help) > ");
+ buf = malloc_chk(MONINSIZE + 1, "monitor.buf");
+ fgets(buf, MONINSIZE, stdin);
+ if((p = strchr(buf, '\n')) != NULL) {
+ *p = '\0';
+ }
+ if((moncmdl = monlinetok(buf)) != NULL) {
+ next = monitorcmd(moncmdl->cmd, moncmdl->args);
+ free_moncmdline(moncmdl);
+ }
+ FREE(buf);
+ } while(next == false);
+}
projects / YACASL2.git / blobdiff