| 1 | /* trace.c --- tracing output for the RX 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 | #include "config.h" |
| 23 | #include <stdio.h> |
| 24 | #include <stdarg.h> |
| 25 | #include <string.h> |
| 26 | #include <stdlib.h> |
| 27 | #include <sys/types.h> |
| 28 | #include <sys/stat.h> |
| 29 | #include <ctype.h> |
| 30 | |
| 31 | #include "bfd.h" |
| 32 | #include "dis-asm.h" |
| 33 | |
| 34 | #include "cpu.h" |
| 35 | #include "mem.h" |
| 36 | #include "load.h" |
| 37 | |
| 38 | static int |
| 39 | sim_dis_read (bfd_vma memaddr, bfd_byte * ptr, unsigned int length, |
| 40 | struct disassemble_info *info) |
| 41 | { |
| 42 | int i; |
| 43 | |
| 44 | if (rx_big_endian) |
| 45 | { |
| 46 | /* See load.c for an explanation of this. */ |
| 47 | for (i=0; i<length; i++) |
| 48 | ptr[i] = mem_get_qi ((memaddr + i) ^ 3); |
| 49 | } |
| 50 | else |
| 51 | mem_get_blk (memaddr, ptr, length); |
| 52 | return 0; |
| 53 | } |
| 54 | |
| 55 | /* Filter out (in place) symbols that are useless for disassembly. |
| 56 | COUNT is the number of elements in SYMBOLS. |
| 57 | Return the number of useful symbols. */ |
| 58 | |
| 59 | static long |
| 60 | remove_useless_symbols (asymbol ** symbols, long count) |
| 61 | { |
| 62 | register asymbol **in_ptr = symbols, **out_ptr = symbols; |
| 63 | |
| 64 | while (--count >= 0) |
| 65 | { |
| 66 | asymbol *sym = *in_ptr++; |
| 67 | |
| 68 | if (strstr (sym->name, "gcc2_compiled")) |
| 69 | continue; |
| 70 | if (sym->name == NULL || sym->name[0] == '\0') |
| 71 | continue; |
| 72 | if (sym->flags & (BSF_DEBUGGING)) |
| 73 | continue; |
| 74 | if (bfd_is_und_section (sym->section) |
| 75 | || bfd_is_com_section (sym->section)) |
| 76 | continue; |
| 77 | |
| 78 | *out_ptr++ = sym; |
| 79 | } |
| 80 | return out_ptr - symbols; |
| 81 | } |
| 82 | |
| 83 | static int |
| 84 | compare_symbols (const PTR ap, const PTR bp) |
| 85 | { |
| 86 | const asymbol *a = *(const asymbol **) ap; |
| 87 | const asymbol *b = *(const asymbol **) bp; |
| 88 | |
| 89 | if (bfd_asymbol_value (a) > bfd_asymbol_value (b)) |
| 90 | return 1; |
| 91 | else if (bfd_asymbol_value (a) < bfd_asymbol_value (b)) |
| 92 | return -1; |
| 93 | return 0; |
| 94 | } |
| 95 | |
| 96 | static char opbuf[1000]; |
| 97 | |
| 98 | static int |
| 99 | op_printf (char *buf, char *fmt, ...) |
| 100 | { |
| 101 | int ret; |
| 102 | va_list ap; |
| 103 | |
| 104 | va_start (ap, fmt); |
| 105 | ret = vsprintf (opbuf + strlen (opbuf), fmt, ap); |
| 106 | va_end (ap); |
| 107 | return ret; |
| 108 | } |
| 109 | |
| 110 | static bfd * current_bfd = NULL; |
| 111 | static asymbol ** symtab = NULL; |
| 112 | static int symcount = 0; |
| 113 | static asection * code_section = NULL; |
| 114 | static bfd_vma code_base = 0; |
| 115 | static struct disassemble_info info; |
| 116 | |
| 117 | void |
| 118 | sim_disasm_init (bfd *prog) |
| 119 | { |
| 120 | current_bfd = prog; |
| 121 | } |
| 122 | |
| 123 | typedef struct Files |
| 124 | { |
| 125 | struct Files *next; |
| 126 | char *filename; |
| 127 | int nlines; |
| 128 | char **lines; |
| 129 | char *data; |
| 130 | } Files; |
| 131 | Files *files = 0; |
| 132 | |
| 133 | static char * |
| 134 | load_file_and_line (const char *filename, int lineno) |
| 135 | { |
| 136 | Files *f; |
| 137 | for (f = files; f; f = f->next) |
| 138 | if (strcmp (f->filename, filename) == 0) |
| 139 | break; |
| 140 | if (!f) |
| 141 | { |
| 142 | int i; |
| 143 | struct stat s; |
| 144 | const char *found_filename, *slash; |
| 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 *) malloc (sizeof (Files)); |
| 158 | f->next = files; |
| 159 | files = f; |
| 160 | f->filename = strdup (filename); |
| 161 | f->data = (char *) malloc (s.st_size + 2); |
| 162 | FILE *file = fopen (found_filename, "rb"); |
| 163 | fread (f->data, 1, s.st_size, file); |
| 164 | f->data[s.st_size] = 0; |
| 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 **) malloc (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 = get_reg (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_rx; |
| 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 **) malloc (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; |
| 231 | code_base = bfd_section_lma (s); |
| 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 = get_reg (pc); |
| 260 | |
| 261 | if (! sim_get_current_source_location (& filename, & functionname, & lineno)) |
| 262 | return; |
| 263 | |
| 264 | trace = 0; |
| 265 | |
| 266 | if (filename && functionname && lineno) |
| 267 | { |
| 268 | if (lineno != prev_lineno || strcmp (prev_filename, filename)) |
| 269 | { |
| 270 | char * the_line = load_file_and_line (filename, lineno); |
| 271 | const char * slash = strrchr (filename, '/'); |
| 272 | |
| 273 | if (!slash) |
| 274 | slash = filename; |
| 275 | else |
| 276 | slash++; |
| 277 | printf |
| 278 | ("========================================" |
| 279 | "=====================================\n"); |
| 280 | printf ("\033[37;41m %s:%d: \033[33;40m %s\033[K\033[0m\n", |
| 281 | slash, lineno, the_line); |
| 282 | } |
| 283 | prev_lineno = lineno; |
| 284 | prev_filename = filename; |
| 285 | } |
| 286 | |
| 287 | min = -1; |
| 288 | max = symcount; |
| 289 | while (min < max - 1) |
| 290 | { |
| 291 | bfd_vma sa; |
| 292 | |
| 293 | sym = (min + max) / 2; |
| 294 | sa = bfd_asymbol_value (symtab[sym]); |
| 295 | /*printf("checking %4d %08x %s\n", |
| 296 | sym, sa, bfd_asymbol_name (symtab[sym])); */ |
| 297 | if (sa > mypc) |
| 298 | max = sym; |
| 299 | else if (sa < mypc) |
| 300 | min = sym; |
| 301 | else |
| 302 | { |
| 303 | min = sym; |
| 304 | break; |
| 305 | } |
| 306 | } |
| 307 | |
| 308 | if (min != -1 && min != last_sym) |
| 309 | { |
| 310 | bestaddr = bfd_asymbol_value (symtab[min]); |
| 311 | printf ("\033[43;30m%s", bfd_asymbol_name (symtab[min])); |
| 312 | if (bestaddr != mypc) |
| 313 | printf ("+%d", mypc - bestaddr); |
| 314 | printf (":\t\t\t\033[0m\n"); |
| 315 | last_sym = min; |
| 316 | #if 0 |
| 317 | if (trace == 1) |
| 318 | if (strcmp (bfd_asymbol_name (symtab[min]), "abort") == 0 |
| 319 | || strcmp (bfd_asymbol_name (symtab[min]), "exit") == 0) |
| 320 | trace = 0; |
| 321 | #endif |
| 322 | } |
| 323 | |
| 324 | opbuf[0] = 0; |
| 325 | #ifdef CYCLE_ACCURATE |
| 326 | printf ("\033[33m %04u %06x: ", (int)(regs.cycle_count % 10000), mypc); |
| 327 | #else |
| 328 | printf ("\033[33m %06x: ", mypc); |
| 329 | |
| 330 | #endif |
| 331 | |
| 332 | max = print_insn_rx (mypc, & info); |
| 333 | |
| 334 | for (i = 0; i < max; i++) |
| 335 | { |
| 336 | if (rx_big_endian) |
| 337 | printf ("%02x", mem_get_qi ((mypc + i) ^ 3)); |
| 338 | else |
| 339 | printf ("%02x", mem_get_qi (mypc + i)); |
| 340 | } |
| 341 | |
| 342 | do |
| 343 | { |
| 344 | printf (" "); |
| 345 | i ++; |
| 346 | } |
| 347 | while (i < 6); |
| 348 | |
| 349 | printf ("%-16s ", opbuf); |
| 350 | |
| 351 | printf ("\033[0m\n"); |
| 352 | trace = save_trace; |
| 353 | } |