1 /* trace.c --- tracing output for the MSP430 simulator.
3 Copyright (C) 2005-2015 Free Software Foundation, Inc.
4 Contributed by Red Hat, Inc.
6 This file is part of the GNU simulators.
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.
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.
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/>.
28 #include <sys/types.h>
32 #include "libiberty.h"
37 sim_dis_read (bfd_vma memaddr, bfd_byte * ptr, unsigned int length,
38 struct disassemble_info *info)
43 /* Filter out (in place) symbols that are useless for disassembly.
44 COUNT is the number of elements in SYMBOLS.
45 Return the number of useful symbols. */
48 remove_useless_symbols (asymbol ** symbols, long count)
50 asymbol **in_ptr = symbols, **out_ptr = symbols;
54 asymbol *sym = *in_ptr ++;
56 if (strstr (sym->name, "gcc2_compiled"))
58 if (sym->name == NULL || sym->name[0] == '\0')
60 if (sym->flags & (BSF_DEBUGGING))
62 if (bfd_is_und_section (sym->section)
63 || bfd_is_com_section (sym->section))
66 if (sym->name[0] == '.' && sym->name[1] == 'L')
69 /* If the symbol ends in ^A or ^B it is
70 an assembler generated local label. */
71 if (sym->name[strlen (sym->name) - 1] < 32)
76 return out_ptr - symbols;
80 compare_symbols (const PTR ap, const PTR bp)
82 const asymbol *a = *(const asymbol **) ap;
83 const asymbol *b = *(const asymbol **) bp;
85 if (bfd_asymbol_value (a) > bfd_asymbol_value (b))
87 else if (bfd_asymbol_value (a) < bfd_asymbol_value (b))
92 static char opbuf[1000];
95 op_printf (char *buf, char *fmt, ...)
101 ret = vsprintf (opbuf + strlen (opbuf), fmt, ap);
106 static bfd * current_bfd = NULL;
107 static asymbol ** symtab = NULL;
108 static int symcount = 0;
109 static asection * code_section = NULL;
110 static bfd_vma code_base = 0;
111 static struct disassemble_info info;
114 msp430_trace_init (bfd *prog)
130 load_file_and_line (const char *filename, int lineno)
133 for (f = files; f; f = f->next)
134 if (strcmp (f->filename, filename) == 0)
140 const char *found_filename, *slash;
142 found_filename = filename;
145 if (stat (found_filename, &s) == 0)
147 slash = strchr (found_filename, '/');
150 found_filename = slash + 1;
153 f = (Files *) xmalloc (sizeof (Files));
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;
164 for (i = 0; i < s.st_size; i ++)
165 if (f->data[i] == '\n')
167 f->lines = (char **) xmalloc (f->nlines * sizeof (char *));
168 f->lines[0] = f->data;
170 for (i = 0; i < s.st_size; i ++)
171 if (f->data[i] == '\n')
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] ++;
181 if (lineno < 1 || lineno > f->nlines)
183 return f->lines[lineno - 1];
187 msp430_get_current_source_location (int mypc,
188 const char ** pfilename,
189 const char ** pfunctionname,
190 unsigned int * plineno)
192 static int initted = 0;
194 if (current_bfd == NULL)
206 memset (& info, 0, sizeof (info));
207 INIT_DISASSEMBLE_INFO (info, stdout, op_printf);
208 info.read_memory_func = sim_dis_read;
209 info.arch = bfd_get_arch (current_bfd);
210 info.mach = bfd_get_mach (current_bfd);
212 info.arch = bfd_arch_msp430;
214 disassemble_init_for_target (& info);
216 storage = bfd_get_symtab_upper_bound (current_bfd);
219 symtab = (asymbol **) xmalloc (storage);
220 symcount = bfd_canonicalize_symtab (current_bfd, symtab);
221 symcount = remove_useless_symbols (symtab, symcount);
222 qsort (symtab, symcount, sizeof (asymbol *), compare_symbols);
225 for (s = current_bfd->sections; s; s = s->next)
227 if (s->flags & SEC_CODE || code_section == 0)
230 code_base = bfd_section_lma (current_bfd, s);
236 *pfilename = *pfunctionname = NULL;
239 bfd_find_nearest_line
240 (current_bfd, code_section, symtab, mypc - code_base,
241 pfilename, pfunctionname, plineno);
247 msp430_trace_one (int mypc)
249 static int last_sym = -1;
250 static const char * prev_filename = "";
251 static int prev_lineno = 0;
252 const char * filename;
253 const char * functionname;
258 if (! msp430_get_current_source_location (mypc, & filename, & functionname, & lineno))
261 if (filename && functionname && lineno)
263 if (lineno != prev_lineno || strcmp (prev_filename, filename))
265 char * the_line = load_file_and_line (filename, lineno);
266 const char * slash = strrchr (filename, '/');
273 (stderr, "========================================"
274 "=====================================\n");
275 fprintf (stderr, "\033[37;41m %s:%d: \033[33;40m %s\033[K\033[0m\n",
276 slash, lineno, the_line);
278 prev_lineno = lineno;
279 prev_filename = filename;
284 while (min < max - 1)
288 sym = (min + max) / 2;
289 sa = bfd_asymbol_value (symtab[sym]);
290 /*printf ("checking %4d %08x %s\n",
291 sym, sa, bfd_asymbol_name (symtab[sym])); */
303 if (min != -1 && min != last_sym)
305 bestaddr = bfd_asymbol_value (symtab[min]);
306 fprintf (stderr, "\033[43;30m%s", bfd_asymbol_name (symtab[min]));
307 if (bestaddr != mypc)
308 fprintf (stderr, "+%d", mypc - bestaddr);
309 fprintf (stderr, ":\t\t\t\033[0m\n");
313 if (strcmp (bfd_asymbol_name (symtab[min]), "abort") == 0
314 || strcmp (bfd_asymbol_name (symtab[min]), "exit") == 0)