src/debugger.c

   1 #include "debugger.h"
   2
   3 /**
   4  * @brief ブレークポイント表
   5  */
   6 static BPSLIST *bps[BPSTABSIZE];
   7
   8 /**
   9  * @brief ブレークポイントのエラー
  10  */
  11 static CERR cerr_bps[] = {
  12     { 101, "break point already defined" },
  13     { 102, "break point table is full" },
  14     { 103, "break point not found" },
  15     { 104, "break point address not set" },
  16     { 105, "illegal break point address" },
  17 };
  18
  19 /**
  20  * @brief ブレークポイントのエラーをエラーリストに追加する
  21  *
  22  * @return なし
  23  */
  24 void addcerrlist_bps();
  25
  26
  27 unsigned adrhash(WORD adr)
  28 {
  29     HKEY *key[1];
  30     unsigned h;
  31     key[0] = malloc_chk(sizeof(HKEY), "adrhash.key");
  32     key[0]->type = INT;
  33     key[0]->val.i = adr;
  34     h = hash(1, key, BPSTABSIZE);
  35     FREE(key[0]);
  36     return h;
  37 }
  38
  39 void addcerrlist_bps()
  40 {
  41     addcerrlist(ARRAYSIZE(cerr_bps), cerr_bps);
  42 }
  43
  44 bool getbps(WORD adr)
  45 {
  46     BPSLIST *p;
  47
  48     for(p = bps[adrhash(adr)]; p != NULL; p = p->next) {
  49         if(p->adr == adr) {
  50             return true;
  51         }
  52     }
  53     return false;
  54 }
  55
  56 bool addbps(WORD adr)
  57 {
  58     BPSLIST *p;
  59     unsigned h;
  60
  61     /* 登録されたラベルを検索。すでに登録されている場合は終了 */
  62     if(getbps(adr) == true) {
  63         fprintf(stderr, "%04X: Breakpoint is already defined.\n", adr);
  64         return false;
  65     }
  66     /* メモリを確保 */
  67     p = malloc_chk(sizeof(BPSLIST), "bps.next");
  68     /* アドレスを設定 */
  69     p->adr = adr;
  70     /* ハッシュ表へ追加 */
  71     p->next = bps[h = adrhash(adr)];
  72     bps[h] = p;
  73     return true;
  74 }
  75
  76 bool delbps(WORD adr)
  77 {
  78     BPSLIST *p, *q;
  79     unsigned h;
  80     bool res = false;
  81
  82     p = bps[h = adrhash(adr)];
  83     if(p != NULL) {
  84         if(p->adr == adr) {
  85             if(p->next == NULL) {
  86                 FREE(bps[h]);
  87             } else {
  88                 bps[h] = p->next;
  89                 FREE(p);
  90             }
  91             res = true;
  92         } else {
  93             for(; p->next != NULL; p = p->next) {
  94                 q = p->next;
  95                 if(q->adr == adr) {
  96                     p->next = q->next;
  97                     FREE(q);
  98                     res = true;
  99                     break;
 100                 }
 101             }
 102         }
 103     }
 104     return res;
 105 }
 106
 107 void listbps()
 108 {
 109     int i, cnt = 0;
 110     BPSLIST *p;
 111
 112     fprintf(stdout, "List of breakpoints\n");
 113     for(i = 0; i < BPSTABSIZE; i++) {
 114         for(p = bps[i]; p != NULL; p = p->next) {
 115             fprintf(stdout, "#%04X\n", p->adr);
 116             cnt++;
 117         }
 118     }
 119     if(cnt == 0) {
 120         fprintf(stdout, "(No breakpoints.)\n");
 121     }
 122 }
 123
 124 void freebpslist(BPSLIST *head)
 125 {
 126     BPSLIST *p, *q;
 127     for(p = head; p != NULL; p = q) {
 128         q = p->next;
 129         FREE(p);
 130     }
 131 }
 132
 133 void freebps()
 134 {
 135     int i;
 136     for(i = 0; i < BPSTABSIZE; i++) {
 137         freebpslist(bps[i]);
 138         bps[i] = NULL;
 139     }
 140 }
 141
 142 DBARGS *dbargstok(const char *str)
 143 {
 144     DBARGS *args = malloc_chk(sizeof(DBARGS), "args");
 145     char *p, *q, *r, *sepp;     /* pは文字列全体の先頭位置、qはトークンの先頭位置、rは文字の位置 */
 146     int sepc = ' ';
 147
 148     args->argc = 0;
 149     if(str == NULL) {
 150         return args;
 151     }
 152     p = q = r = strdup_chk(str, "argstok.p");
 153     do {
 154         while(*q == ' ' || *q == '\t'){
 155             q = ++r;
 156         }
 157         sepp = r + strcspn(r, " ");
 158         sepc = *sepp;
 159         *sepp = '\0';
 160         args->argv[++(args->argc)-1] = strdup_chk(q, "args.argv[]");
 161         q = r = sepp + 1;
 162     } while(sepc == ' ');
 163     FREE(p);
 164     return args;
 165 }
 166
 167 DBCMDLINE *dblinetok(const char *line)
 168 {
 169     char *tokens, *p;
 170     long l;
 171     DBCMDLINE *dbcmdl = NULL;
 172
 173     if(*line == '\n' || *line == '\0') {
 174         return NULL;
 175     }
 176     p = tokens = strdup_chk(line, "tokens");
 177     dbcmdl = malloc_chk(sizeof(DBCMDLINE), "dbcmdl");
 178     /* コマンドの取得 */
 179     dbcmdl->cmd = malloc_chk((l = strcspn(p, " \t\n")) + 1, "dbcmdl.cmd");
 180     strncpy(dbcmdl->cmd, p, l);
 181     /* コマンドと引数の間の空白をスキップ */
 182     p += l;
 183     while(*p == ' ' || *p == '\t') {
 184         p++;
 185     }
 186     /* 引数として、改行までの文字列を取得 */
 187     if((l = strcspn(p, "\n")) > 0) {
 188         dbcmdl->args = dbargstok(p);
 189     } else {
 190         dbcmdl->args = malloc_chk(sizeof(DBARGS), "dbcmdl.args");
 191         dbcmdl->args->argc = 0;
 192     }
 193     FREE(tokens);
 194     return dbcmdl;
 195 }
 196
 197 bool stracmp(char *str1, int str2c, char *str2v[])
 198 {
 199     int i;
 200     if(str1 == NULL) {
 201         return false;
 202     }
 203     for(i = 0; i < str2c; i++) {
 204         if(strcmp(str1, str2v[i]) == 0) {
 205             return true;
 206         }
 207     }
 208     return false;
 209 }
 210
 211 void db_break(int argc, char *argv[])
 212 {
 213     WORD w;
 214     if(stracmp(argv[0], 2, (char* []){"l", "list"})) {
 215         listbps();
 216     } else if(stracmp(argv[0], 2, (char* []){"r", "reset"})) {
 217         freebps();
 218         fprintf(stdout, "All breakpoints are deleted.\n");
 219     } else {
 220         if(argc > 1) {
 221             if((w = nh2word(argv[1])) == 0x0) {
 222                 fprintf(stderr, "%s: address error\n", argv[1]);
 223             }
 224         }
 225         if(stracmp(argv[0], 2, (char* []){"a", "add"})) {
 226             if(addbps(w) == true) {
 227                 fprintf(stdout, "#%04X: breakpoint added\n", w);
 228             } else {
 229                 fprintf(stdout, "No breakpoint added\n");
 230             }
 231         } else if(stracmp(argv[0], 2, (char* []){"d", "del"})) {
 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             fprintf(stdout, "breakpoint manipulate:\n");
 239             fprintf(stdout, "    b[reak] a[dd] <address>\n");
 240             fprintf(stdout, "    b[reak] d[el] <address>\n");
 241             fprintf(stdout, "    b[reak] l[ist]\n");
 242             fprintf(stdout, "    b[reak] r[eset]\n");
 243         } else {
 244             fprintf(stderr, "%s: Not breakpoint manipulate command. see `b ?'.\n", argv[0]);
 245         }
 246     }
 247 }
 248
 249 bool debuggercmd(char *cmd, DBARGS *args)
 250 {
 251     bool next = false;
 252     if(stracmp(cmd, 2, (char* []){"s", "step"})) {
 253         execmode.step = true;
 254         next = true;
 255     } else if(stracmp(cmd, 2, (char* []){"b", "break"})) {
 256         db_break(args->argc, args->argv);
 257     } else if(stracmp(cmd, 2, (char* []){"c", "continue"})) {
 258         execmode.step = false;
 259         next = true;
 260     } else if(stracmp(cmd, 2, (char* []){"t", "trace"})) {
 261         if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"a", "auto"})) {
 262             execmode.logical = false;
 263             execmode.trace = true;
 264         } else if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"no", "noauto"})) {
 265             execmode.trace = false;
 266         } else {
 267             fprintf(stdout, "#%04X: Register::::\n", sys->cpu->pr);
 268             dspregister();
 269         }
 270     } else if(stracmp(cmd, 2, (char* []){"T", "tracelogical"})) {
 271         if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"a", "auto"})) {
 272             execmode.logical = true;
 273             execmode.trace = true;
 274         } else if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"no", "noauto"})) {
 275             execmode.trace = false;
 276         } else {
 277             fprintf(stdout, "#%04X: Register::::\n", sys->cpu->pr);
 278             dspregister();
 279         }
 280     } else if(stracmp(cmd, 2, (char* []){"d", "dump"})) {
 281         if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"a", "auto"})) {
 282             execmode.dump = true;
 283         } else if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"no", "noauto"})) {
 284             execmode.dump = false;
 285         } else {
 286             dumpmemory();
 287         }
 288     } else if(stracmp(cmd, 3, (char* []){"?", "h", "help"})) {
 289         fprintf(stdout, "b[reak] -- Manipulate Breakpoints. Details in `b ?'.\n");
 290         fprintf(stdout, "s[tep] -- Step by step running your program until next interaction.\n");
 291         fprintf(stdout, "c[ontinue] -- Continue running your program.\n");
 292         fprintf(stdout, "t[race] -- Display CPU register. `t[race] a[uto]/n[oauto]' set auto/noauto display. \n");
 293         fprintf(stdout, "d[ump] -- Display memory dump. `d[ump] a[uto]/n[oauto]' set auto/noauto display.\n");
 294         fprintf(stdout, "?/h[elp] -- Display this help.\n");
 295     }
 296     return next;
 297 }
 298
 299 void free_dbcmdline(DBCMDLINE *dbcmdl)
 300 {
 301     int i;
 302     assert(dbcmdl != NULL);
 303     if(dbcmdl->args != NULL) {
 304         for(i = 0;  i < dbcmdl->args->argc; i++) {
 305             FREE(dbcmdl->args->argv[i]);
 306         }
 307         FREE(dbcmdl->args);
 308     }
 309     if(dbcmdl->cmd != NULL) {
 310         FREE(dbcmdl->cmd);
 311     }
 312     if(dbcmdl != NULL) {
 313         FREE(dbcmdl);
 314     }
 315 }
 316
 317 void debugger()
 318 {
 319     char *buf, *p;
 320     DBCMDLINE *dbcmdl;
 321     bool next = false;
 322     do {
 323         fprintf(stdout, "COMET II (Type ? for help) > ");
 324         buf = malloc_chk(DBINSIZE + 1, "debugger.buf");
 325         fgets(buf, DBINSIZE, stdin);
 326         if((p = strchr(buf, '\n')) != NULL) {
 327             *p = '\0';
 328         }
 329         if((dbcmdl = dblinetok(buf)) != NULL) {
 330             next = debuggercmd(dbcmdl->cmd, dbcmdl->args);
 331             free_dbcmdline(dbcmdl);
 332         }
 333         FREE(buf);
 334     } while(next == false);
 335 }