Commit | Line | Data |
---|---|---|
87326c78 DD |
1 | /* trace.c --- tracing output for the RL78 simulator. |
2 | ||
3666a048 | 3 | Copyright (C) 2005-2021 Free Software Foundation, Inc. |
87326c78 DD |
4 | Contributed by Red Hat, Inc. |
5 | ||
6 | This file is part of the GNU simulators. | |
7 | ||
8 | This program is free software; you can redistribute it and/or modify | |
9 | it under the terms of the GNU General Public License as published by | |
10 | the Free Software Foundation; either version 3 of the License, or | |
11 | (at your option) any later version. | |
12 | ||
13 | This program is distributed in the hope that it will be useful, | |
14 | but WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
16 | GNU General Public License for more details. | |
17 | ||
18 | You should have received a copy of the GNU General Public License | |
19 | along with this program. If not, see <http://www.gnu.org/licenses/>. | |
20 | */ | |
21 | ||
6df01ab8 MF |
22 | /* This must come before any other includes. */ |
23 | #include "defs.h" | |
87326c78 | 24 | |
87326c78 DD |
25 | #include <stdio.h> |
26 | #include <stdarg.h> | |
27 | #include <string.h> | |
28 | #include <stdlib.h> | |
29 | #include <sys/types.h> | |
30 | #include <sys/stat.h> | |
31 | #include <ctype.h> | |
32 | ||
33 | #include "libiberty.h" | |
34 | #include "bfd.h" | |
35 | #include "dis-asm.h" | |
36 | ||
37 | #include "cpu.h" | |
38 | #include "mem.h" | |
39 | #include "load.h" | |
5318ba65 | 40 | #include "trace.h" |
87326c78 | 41 | |
0952813b DD |
42 | static disassembler_ftype rl78_disasm_fn = NULL; |
43 | ||
87326c78 DD |
44 | static int |
45 | sim_dis_read (bfd_vma memaddr, bfd_byte * ptr, unsigned int length, | |
46 | struct disassemble_info *info) | |
47 | { | |
48 | mem_get_blk (memaddr, ptr, length); | |
49 | return 0; | |
50 | } | |
51 | ||
52 | /* Filter out (in place) symbols that are useless for disassembly. | |
53 | COUNT is the number of elements in SYMBOLS. | |
54 | Return the number of useful symbols. */ | |
55 | ||
56 | static long | |
57 | remove_useless_symbols (asymbol ** symbols, long count) | |
58 | { | |
59 | register asymbol **in_ptr = symbols, **out_ptr = symbols; | |
60 | ||
61 | while (-- count >= 0) | |
62 | { | |
63 | asymbol *sym = *in_ptr ++; | |
64 | ||
65 | if (strstr (sym->name, "gcc2_compiled")) | |
66 | continue; | |
67 | if (sym->name == NULL || sym->name[0] == '\0') | |
68 | continue; | |
69 | if (sym->flags & (BSF_DEBUGGING)) | |
70 | continue; | |
71 | if (bfd_is_und_section (sym->section) | |
72 | || bfd_is_com_section (sym->section)) | |
73 | continue; | |
74 | ||
75 | *out_ptr++ = sym; | |
76 | } | |
77 | return out_ptr - symbols; | |
78 | } | |
79 | ||
80 | static int | |
81 | compare_symbols (const PTR ap, const PTR bp) | |
82 | { | |
83 | const asymbol *a = *(const asymbol **) ap; | |
84 | const asymbol *b = *(const asymbol **) bp; | |
85 | ||
86 | if (bfd_asymbol_value (a) > bfd_asymbol_value (b)) | |
87 | return 1; | |
88 | else if (bfd_asymbol_value (a) < bfd_asymbol_value (b)) | |
89 | return -1; | |
90 | return 0; | |
91 | } | |
92 | ||
93 | static char opbuf[1000]; | |
94 | ||
95 | static int | |
96 | op_printf (char *buf, char *fmt, ...) | |
97 | { | |
98 | int ret; | |
99 | va_list ap; | |
100 | ||
101 | va_start (ap, fmt); | |
102 | ret = vsprintf (opbuf + strlen (opbuf), fmt, ap); | |
103 | va_end (ap); | |
104 | return ret; | |
105 | } | |
106 | ||
107 | static bfd * current_bfd = NULL; | |
108 | static asymbol ** symtab = NULL; | |
109 | static int symcount = 0; | |
110 | static asection * code_section = NULL; | |
111 | static bfd_vma code_base = 0; | |
112 | static struct disassemble_info info; | |
113 | ||
114 | void | |
115 | sim_disasm_init (bfd *prog) | |
116 | { | |
117 | current_bfd = prog; | |
0952813b | 118 | rl78_disasm_fn = NULL; |
87326c78 DD |
119 | } |
120 | ||
121 | typedef struct Files | |
122 | { | |
123 | struct Files *next; | |
124 | char *filename; | |
125 | int nlines; | |
126 | char **lines; | |
127 | char *data; | |
128 | } Files; | |
129 | Files *files = 0; | |
130 | ||
131 | static char * | |
132 | load_file_and_line (const char *filename, int lineno) | |
133 | { | |
134 | Files *f; | |
135 | for (f = files; f; f = f->next) | |
136 | if (strcmp (f->filename, filename) == 0) | |
137 | break; | |
138 | if (!f) | |
139 | { | |
140 | int i; | |
141 | struct stat s; | |
142 | const char *found_filename, *slash; | |
5318ba65 MF |
143 | FILE *file; |
144 | size_t ret; | |
87326c78 DD |
145 | |
146 | found_filename = filename; | |
147 | while (1) | |
148 | { | |
149 | if (stat (found_filename, &s) == 0) | |
150 | break; | |
151 | slash = strchr (found_filename, '/'); | |
152 | if (!slash) | |
153 | return ""; | |
154 | found_filename = slash + 1; | |
155 | } | |
156 | ||
157 | f = (Files *) xmalloc (sizeof (Files)); | |
158 | f->next = files; | |
159 | files = f; | |
160 | f->filename = xstrdup (filename); | |
161 | f->data = (char *) xmalloc (s.st_size + 2); | |
5318ba65 MF |
162 | file = fopen (found_filename, "rb"); |
163 | ret = fread (f->data, 1, s.st_size, file); | |
164 | f->data[ret] = 0; | |
87326c78 DD |
165 | fclose (file); |
166 | ||
167 | f->nlines = 1; | |
168 | for (i = 0; i < s.st_size; i ++) | |
169 | if (f->data[i] == '\n') | |
170 | f->nlines ++; | |
171 | f->lines = (char **) xmalloc (f->nlines * sizeof (char *)); | |
172 | f->lines[0] = f->data; | |
173 | f->nlines = 1; | |
174 | for (i = 0; i < s.st_size; i ++) | |
175 | if (f->data[i] == '\n') | |
176 | { | |
177 | f->lines[f->nlines] = f->data + i + 1; | |
178 | while (*f->lines[f->nlines] == ' ' | |
179 | || *f->lines[f->nlines] == '\t') | |
180 | f->lines[f->nlines] ++; | |
181 | f->nlines ++; | |
182 | f->data[i] = 0; | |
183 | } | |
184 | } | |
185 | if (lineno < 1 || lineno > f->nlines) | |
186 | return ""; | |
187 | return f->lines[lineno - 1]; | |
188 | } | |
189 | ||
190 | int | |
191 | sim_get_current_source_location (const char ** pfilename, | |
192 | const char ** pfunctionname, | |
193 | unsigned int * plineno) | |
194 | { | |
195 | static int initted = 0; | |
196 | int mypc = pc; | |
197 | ||
198 | if (current_bfd == NULL) | |
199 | return 0; | |
200 | ||
201 | if (!initted) | |
202 | { | |
203 | int storage; | |
204 | asection * s; | |
205 | ||
206 | initted = 1; | |
207 | memset (& info, 0, sizeof (info)); | |
208 | INIT_DISASSEMBLE_INFO (info, stdout, op_printf); | |
209 | info.read_memory_func = sim_dis_read; | |
210 | info.arch = bfd_get_arch (current_bfd); | |
211 | info.mach = bfd_get_mach (current_bfd); | |
212 | if (info.mach == 0) | |
213 | info.arch = bfd_arch_rl78; | |
214 | ||
215 | disassemble_init_for_target (& info); | |
216 | ||
217 | storage = bfd_get_symtab_upper_bound (current_bfd); | |
218 | if (storage > 0) | |
219 | { | |
220 | symtab = (asymbol **) xmalloc (storage); | |
221 | symcount = bfd_canonicalize_symtab (current_bfd, symtab); | |
222 | symcount = remove_useless_symbols (symtab, symcount); | |
223 | qsort (symtab, symcount, sizeof (asymbol *), compare_symbols); | |
224 | } | |
225 | ||
226 | for (s = current_bfd->sections; s; s = s->next) | |
227 | { | |
228 | if (s->flags & SEC_CODE || code_section == 0) | |
229 | { | |
230 | code_section = s; | |
fd361982 | 231 | code_base = bfd_section_lma (s); |
87326c78 DD |
232 | break; |
233 | } | |
234 | } | |
235 | } | |
236 | ||
237 | *pfilename = *pfunctionname = NULL; | |
238 | *plineno = 0; | |
239 | ||
240 | bfd_find_nearest_line | |
241 | (current_bfd, code_section, symtab, mypc - code_base, | |
242 | pfilename, pfunctionname, plineno); | |
243 | ||
244 | return 1; | |
245 | } | |
246 | ||
247 | void | |
248 | sim_disasm_one (void) | |
249 | { | |
250 | static int last_sym = -1; | |
251 | static const char * prev_filename = ""; | |
252 | static int prev_lineno = 0; | |
253 | const char * filename; | |
254 | const char * functionname; | |
255 | unsigned int lineno; | |
256 | int sym, bestaddr; | |
257 | int min, max, i; | |
258 | int save_trace = trace; | |
259 | int mypc = pc; | |
260 | ||
261 | if (! sim_get_current_source_location (& filename, & functionname, & lineno)) | |
262 | return; | |
263 | ||
264 | trace = 0; | |
265 | ||
0952813b DD |
266 | if (!rl78_disasm_fn) |
267 | { | |
268 | if (rl78_g10_mode) | |
269 | rl78_disasm_fn = print_insn_rl78_g10; | |
270 | else if (g14_multiply) | |
271 | rl78_disasm_fn = print_insn_rl78_g14; | |
272 | else if (g13_multiply) | |
273 | rl78_disasm_fn = print_insn_rl78_g13; | |
274 | else | |
275 | rl78_disasm_fn = print_insn_rl78; | |
276 | } | |
277 | ||
87326c78 DD |
278 | if (filename && functionname && lineno) |
279 | { | |
280 | if (lineno != prev_lineno || strcmp (prev_filename, filename)) | |
281 | { | |
282 | char * the_line = load_file_and_line (filename, lineno); | |
283 | const char * slash = strrchr (filename, '/'); | |
284 | ||
285 | if (!slash) | |
286 | slash = filename; | |
287 | else | |
288 | slash ++; | |
289 | printf | |
290 | ("========================================" | |
291 | "=====================================\n"); | |
292 | printf ("\033[37;41m %s:%d: \033[33;40m %s\033[K\033[0m\n", | |
293 | slash, lineno, the_line); | |
294 | } | |
295 | prev_lineno = lineno; | |
296 | prev_filename = filename; | |
297 | } | |
298 | ||
299 | min = -1; | |
300 | max = symcount; | |
301 | while (min < max - 1) | |
302 | { | |
303 | bfd_vma sa; | |
304 | ||
305 | sym = (min + max) / 2; | |
306 | sa = bfd_asymbol_value (symtab[sym]); | |
307 | /*printf ("checking %4d %08x %s\n", | |
308 | sym, sa, bfd_asymbol_name (symtab[sym])); */ | |
309 | if (sa > mypc) | |
310 | max = sym; | |
311 | else if (sa < mypc) | |
312 | min = sym; | |
313 | else | |
314 | { | |
315 | min = sym; | |
316 | break; | |
317 | } | |
318 | } | |
319 | ||
320 | if (min != -1 && min != last_sym) | |
321 | { | |
322 | bestaddr = bfd_asymbol_value (symtab[min]); | |
323 | printf ("\033[43;30m%s", bfd_asymbol_name (symtab[min])); | |
324 | if (bestaddr != mypc) | |
325 | printf ("+%d", mypc - bestaddr); | |
326 | printf (":\t\t\t\033[0m\n"); | |
327 | last_sym = min; | |
328 | #if 0 | |
329 | if (trace == 1) | |
330 | if (strcmp (bfd_asymbol_name (symtab[min]), "abort") == 0 | |
331 | || strcmp (bfd_asymbol_name (symtab[min]), "exit") == 0) | |
332 | trace = 0; | |
333 | #endif | |
334 | } | |
335 | ||
336 | #define TCR0 0xf0180 | |
337 | ||
338 | opbuf[0] = 0; | |
339 | #ifdef CYCLE_ACCURATE | |
340 | printf ("\033[33m %04u %06x: ", (int)(regs.cycle_count % 10000), mypc); | |
341 | #else | |
342 | printf ("\033[33m %08llx %06x: ", total_clocks, mypc); | |
343 | #endif | |
344 | ||
0952813b | 345 | max = rl78_disasm_fn (mypc, & info); |
87326c78 DD |
346 | |
347 | for (i = 0; i < max; i ++) | |
348 | printf ("%02x", mem_get_qi (mypc + i)); | |
349 | ||
350 | do | |
351 | { | |
352 | printf (" "); | |
353 | i ++; | |
354 | } | |
355 | while (i < 6); | |
356 | ||
357 | printf ("%-16s ", opbuf); | |
358 | ||
359 | printf ("\033[0m\n"); | |
360 | trace = save_trace; | |
361 | } |