sim/rl78/trace.c

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