89ad9186ba0704f7b1f72b762dc62c0fc50f646a
[YACASL2.git] / 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 }