1 /* trace.c --- tracing output for the RL78 simulator. 2 3 Copyright (C) 2005-2017 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 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 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 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 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 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 * 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 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 (current_bfd, 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 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