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