src/monitor.c

   1 #include "monitor.h"
   2
   3 /**
   4  * @brief ブレークポイント表
   5  */
   6 static BPSLIST *bps[BPSTABSIZE];
   7
   8 /**
   9  * @brief comet2monitorのプロンプト
  10  */
  11 static char *monitor_prompt = "(comet2 monitor)";
  12
  13 unsigned adrhash(WORD adr)
  14 {
  15     HKEY *key[1];
  16     unsigned h;
  17     key[0] = malloc_chk(sizeof(HKEY), "adrhash.key");
  18     key[0]->type = INT;
  19     key[0]->val.i = adr;
  20     h = hash(1, key, BPSTABSIZE);
  21     FREE(key[0]);
  22     return h;
  23 }
  24
  25 bool getbps(WORD adr)
  26 {
  27     BPSLIST *p;
  28
  29     for(p = bps[adrhash(adr)]; p != NULL; p = p->next) {
  30         if(p->adr == adr) {
  31             return true;
  32         }
  33     }
  34     return false;
  35 }
  36
  37 bool addbps(WORD adr)
  38 {
  39     BPSLIST *p;
  40     unsigned h;
  41
  42     /* 登録されたラベルを検索。すでに登録されている場合は終了 */
  43     if(getbps(adr) == true) {
  44         fprintf(stderr, "%04X: Breakpoint is already defined.\n", adr);
  45         return false;
  46     }
  47     /* メモリを確保 */
  48     p = malloc_chk(sizeof(BPSLIST), "bps.next");
  49     /* アドレスを設定 */
  50     p->adr = adr;
  51     /* ハッシュ表へ追加 */
  52     p->next = bps[h = adrhash(adr)];
  53     bps[h] = p;
  54     return true;
  55 }
  56
  57 bool delbps(WORD adr)
  58 {
  59     BPSLIST *p, *q;
  60     unsigned h;
  61     bool res = false;
  62
  63     p = bps[h = adrhash(adr)];
  64     if(p != NULL) {
  65         if(p->adr == adr) {
  66             if(p->next == NULL) {
  67                 FREE(bps[h]);
  68             } else {
  69                 bps[h] = p->next;
  70                 FREE(p);
  71             }
  72             res = true;
  73         } else {
  74             for(; p->next != NULL; p = p->next) {
  75                 q = p->next;
  76                 if(q->adr == adr) {
  77                     p->next = q->next;
  78                     FREE(q);
  79                     res = true;
  80                     break;
  81                 }
  82             }
  83         }
  84     }
  85     return res;
  86 }
  87
  88 void listbps()
  89 {
  90     int i, cnt = 0;
  91     BPSLIST *p;
  92
  93     fprintf(stdout, "List of breakpoints\n");
  94     for(i = 0; i < BPSTABSIZE; i++) {
  95         for(p = bps[i]; p != NULL; p = p->next) {
  96             fprintf(stdout, "#%04X\n", p->adr);
  97             cnt++;
  98         }
  99     }
 100     if(cnt == 0) {
 101         fprintf(stdout, "(No breakpoints.)\n");
 102     }
 103 }
 104
 105 void freebpslist(BPSLIST *head)
 106 {
 107     BPSLIST *p, *q;
 108     for(p = head; p != NULL; p = q) {
 109         q = p->next;
 110         FREE(p);
 111     }
 112 }
 113
 114 void freebps()
 115 {
 116     int i;
 117     for(i = 0; i < BPSTABSIZE; i++) {
 118         freebpslist(bps[i]);
 119         bps[i] = NULL;
 120     }
 121 }
 122
 123 MONARGS *monargstok(const char *str)
 124 {
 125     MONARGS *args = malloc_chk(sizeof(MONARGS), "args");
 126     char *tok, *p, sepc = ' ';
 127     int i = 0;
 128
 129     args->argc = 0;
 130     if(!str || !str[0]) {
 131         return args;
 132     }
 133     tok = p = strdup_chk(str, "argstok.p");
 134     do {
 135         i = strcspn(p, " ");
 136         sepc = p[i];
 137         args->argv[(args->argc)++] = strndup_chk(p, i, "args->argv[]");
 138         p += i + 1;
 139         i = 0;
 140     } while(sepc == ' ');
 141     FREE(tok);
 142     return args;
 143 }
 144
 145 MONCMDLINE *monlinetok(const char *line)
 146 {
 147     char *tokens, *p;
 148     int i;
 149     MONCMDLINE *moncmdl = NULL;
 150
 151     if(!line[0] || line[0] == '\n') {
 152         return NULL;
 153     }
 154     p = tokens = strdup_chk(line, "tokens");
 155     /* コメントを削除 */
 156     strip_casl2_comment(p);
 157     /* 文字列末尾の改行と空白を削除 */
 158     strip_end(p);
 159
 160     moncmdl = malloc_chk(sizeof(MONCMDLINE), "moncmdl");
 161     /* コマンドの取得 */
 162     i = strcspn(p, " \t\n");
 163     moncmdl->cmd = strndup_chk(p, i, "moncmdl->cmd");
 164     /* コマンドと引数の間の空白をスキップ */
 165     p += i;
 166     while(*p == ' ' || *p == '\t') {
 167         p++;
 168     }
 169     /* 引数として、改行までの文字列を取得 */
 170     if(strcspn(p, "\n") > 0) {
 171         moncmdl->args = monargstok(p);
 172     } else {
 173         moncmdl->args = malloc_chk(sizeof(MONARGS), "moncmdl.args");
 174         moncmdl->args->argc = 0;
 175     }
 176     FREE(tokens);
 177     return moncmdl;
 178 }
 179
 180 bool stracmp(char *str1, int str2c, char *str2v[])
 181 {
 182     int i;
 183     if(str1 == NULL) {
 184         return false;
 185     }
 186     for(i = 0; i < str2c; i++) {
 187         if(strcmp(str1, str2v[i]) == 0) {
 188             return true;
 189         }
 190     }
 191     return false;
 192 }
 193
 194 void warn_ignore_arg(int argc, char *argv[])
 195 {
 196     int i;
 197     for(i = 0; i < argc; i++) {
 198         if(i > 0) {
 199             fprintf(stderr, " ");
 200         }
 201         fprintf(stderr, "%s", argv[i]);
 202     }
 203     fprintf(stderr, ": ignored.\n");
 204 }
 205
 206 void mon_break(int argc, char *argv[])
 207 {
 208     WORD w;
 209     int i = 0;
 210     if(stracmp(argv[0], 2, (char* []){"l", "list"})) {
 211         i++;
 212         listbps();
 213     } else if(stracmp(argv[0], 2, (char* []){"r", "reset"})) {
 214         i++;
 215         freebps();
 216         fprintf(stdout, "All breakpoints are deleted.\n");
 217     } else {
 218         if(argc > 1) {
 219             if((w = nh2word(argv[1])) == 0x0) {
 220                 fprintf(stderr, "%s: address error\n", argv[1]);
 221             }
 222         }
 223         if(stracmp(argv[0], 2, (char* []){"a", "add"})) {
 224             i += 2;
 225             if(addbps(w) == true) {
 226                 fprintf(stdout, "#%04X: breakpoint added\n", w);
 227             } else {
 228                 fprintf(stdout, "No breakpoint added\n");
 229             }
 230         } else if(stracmp(argv[0], 2, (char* []){"d", "del"})) {
 231             i += 2;
 232             if(delbps(w) == true) {
 233                 fprintf(stdout, "#%04X: breakpoint deleted\n", w);
 234             } else {
 235                 fprintf(stdout, "No breakpoint deleted\n");
 236             }
 237         } else if(stracmp(argv[0], 3, (char* []){"?", "h", "help"})) {
 238             i++;
 239             fprintf(stdout, "breakpoint manipulate:\n");
 240             fprintf(stdout, "    b[reak] a[dd] <address>\n");
 241             fprintf(stdout, "    b[reak] d[el] <address>\n");
 242             fprintf(stdout, "    b[reak] l[ist]\n");
 243             fprintf(stdout, "    b[reak] r[eset]\n");
 244         } else {
 245             fprintf(stderr, "%s: Not breakpoint manipulate command. see `b ?'.\n", argv[0]);
 246         }
 247         if(argc > i) {
 248             warn_ignore_arg(argc - i, argv + i);
 249         }
 250     }
 251 }
 252
 253 void mon_dump(int argc, char *argv[])
 254 {
 255     int i = 0;
 256     WORD dump_start = 0, dump_end = 0x40;
 257     if(argc > 0 && stracmp(argv[0], 2, (char* []){"a", "auto"})) {
 258         execmode.dump = true;
 259         i++;
 260     } else if(argc > 0 && stracmp(argv[0], 2, (char* []){"no", "noauto"})) {
 261         execmode.dump = false;
 262         i++;
 263     }
 264     if(argc > i) {
 265         dump_start = nh2word(argv[i++]);
 266         if(argc > i) {
 267             if(argv[i][0] =='+') {
 268                 dump_end = dump_start + nh2word(argv[i] + 1);
 269             } else {
 270                 dump_end = nh2word(argv[i]);
 271             }
 272         } else {
 273             dump_end += dump_start;
 274         }
 275         i++;
 276     }
 277     if(argc > i) {
 278         warn_ignore_arg(argc - i, argv + i);
 279     }
 280     dumpmemory(dump_start, dump_end);
 281     execmode.dump_start = dump_start;
 282     execmode.dump_end = dump_end;
 283 }
 284
 285 MONCMDTYPE monitorcmd(char *cmd, MONARGS *args)
 286 {
 287     MONCMDTYPE cmdtype = MONREPEAT;
 288     if(stracmp(cmd, 2, (char* []){"a", "assemble"})) {
 289         if(args->argc == 0) {
 290             fprintf(stderr, "Error: Input file name.\n");
 291         } else if(args->argc == 1) {
 292             assemble(1, (char* []){args->argv[0]}, 0);
 293         } else {
 294             assemble(1, (char* []){args->argv[0]}, nh2word(args->argv[1]));
 295         }
 296     } else if(stracmp(cmd, 2, (char* []){"b", "break"})) {
 297         mon_break(args->argc, args->argv);
 298     } else if(stracmp(cmd, 2, (char* []){"c", "continue"})) {
 299         execmode.step = false;
 300         cmdtype = MONNEXT;
 301     } else if(stracmp(cmd, 2, (char* []){"d", "dump"})) {
 302         mon_dump(args->argc, args->argv);
 303     } else if(stracmp(cmd, 2, (char* []){"l", "load"})) {
 304         execptr->end = loadassemble(args->argv[0], nh2word(args->argv[1]));
 305     } else if(stracmp(cmd, 2, (char* []){"n", "next"})) {
 306         execmode.step = true;
 307         cmdtype = MONNEXT;
 308     } else if(stracmp(cmd, 2, (char* []){"q", "quit"})) {
 309         fprintf(stdout, "Quit: COMET II monitor\n");
 310         cmdtype = MONQUIT;
 311     } else if(stracmp(cmd, 2, (char* []){"r", "reverse"})) {
 312         if(args->argc == 2) {
 313             disassemble_memory(nh2word(args->argv[0]), nh2word(args->argv[1]));
 314         }
 315     } else if(stracmp(cmd, 1, (char* []){"reset"})) {
 316         fprintf(stdout, "Reset COMET II.\n");
 317         reset(sys->memsize, sys->clocks);     /* COMET II仮想マシンのリセット */
 318     } else if(stracmp(cmd, 2, (char* []){"t", "trace"})) {
 319         if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"a", "auto"})) {
 320             execmode.logical = false;
 321             execmode.trace = true;
 322         } else if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"no", "noauto"})) {
 323             execmode.trace = false;
 324         } else {
 325             fprintf(stdout, "#%04X: Register::::\n", sys->cpu->pr);
 326             dspregister();
 327         }
 328     } else if(stracmp(cmd, 2, (char* []){"T", "tracelogical"})) {
 329         if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"a", "auto"})) {
 330             execmode.logical = true;
 331             execmode.trace = true;
 332         } else if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"no", "noauto"})) {
 333             execmode.trace = false;
 334         } else {
 335             fprintf(stdout, "#%04X: Register::::\n", sys->cpu->pr);
 336             dspregister();
 337         }
 338     } else if(stracmp(cmd, 3, (char* []){"?", "h", "help"})) {
 339         fprintf(stdout, "b[reak] -- Manipulate Breakpoints. See details, `b ?'.\n");
 340         fprintf(stdout, "c[ontinue] -- Continue running your program.\n");
 341         fprintf(stdout, "d[ump] -- Display memory dump. `d[ump] a[uto]/n[oauto]' set auto/noauto display.\n");
 342         fprintf(stdout, "l[oad] -- Load object from a file to the memory. `l[oad] <filepath> <address>' if address is omitted, load to address 0.\n");
 343         fprintf(stdout, "n[ext] -- Go next instruction.\n");
 344         fprintf(stdout, "q[uit] -- Quit running your program.\n");
 345         fprintf(stdout, "reset -- Reset the system.\n");
 346         fprintf(stdout, "r[everse] -- Disassemble memory. `r[everse] <start address> <end address>.\n");
 347         fprintf(stdout, "s[ave] -- Save object from the memory to a file. `s[ave] <filepath> [<start address1> [<end address>]]' if <start address> and <end address> is omitted, save the whole memory. if <end address> is omitted, save the memory after <start address>.\n");
 348         fprintf(stdout, "t[race] -- Display CPU register. `t[race] a[uto]/n[oauto]' set auto/noauto display. \n");
 349         fprintf(stdout, "T[race] -- Display CPU register as logical value. `t[race] a[uto]/n[oauto]' set auto/noauto display. \n");
 350         fprintf(stdout, "?/h[elp] -- Display this help.\n");
 351     }
 352     return cmdtype;
 353 }
 354
 355 void free_moncmdline(MONCMDLINE *moncmdl)
 356 {
 357     int i;
 358     assert(moncmdl != NULL);
 359     if(moncmdl->args != NULL) {
 360         for(i = 0;  i < moncmdl->args->argc; i++) {
 361             FREE(moncmdl->args->argv[i]);
 362         }
 363         FREE(moncmdl->args);
 364     }
 365     if(moncmdl->cmd != NULL) {
 366         FREE(moncmdl->cmd);
 367     }
 368     if(moncmdl != NULL) {
 369         FREE(moncmdl);
 370     }
 371 }
 372
 373 int monquit()
 374 {
 375     int stat = 0;
 376     shutdown();
 377     freebps();
 378     free_cmdtable(HASH_CMDTYPE);
 379     free_cmdtable(HASH_CODE);
 380     if(cerr->num > 0) {
 381         stat = 1;
 382     }
 383     freecerr();
 384     return stat;
 385 }
 386
 387 void monitor()
 388 {
 389     char *buf = NULL;
 390     MONCMDLINE *moncmdl;
 391     MONCMDTYPE cmdtype = MONREPEAT;
 392
 393     do {
 394         fprintf(stdout, "%s ", monitor_prompt);
 395         buf = malloc_chk(MONINSIZE + 1, "monitor.buf");
 396         fgets(buf, MONINSIZE, stdin);
 397         fprintf(stdout, "%s", buf);
 398         if(!buf[0]) {
 399             cmdtype = MONQUIT;
 400         }
 401         strip_end(buf);        /* 文字列末尾の改行と空白を削除 */
 402         if((moncmdl = monlinetok(buf)) != NULL) {
 403             cmdtype = monitorcmd(moncmdl->cmd, moncmdl->args);
 404             free_moncmdline(moncmdl);
 405         }
 406         FREE(buf);
 407         if(cmdtype == MONQUIT) {
 408             exit(monquit());
 409         }
 410     } while(cmdtype == MONREPEAT);
 411 }