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