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