sim/m32c/trace.c

   1 /* trace.c --- tracing output for the M32C simulator.
   2
   3 Copyright (C) 2005, 2007 Free Software Foundation, Inc.
   4 Contributed by Red Hat, Inc.
   5
   6 This file is part of the GNU simulators.
   7
   8 The GNU simulators are free software; you can redistribute them and/or
   9 modify them under the terms of the GNU General Public License as
  10 published by the Free Software Foundation; either version 2 of the
  11 License, or (at your option) any later version.
  12
  13 The GNU simulators are distributed in the hope that they will be
  14 useful, but WITHOUT ANY WARRANTY; without even the implied warranty of
  15 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  16 General Public License for more details.
  17
  18 You should have received a copy of the GNU General Public License
  19 along with the GNU simulators; if not, write to the Free Software
  20 Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  21 02110-1301, USA  */
  22
  23
  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 "bfd.h"
  33 #include "dis-asm.h"
  34 #include "m32c-desc.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;
 104
 105 void
 106 sim_disasm_init (bfd *prog)
 107 {
 108   current_bfd = prog;
 109 }
 110
 111 typedef struct Files
 112 {
 113   struct Files *next;
 114   char *filename;
 115   int nlines;
 116   char **lines;
 117   char *data;
 118 } Files;
 119 Files *files = 0;
 120
 121 static char *
 122 load_file_and_line (const char *filename, int lineno)
 123 {
 124   Files *f;
 125   for (f = files; f; f = f->next)
 126     if (strcmp (f->filename, filename) == 0)
 127       break;
 128   if (!f)
 129     {
 130       int i;
 131       struct stat s;
 132       const char *found_filename, *slash;
 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 *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 ()
 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 (current_bfd, 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 }