X-Git-Url: https://review.openocd.org/gitweb?p=openocd.git;a=blobdiff_plain;f=src%2Ftarget%2Ftrace.c;h=9c2d3698cff5e2035be93f0ced3b2242d4cd70cf;hp=3eec3d8335300244dd25d2e90fc3243623152a24;hb=5c2f920cc792d40f449cf596b5729671d0414fa1;hpb=20e4e77cdf366dedac21ff5670c54291feadfc05 diff --git a/src/target/trace.c b/src/target/trace.c index 3eec3d8335..9c2d3698cf 100644 --- a/src/target/trace.c +++ b/src/target/trace.c @@ -15,55 +15,163 @@ * You should have received a copy of the GNU General Public License * * along with this program; if not, write to the * * Free Software Foundation, Inc., * - * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. * + * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. * ***************************************************************************/ + #ifdef HAVE_CONFIG_H #include "config.h" #endif -#include "replacements.h" -#include "log.h" +#include #include "trace.h" #include "target.h" -#include +int trace_point(struct target *target, uint32_t number) +{ + struct trace *trace = target->trace_info; + + LOG_DEBUG("tracepoint: %i", (int)number); + + if (number < trace->num_trace_points) + trace->trace_points[number].hit_counter++; + + if (trace->trace_history_size) { + trace->trace_history[trace->trace_history_pos++] = number; + if (trace->trace_history_pos == trace->trace_history_size) { + trace->trace_history_pos = 0; + trace->trace_history_overflowed = 1; + } + } + + return ERROR_OK; +} -int handle_trace_history_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc) +COMMAND_HANDLER(handle_trace_point_command) { - target_t *target = get_current_target(cmd_ctx); - trace_t *trace = target->trace_info; - - if (argc > 0) - { + struct target *target = get_current_target(CMD_CTX); + struct trace *trace = target->trace_info; + + if (CMD_ARGC == 0) { + uint32_t i; + + for (i = 0; i < trace->num_trace_points; i++) { + command_print(CMD_CTX, "trace point 0x%8.8" PRIx32 " (%lld times hit)", + trace->trace_points[i].address, + (long long)trace->trace_points[i].hit_counter); + } + + return ERROR_OK; + } + + if (!strcmp(CMD_ARGV[0], "clear")) { + if (trace->trace_points) { + free(trace->trace_points); + trace->trace_points = NULL; + } + trace->num_trace_points = 0; + trace->trace_points_size = 0; + + return ERROR_OK; + } + + /* resize array if necessary */ + if (!trace->trace_points || (trace->trace_points_size == trace->num_trace_points)) { + trace->trace_points = realloc(trace->trace_points, + sizeof(struct trace_point) * (trace->trace_points_size + 32)); + trace->trace_points_size += 32; + } + + uint32_t address; + COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], address); + trace->trace_points[trace->num_trace_points].address = address; + trace->trace_points[trace->num_trace_points].hit_counter = 0; + trace->num_trace_points++; + + return ERROR_OK; +} + +COMMAND_HANDLER(handle_trace_history_command) +{ + struct target *target = get_current_target(CMD_CTX); + struct trace *trace = target->trace_info; + + if (CMD_ARGC > 0) { + trace->trace_history_pos = 0; + trace->trace_history_overflowed = 0; + + if (!strcmp(CMD_ARGV[0], "clear")) { + /* clearing is implicit, we've just reset position anyway */ + return ERROR_OK; + } + if (trace->trace_history) free(trace->trace_history); - - trace->trace_history_size = strtoul(args[0], NULL, 0); - trace->trace_history = malloc(sizeof(u32) * trace->trace_history_size); - - command_print(cmd_ctx, "new trace history size: %i", trace->trace_history_size); - } - else - { - int i; - - for (i = 0; i < trace->trace_history_size; i++) - { - if (trace->trace_history[i] < trace->num_trace_points) - { - u32 address; - address = trace->trace_points[trace->trace_history[i]].address; - command_print(cmd_ctx, "trace point %i: 0x%8.8x", - trace->trace_history[i], - address); - } - - else - { - command_print(cmd_ctx, "trace point %i: -not defined-", trace->trace_history[i]); - } + + COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], trace->trace_history_size); + trace->trace_history = malloc(sizeof(uint32_t) * trace->trace_history_size); + + command_print(CMD_CTX, "new trace history size: %i", (int)(trace->trace_history_size)); + } else { + uint32_t i; + uint32_t first = 0; + uint32_t last = trace->trace_history_pos; + + if (!trace->trace_history_size) { + command_print(CMD_CTX, "trace history buffer is not allocated"); + return ERROR_OK; + } + + if (trace->trace_history_overflowed) { + first = trace->trace_history_pos; + last = trace->trace_history_pos - 1; + } + + for (i = first; (i % trace->trace_history_size) != last; i++) { + if (trace->trace_history[i % trace->trace_history_size] < trace->num_trace_points) { + uint32_t address; + address = trace->trace_points[trace->trace_history[i % trace->trace_history_size]].address; + command_print(CMD_CTX, "trace point %i: 0x%8.8" PRIx32 "", + (int)(trace->trace_history[i % trace->trace_history_size]), + address); + } else + command_print(CMD_CTX, "trace point %i: -not defined-", + (int)(trace->trace_history[i % trace->trace_history_size])); } } return ERROR_OK; } + +static const struct command_registration trace_exec_command_handlers[] = { + { + .name = "history", + .handler = handle_trace_history_command, + .mode = COMMAND_EXEC, + .help = "display trace history, clear history or set size", + .usage = "['clear'|size]", + }, + { + .name = "point", + .handler = handle_trace_point_command, + .mode = COMMAND_EXEC, + .help = "display trace points, clear list of trace points, " + "or add new tracepoint at address", + .usage = "['clear'|address]", + }, + COMMAND_REGISTRATION_DONE +}; +static const struct command_registration trace_command_handlers[] = { + { + .name = "trace", + .mode = COMMAND_EXEC, + .help = "trace command group", + .usage = "", + .chain = trace_exec_command_handlers, + }, + COMMAND_REGISTRATION_DONE +}; + +int trace_register_commands(struct command_context *cmd_ctx) +{ + return register_commands(cmd_ctx, NULL, trace_command_handlers); +}