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 for(i = 0; i < argc; i++) {
200 if(i > 0) {
201 fprintf(stderr, " ");
202 }
203 fprintf(stderr, "%s", argv[i]);
204 }
205 fprintf(stderr, ": ignored.\n");
206 }
207
208 void mon_break(int argc, char *argv[])
209 {
210 WORD w;
211 int i = 0;
212 if(stracmp(argv[0], 2, (char* []){"l", "list"})) {
213 i++;
214 listbps();
215 } else if(stracmp(argv[0], 2, (char* []){"r", "reset"})) {
216 i++;
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 i += 2;
227 if(addbps(w) == true) {
228 fprintf(stdout, "#%04X: breakpoint added\n", w);
229 } else {
230 fprintf(stdout, "No breakpoint added\n");
231 }
232 } else if(stracmp(argv[0], 2, (char* []){"d", "del"})) {
233 i += 2;
234 if(delbps(w) == true) {
235 fprintf(stdout, "#%04X: breakpoint deleted\n", w);
236 } else {
237 fprintf(stdout, "No breakpoint deleted\n");
238 }
239 } else if(stracmp(argv[0], 3, (char* []){"?", "h", "help"})) {
240 i++;
241 fprintf(stdout, "breakpoint manipulate:\n");
242 fprintf(stdout, " b[reak] a[dd] <address>\n");
243 fprintf(stdout, " b[reak] d[el] <address>\n");
244 fprintf(stdout, " b[reak] l[ist]\n");
245 fprintf(stdout, " b[reak] r[eset]\n");
246 } else {
247 fprintf(stderr, "%s: Not breakpoint manipulate command. see `b ?'.\n", argv[0]);
248 }
249 if(argc > i) {
250 warn_ignore_arg(argc - i, argv + i);
251 }
252 }
253 }
254
255 void mon_dump(int argc, char *argv[])
256 {
257 int i = 0;
258 WORD dump_start = 0, dump_end = 0x40;
259 if(argc > 0 && stracmp(argv[0], 2, (char* []){"a", "auto"})) {
260 execmode.dump = true;
261 i++;
262 } else if(argc > 0 && stracmp(argv[0], 2, (char* []){"no", "noauto"})) {
263 execmode.dump = false;
264 i++;
265 }
266 if(argc > i) {
267 dump_start = nh2word(argv[i++]);
268 if(argc > i) {
269 if(argv[i][0] =='+') {
270 dump_end = dump_start + nh2word(argv[i] + 1);
271 } else {
272 dump_end = nh2word(argv[i]);
273 }
274 } else {
275 dump_end += dump_start;
276 }
277 i++;
278 }
279 if(argc > i) {
280 warn_ignore_arg(argc - i, argv + i);
281 }
282 dumpmemory(dump_start, dump_end);
283 execmode.dump_start = dump_start;
284 execmode.dump_end = dump_end;
285 }
286
287 MONCMDTYPE monitorcmd(char *cmd, MONARGS *args)
288 {
289 MONCMDTYPE cmdtype = MONREPEAT;
290 if(stracmp(cmd, 2, (char* []){"a", "assemble"})) {
291 if(args->argc == 0) {
292 fprintf(stderr, "Error: Input file name.\n");
293 } else if(args->argc == 1) {
294 assemble(1, (char* []){args->argv[0]}, 0);
295 } else {
296 assemble(1, (char* []){args->argv[0]}, nh2word(args->argv[1]));
297 }
298 } else if(stracmp(cmd, 2, (char* []){"b", "break"})) {
299 mon_break(args->argc, args->argv);
300 } else if(stracmp(cmd, 2, (char* []){"c", "continue"})) {
301 execmode.step = false;
302 cmdtype = MONNEXT;
303 } else if(stracmp(cmd, 2, (char* []){"d", "dump"})) {
304 mon_dump(args->argc, args->argv);
305 } else if(stracmp(cmd, 2, (char* []){"l", "load"})) {
306 execptr->end = loadassemble(args->argv[0], nh2word(args->argv[1]));
307 } else if(stracmp(cmd, 2, (char* []){"n", "next"})) {
308 execmode.step = true;
309 cmdtype = MONNEXT;
310 } else if(stracmp(cmd, 2, (char* []){"q", "quit"})) {
311 fprintf(stdout, "Quit: COMET II monitor\n");
312 cmdtype = MONQUIT;
313 } else if(stracmp(cmd, 2, (char* []){"r", "reverse"})) {
314 if(args->argc == 2) {
315 disassemble_memory(nh2word(args->argv[0]), nh2word(args->argv[1]));
316 }
317 } else if(stracmp(cmd, 1, (char* []){"reset"})) {
318 fprintf(stdout, "Reset COMET II.\n");
319 reset(sys->memsize, sys->clocks);
320 } else if(stracmp(cmd, 2, (char* []){"t", "trace"})) {
321 if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"a", "auto"})) {
322 execmode.logical = false;
323 execmode.trace = true;
324 } else if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"no", "noauto"})) {
325 execmode.trace = false;
326 } else {
327 fprintf(stdout, "#%04X: Register::::\n", sys->cpu->pr);
328 dspregister();
329 }
330 } else if(stracmp(cmd, 2, (char* []){"T", "tracelogical"})) {
331 if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"a", "auto"})) {
332 execmode.logical = true;
333 execmode.trace = true;
334 } else if(args->argc > 0 && stracmp(args->argv[0], 2, (char* []){"no", "noauto"})) {
335 execmode.trace = false;
336 } else {
337 fprintf(stdout, "#%04X: Register::::\n", sys->cpu->pr);
338 dspregister();
339 }
340 } else if(stracmp(cmd, 3, (char* []){"?", "h", "help"})) {
341 fprintf(stdout, "b[reak] -- Manipulate Breakpoints. See details, `b ?'.\n");
342 fprintf(stdout, "c[ontinue] -- Continue running your program.\n");
343 fprintf(stdout, "d[ump] -- Display memory dump. `d[ump] a[uto]/n[oauto]' set auto/noauto display.\n");
344 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");
345 fprintf(stdout, "n[ext] -- Go next instruction.\n");
346 fprintf(stdout, "q[uit] -- Quit running your program.\n");
347 fprintf(stdout, "reset -- Reset the system.\n");
348 fprintf(stdout, "r[everse] -- Disassemble memory. `r[everse] <start address> <end address>.\n");
349 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");
350 fprintf(stdout, "t[race] -- Display CPU register. `t[race] a[uto]/n[oauto]' set auto/noauto display. \n");
351 fprintf(stdout, "T[race] -- Display CPU register as logical value. `t[race] a[uto]/n[oauto]' set auto/noauto display. \n");
352 fprintf(stdout, "?/h[elp] -- Display this help.\n");
353 }
354 return cmdtype;
355 }
356
357 void free_moncmdline(MONCMDLINE *moncmdl)
358 {
359 int i;
360 assert(moncmdl != NULL);
361 if(moncmdl->args != NULL) {
362 for(i = 0; i < moncmdl->args->argc; i++) {
363 FREE(moncmdl->args->argv[i]);
364 }
365 FREE(moncmdl->args);
366 }
367 if(moncmdl->cmd != NULL) {
368 FREE(moncmdl->cmd);
369 }
370 if(moncmdl != NULL) {
371 FREE(moncmdl);
372 }
373 }
374
375 int monquit()
376 {
377 int stat = 0;
378 shutdown();
379 freebps();
380 free_cmdtable(HASH_CMDTYPE);
381 free_cmdtable(HASH_CODE);
382 if(cerr->num > 0) {
383 stat = 1;
384 }
385 freecerr();
386 return stat;
387 }
388
389 void monitor()
390 {
391 char *buf = NULL;
392 MONCMDLINE *moncmdl = NULL;
393 MONCMDTYPE cmdtype = MONREPEAT;
394
395 do {
396 fprintf(stdout, "%s ", monitor_prompt);
397 buf = malloc_chk(MONINSIZE + 1, "monitor.buf");
398 fgets(buf, MONINSIZE, stdin);
399 if(!buf[0]) {
400 cmdtype = MONQUIT;
401 }
402 strip_end(buf);
403 fprintf(stdout, "%s\n", buf);
404 if((moncmdl = monlinetok(buf)) != NULL) {
405 cmdtype = monitorcmd(moncmdl->cmd, moncmdl->args);
406 free_moncmdline(moncmdl);
407 }
408 FREE(buf);
409 if(cmdtype == MONQUIT) {
410 exit(monquit());
411 }
412 } while(cmdtype == MONREPEAT);
413 }