+#include <string.h>
+#include <inttypes.h>
+
+int trace_point(target_t *target, int number)
+{
+ trace_t *trace = target->trace_info;
+
+ LOG_DEBUG("tracepoint: %i", 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_point_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
+{
+ target_t *target = get_current_target(cmd_ctx);
+ trace_t *trace = target->trace_info;
+
+ if (argc == 0)
+ {
+ int i;
+
+ for (i = 0; i < trace->num_trace_points; i++)
+ {
+ command_print(cmd_ctx, "trace point 0x%8.8x (%"PRIi64" times hit)",
+ trace->trace_points[i].address,
+ trace->trace_points[i].hit_counter);
+ }
+
+ return ERROR_OK;
+ }
+
+ if (!strcmp(args[0], "clear"))
+ {
+ if (trace->trace_points)
+ free(trace->trace_points);
+ 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(trace_point_t) * (trace->trace_points_size + 32));
+ trace->trace_points_size += 32;
+ }
+
+ trace->trace_points[trace->num_trace_points].address = strtoul(args[0], NULL, 0);
+ trace->trace_points[trace->num_trace_points].hit_counter = 0;
+ trace->num_trace_points++;
+
+ return ERROR_OK;
+}