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