src/target/trace.c

   1 /***************************************************************************
   2  *   Copyright (C) 2005, 2007 by Dominic Rath                              *
   3  *   Dominic.Rath@gmx.de                                                   *
   4  *                                                                         *
   5  *   This program is free software; you can redistribute it and/or modify  *
   6  *   it under the terms of the GNU General Public License as published by  *
   7  *   the Free Software Foundation; either version 2 of the License, or     *
   8  *   (at your option) any later version.                                   *
   9  *                                                                         *
  10  *   This program is distributed in the hope that it will be useful,       *
  11  *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
  12  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
  13  *   GNU General Public License for more details.                          *
  14  *                                                                         *
  15  *   You should have received a copy of the GNU General Public License     *
  16  *   along with this program; if not, write to the                         *
  17  *   Free Software Foundation, Inc.,                                       *
  18  *   51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.           *
  19  ***************************************************************************/
  20
  21 #ifdef HAVE_CONFIG_H
  22 #include "config.h"
  23 #endif
  24
  25 #include <helper/log.h>
  26 #include "trace.h"
  27 #include "target.h"
  28
  29 int trace_point(struct target *target, uint32_t number)
  30 {
  31         struct trace *trace = target->trace_info;
  32
  33         LOG_DEBUG("tracepoint: %i", (int)number);
  34
  35         if (number < trace->num_trace_points)
  36                 trace->trace_points[number].hit_counter++;
  37
  38         if (trace->trace_history_size) {
  39                 trace->trace_history[trace->trace_history_pos++] = number;
  40                 if (trace->trace_history_pos == trace->trace_history_size) {
  41                         trace->trace_history_pos = 0;
  42                         trace->trace_history_overflowed = 1;
  43                 }
  44         }
  45
  46         return ERROR_OK;
  47 }
  48
  49 COMMAND_HANDLER(handle_trace_point_command)
  50 {
  51         struct target *target = get_current_target(CMD_CTX);
  52         struct trace *trace = target->trace_info;
  53
  54         if (CMD_ARGC == 0) {
  55                 uint32_t i;
  56
  57                 for (i = 0; i < trace->num_trace_points; i++) {
  58                         command_print(CMD_CTX, "trace point 0x%8.8" PRIx32 " (%lld times hit)",
  59                                         trace->trace_points[i].address,
  60                                         (long long)trace->trace_points[i].hit_counter);
  61                 }
  62
  63                 return ERROR_OK;
  64         }
  65
  66         if (!strcmp(CMD_ARGV[0], "clear")) {
  67                 if (trace->trace_points) {
  68                         free(trace->trace_points);
  69                         trace->trace_points = NULL;
  70                 }
  71                 trace->num_trace_points = 0;
  72                 trace->trace_points_size = 0;
  73
  74                 return ERROR_OK;
  75         }
  76
  77         /* resize array if necessary */
  78         if (!trace->trace_points || (trace->trace_points_size == trace->num_trace_points)) {
  79                 trace->trace_points = realloc(trace->trace_points,
  80                                 sizeof(struct trace_point) * (trace->trace_points_size + 32));
  81                 trace->trace_points_size += 32;
  82         }
  83
  84         uint32_t address;
  85         COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], address);
  86         trace->trace_points[trace->num_trace_points].address = address;
  87         trace->trace_points[trace->num_trace_points].hit_counter = 0;
  88         trace->num_trace_points++;
  89
  90         return ERROR_OK;
  91 }
  92
  93 COMMAND_HANDLER(handle_trace_history_command)
  94 {
  95         struct target *target = get_current_target(CMD_CTX);
  96         struct trace *trace = target->trace_info;
  97
  98         if (CMD_ARGC > 0) {
  99                 trace->trace_history_pos = 0;
 100                 trace->trace_history_overflowed = 0;
 101
 102                 if (!strcmp(CMD_ARGV[0], "clear")) {
 103                         /* clearing is implicit, we've just reset position anyway */
 104                         return ERROR_OK;
 105                 }
 106
 107                 if (trace->trace_history)
 108                         free(trace->trace_history);
 109
 110                 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], trace->trace_history_size);
 111                 trace->trace_history = malloc(sizeof(uint32_t) * trace->trace_history_size);
 112
 113                 command_print(CMD_CTX, "new trace history size: %i", (int)(trace->trace_history_size));
 114         } else {
 115                 uint32_t i;
 116                 uint32_t first = 0;
 117                 uint32_t last = trace->trace_history_pos;
 118
 119                 if (!trace->trace_history_size) {
 120                         command_print(CMD_CTX, "trace history buffer is not allocated");
 121                         return ERROR_OK;
 122                 }
 123
 124                 if (trace->trace_history_overflowed) {
 125                         first = trace->trace_history_pos;
 126                         last = trace->trace_history_pos - 1;
 127                 }
 128
 129                 for (i = first; (i % trace->trace_history_size) != last; i++) {
 130                         if (trace->trace_history[i % trace->trace_history_size] < trace->num_trace_points) {
 131                                 uint32_t address;
 132                                 address = trace->trace_points[trace->trace_history[i % trace->trace_history_size]].address;
 133                                 command_print(CMD_CTX, "trace point %i: 0x%8.8" PRIx32 "",
 134                                                 (int)(trace->trace_history[i % trace->trace_history_size]),
 135                                                 address);
 136                         } else
 137                                 command_print(CMD_CTX, "trace point %i: -not defined-",
 138                                                 (int)(trace->trace_history[i % trace->trace_history_size]));
 139                 }
 140         }
 141
 142         return ERROR_OK;
 143 }
 144
 145 static const struct command_registration trace_exec_command_handlers[] = {
 146         {
 147                 .name = "history",
 148                 .handler = handle_trace_history_command,
 149                 .mode = COMMAND_EXEC,
 150                 .help = "display trace history, clear history or set size",
 151                 .usage = "['clear'|size]",
 152         },
 153         {
 154                 .name = "point",
 155                 .handler = handle_trace_point_command,
 156                 .mode = COMMAND_EXEC,
 157                 .help = "display trace points, clear list of trace points, "
 158                         "or add new tracepoint at address",
 159                 .usage = "['clear'|address]",
 160         },
 161         COMMAND_REGISTRATION_DONE
 162 };
 163 static const struct command_registration trace_command_handlers[] = {
 164         {
 165                 .name = "trace",
 166                 .mode = COMMAND_EXEC,
 167                 .help = "trace command group",
 168                 .usage = "",
 169                 .chain = trace_exec_command_handlers,
 170         },
 171         COMMAND_REGISTRATION_DONE
 172 };
 173
 174 int trace_register_commands(struct command_context *cmd_ctx)
 175 {
 176         return register_commands(cmd_ctx, NULL, trace_command_handlers);
 177 }