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 *p, *q, *r, *sepp;     /* pは文字列全体の先頭位置、qはトークンの先頭位置、rは文字の位置 */
 127     int sepc = ' ';
 128
 129     args->argc = 0;
 130     if(str == NULL) {
 131         return args;
 132     }
 133     p = q = r = strdup_chk(str, "argstok.p");
 134     do {
 135         while(*q == ' ' || *q == '\t'){
 136             q = ++r;
 137         }
 138         sepp = r + strcspn(r, " ");
 139         sepc = *sepp;
 140         strcpy(sepp, "");
 141         args->argv[++(args->argc)-1] = strdup_chk(q, "args.argv[]");
 142         q = r = sepp + 1;
 143     } while(sepc == ' ');
 144     FREE(p);
 145     return args;
 146 }
 147
 148 MONCMDLINE *monlinetok(const char *line)
 149 {
 150     char *tokens, *p;
 151     long l;
 152     MONCMDLINE *moncmdl = NULL;
 153
 154     if(!line[0] || line[0] == '\n') {
 155         return NULL;
 156     }
 157     p = tokens = strdup_chk(line, "tokens");
 158     moncmdl = malloc_chk(sizeof(MONCMDLINE), "moncmdl");
 159     /* コマンドの取得 */
 160     moncmdl->cmd = malloc_chk((l = strcspn(p, " \t\n")) + 1, "moncmdl.cmd");
 161     strncpy(moncmdl->cmd, p, l);
 162     /* コマンドと引数の間の空白をスキップ */
 163     p += l;
 164     while(*p == ' ' || *p == '\t') {
 165         p++;
 166     }
 167     /* 引数として、改行までの文字列を取得 */
 168     if((l = strcspn(p, "\n")) > 0) {
 169         moncmdl->args = monargstok(p);
 170     } else {
 171         moncmdl->args = malloc_chk(sizeof(MONARGS), "moncmdl.args");
 172         moncmdl->args->argc = 0;
 173     }
 174     FREE(tokens);
 175     return moncmdl;
 176 }
 177
 178 bool stracmp(char *str1, int str2c, char *str2v[])
 179 {
 180     int i;
 181     if(str1 == NULL) {
 182         return false;
 183     }
 184     for(i = 0; i < str2c; i++) {
 185         if(strcmp(str1, str2v[i]) == 0) {
 186             return true;
 187         }
 188     }
 189     return false;
 190 }
 191
 192 void mon_break(int argc, char *argv[])
 193 {
 194     WORD w;
 195     if(stracmp(argv[0], 2, (char* []){"l", "list"})) {
 196         listbps();
 197     } else if(stracmp(argv[0], 2, (char* []){"r", "reset"})) {
 198         freebps();
 199         fprintf(stdout, "All breakpoints are deleted.\n");
 200     } else {
 201         if(argc > 1) {
 202             if((w = nh2word(argv[1])) == 0x0) {
 203                 fprintf(stderr, "%s: address error\n", argv[1]);
 204             }
 205         }
 206         if(stracmp(argv[0], 2, (char* []){"a", "add"})) {
 207             if(addbps(w) == true) {
 208                 fprintf(stdout, "#%04X: breakpoint added\n", w);
 209             } else {
 210                 fprintf(stdout, "No breakpoint added\n");
 211             }
 212         } else if(stracmp(argv[0], 2, (char* []){"d", "del"})) {
 213             if(delbps(w) == true) {
 214                 fprintf(stdout, "#%04X: breakpoint deleted\n", w);
 215             } else {
 216                 fprintf(stdout, "No breakpoint deleted\n");
 217             }
 218         } else if(stracmp(argv[0], 3, (char* []){"?", "h", "help"})) {
 219             fprintf(stdout, "breakpoint manipulate:\n");
 220             fprintf(stdout, "    b[reak] a[dd] <address>\n");
 221             fprintf(stdout, "    b[reak] d[el] <address>\n");
 222             fprintf(stdout, "    b[reak] l[ist]\n");
 223             fprintf(stdout, "    b[reak] r[eset]\n");
 224         } else {
 225             fprintf(stderr, "%s: Not breakpoint manipulate command. see `b ?'.\n", argv[0]);
 226         }
 227     }
 228 }
 229
 230 void mon_dump(int argc, char *argv[])
 231 {
 232     int i = 0, j;
 233     WORD start = 0, end = 0xFFFF;
 234     if(argc > 0 && stracmp(argv[0], 2, (char* []){"a", "auto"})) {
 235         execmode.dump = true;
 236         i++;
 237     } else if(argc > 0 && stracmp(argv[0], 2, (char* []){"no", "noauto"})) {
 238         execmode.dump = false;
 239         i++;
 240     }
 241     if(argc > i) {
 242         start = execmode.dump_start = nh2word(argv[i++]);
 243         if(argc > i) {
 244             end = execmode.dump_end = nh2word(argv[i++]);
 245         }
 246         dumpmemory(start, end);
 247         if(argc > i) {
 248             for(j = i; i < argc; j++) {
 249                 if(j > i) {
 250                     fprintf(stderr, " ");
 251                 }
 252                 fprintf(stderr, "%s", argv[j]);
 253             }
 254             fprintf(stderr, ": ignored.\n");
 255         }
 256     }
 257 }
 258
 259 MONCMDTYPE monitorcmd(char *cmd, MONARGS *args)
 260 {
 261     MONCMDTYPE cmdtype = MONREPEAT;
 262     if(stracmp(cmd, 2, (char* []){"a", "assemble"})) {
 263         if(args->argc == 0) {
 264             fprintf(stderr, "Error: Input file name.\n");
 265         } else if(args->argc == 1) {
 266             assemble(1, (char* []){args->argv[0]}, 0);
 267         } else {
 268             assemble(1, (char* []){args->argv[0]}, nh2word(args->argv[1]));
 269         }
 270     } else if(stracmp(cmd, 2, (char* []){"b", "break"})) {
 271         mon_break(args->argc, args->argv);
 272     } else if(stracmp(cmd, 2, (char* []){"c", "continue"})) {
 273         execmode.step = false;
 274         cmdtype = MONNEXT;
 275     } else if(stracmp(cmd, 2, (char* []){"d", "dump"})) {
 276         mon_dump(args->argc, args->argv);
 277     } else if(stracmp(cmd, 2, (char* []){"l", "load"})) {
 278         loadassemble(args->argv[0], nh2word(args->argv[1]));
 279     } else if(stracmp(cmd, 2, (char* []){"n", "next"})) {
 280         execmode.step = true;
 281         cmdtype = MONNEXT;
 282     } else if(stracmp(cmd, 2, (char* []){"q", "quit"})) {
 283         fprintf(stdout, "Quit: COMET II monitor\n");
 284         cmdtype = MONQUIT;
 285     } else if(stracmp(cmd, 2, (char* []){"r", "reverse"})) {
 286         if(args->argc == 2) {
 287             disassemble_memory(nh2word(args->argv[0]), nh2word(args->argv[1]));
 288         }
 289     } else if(stracmp(cmd, 1, (char* []){"reset"})) {
 290         fprintf(stdout, "Reset COMET II.\n");
 291         reset(sys->memsize, sys->clocks);     /* COMET II仮想マシンのリセット */
 292     } else if(stracmp(cmd, 2, (char* []){"t", "trace"})) {
 293         if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"a", "auto"})) {
 294             execmode.logical = false;
 295             execmode.trace = true;
 296         } else if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"no", "noauto"})) {
 297             execmode.trace = false;
 298         } else {
 299             fprintf(stdout, "#%04X: Register::::\n", sys->cpu->pr);
 300             dspregister();
 301         }
 302     } else if(stracmp(cmd, 2, (char* []){"T", "tracelogical"})) {
 303         if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"a", "auto"})) {
 304             execmode.logical = true;
 305             execmode.trace = true;
 306         } else if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"no", "noauto"})) {
 307             execmode.trace = false;
 308         } else {
 309             fprintf(stdout, "#%04X: Register::::\n", sys->cpu->pr);
 310             dspregister();
 311         }
 312     } else if(stracmp(cmd, 3, (char* []){"?", "h", "help"})) {
 313         fprintf(stdout, "b[reak] -- Manipulate Breakpoints. See details, `b ?'.\n");
 314         fprintf(stdout, "c[ontinue] -- Continue running your program.\n");
 315         fprintf(stdout, "d[ump] -- Display memory dump. `d[ump] a[uto]/n[oauto]' set auto/noauto display.\n");
 316         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");
 317         fprintf(stdout, "n[ext] -- Go next instruction.\n");
 318         fprintf(stdout, "q[uit] -- Quit running your program.\n");
 319         fprintf(stdout, "reset -- Reset the system.\n");
 320         fprintf(stdout, "r[everse] -- Disassemble memory. `r[everse] <start address> <end address>.\n");
 321         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");
 322         fprintf(stdout, "t[race] -- Display CPU register. `t[race] a[uto]/n[oauto]' set auto/noauto display. \n");
 323         fprintf(stdout, "T[race] -- Display CPU register as logical value. `t[race] a[uto]/n[oauto]' set auto/noauto display. \n");
 324         fprintf(stdout, "?/h[elp] -- Display this help.\n");
 325     }
 326     return cmdtype;
 327 }
 328
 329 void free_moncmdline(MONCMDLINE *moncmdl)
 330 {
 331     int i;
 332     assert(moncmdl != NULL);
 333     if(moncmdl->args != NULL) {
 334         for(i = 0;  i < moncmdl->args->argc; i++) {
 335             FREE(moncmdl->args->argv[i]);
 336         }
 337         FREE(moncmdl->args);
 338     }
 339     if(moncmdl->cmd != NULL) {
 340         FREE(moncmdl->cmd);
 341     }
 342     if(moncmdl != NULL) {
 343         FREE(moncmdl);
 344     }
 345 }
 346
 347 void monitor()
 348 {
 349     char *buf = NULL;
 350     int i;
 351     MONCMDLINE *moncmdl;
 352     MONCMDTYPE cmdtype = MONREPEAT;
 353
 354     do {
 355         fprintf(stdout, "%s ", monitor_prompt);
 356         buf = malloc_chk(MONINSIZE + 1, "monitor.buf");
 357         fgets(buf, MONINSIZE, stdin);
 358         fprintf(stdout, "%s", buf);
 359         if(!buf[0]) {
 360             cmdtype = MONQUIT;
 361         }
 362         if((i = strcspn(buf, "\n")) > 0 || buf[0] == '\n') {
 363             buf[i] = '\0';
 364         }
 365         if((moncmdl = monlinetok(buf)) != NULL) {
 366             cmdtype = monitorcmd(moncmdl->cmd, moncmdl->args);
 367             free_moncmdline(moncmdl);
 368         }
 369         FREE(buf);
 370         if(cmdtype == MONQUIT) {
 371             shutdown();
 372             freebps();
 373             free_cmdtable(HASH_CODE);
 374             freecerr();
 375             exit(0);
 376         }
 377     } while(cmdtype == MONREPEAT);
 378 }