93925cd1a4827e5a2eba46b95adaf133f932fd7a
[openocd.git] / 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 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
19 ***************************************************************************/
20 #ifdef HAVE_CONFIG_H
21 #include "config.h"
22 #endif
23
24 #include "replacements.h"
25 #include "log.h"
26 #include "trace.h"
27 #include "target.h"
28 #include "command.h"
29
30 #include <stdlib.h>
31 #include <string.h>
32 #include <inttypes.h>
33
34 int trace_point(target_t *target, int number)
35 {
36 trace_t *trace = target->trace_info;
37
38 LOG_DEBUG("tracepoint: %i", number);
39
40 if (number < trace->num_trace_points)
41 trace->trace_points[number].hit_counter++;
42
43 if (trace->trace_history_size)
44 {
45 trace->trace_history[trace->trace_history_pos++] = number;
46 if (trace->trace_history_pos == trace->trace_history_size)
47 {
48 trace->trace_history_pos = 0;
49 trace->trace_history_overflowed = 1;
50 }
51 }
52
53 return ERROR_OK;
54 }
55
56 int handle_trace_point_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
57 {
58 target_t *target = get_current_target(cmd_ctx);
59 trace_t *trace = target->trace_info;
60
61 if (argc == 0)
62 {
63 int i;
64
65 for (i = 0; i < trace->num_trace_points; i++)
66 {
67 command_print(cmd_ctx, "trace point 0x%8.8x (%"PRIi64" times hit)",
68 trace->trace_points[i].address,
69 trace->trace_points[i].hit_counter);
70 }
71
72 return ERROR_OK;
73 }
74
75 if (!strcmp(args[0], "clear"))
76 {
77 if (trace->trace_points)
78 {
79 free(trace->trace_points);
80 trace->trace_points = NULL;
81 }
82 trace->num_trace_points = 0;
83 trace->trace_points_size = 0;
84
85 return ERROR_OK;
86 }
87
88 /* resize array if necessary */
89 if (!trace->trace_points || (trace->trace_points_size == trace->num_trace_points))
90 {
91 trace->trace_points = realloc(trace->trace_points, sizeof(trace_point_t) * (trace->trace_points_size + 32));
92 trace->trace_points_size += 32;
93 }
94
95 trace->trace_points[trace->num_trace_points].address = strtoul(args[0], NULL, 0);
96 trace->trace_points[trace->num_trace_points].hit_counter = 0;
97 trace->num_trace_points++;
98
99 return ERROR_OK;
100 }
101
102 int handle_trace_history_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
103 {
104 target_t *target = get_current_target(cmd_ctx);
105 trace_t *trace = target->trace_info;
106
107 if (argc > 0)
108 {
109 trace->trace_history_pos = 0;
110 trace->trace_history_overflowed = 0;
111
112 if (!strcmp(args[0], "clear"))
113 {
114 /* clearing is implicit, we've just reset position anyway */
115 return ERROR_OK;
116 }
117
118 if (trace->trace_history)
119 free(trace->trace_history);
120
121 trace->trace_history_size = strtoul(args[0], NULL, 0);
122 trace->trace_history = malloc(sizeof(u32) * trace->trace_history_size);
123
124 command_print(cmd_ctx, "new trace history size: %i", trace->trace_history_size);
125 }
126 else
127 {
128 int i;
129 int first = 0;
130 int last = trace->trace_history_pos;
131
132 if ( !trace->trace_history_size ) {
133 command_print(cmd_ctx, "trace history buffer is not allocated");
134 return ERROR_OK;
135 }
136 if (trace->trace_history_overflowed)
137 {
138 first = trace->trace_history_pos;
139 last = trace->trace_history_pos - 1;
140 }
141
142 for (i = first; (i % trace->trace_history_size) != last; i++)
143 {
144 if (trace->trace_history[i % trace->trace_history_size] < trace->num_trace_points)
145 {
146 u32 address;
147 address = trace->trace_points[trace->trace_history[i % trace->trace_history_size]].address;
148 command_print(cmd_ctx, "trace point %i: 0x%8.8x",
149 trace->trace_history[i % trace->trace_history_size],
150 address);
151 }
152
153 else
154 {
155 command_print(cmd_ctx, "trace point %i: -not defined-", trace->trace_history[i % trace->trace_history_size]);
156 }
157 }
158 }
159
160 return ERROR_OK;
161 }
162
163 int trace_register_commands(struct command_context_s *cmd_ctx)
164 {
165 command_t *trace_cmd =
166 register_command(cmd_ctx, NULL, "trace", NULL, COMMAND_ANY, "trace commands");
167
168 register_command(cmd_ctx, trace_cmd, "history", handle_trace_history_command,
169 COMMAND_EXEC, "display trace history, ['clear'] history or set [size]");
170
171 register_command(cmd_ctx, trace_cmd, "point", handle_trace_point_command,
172 COMMAND_EXEC, "display trace points, ['clear'] list of trace points, or add new tracepoint at [address]");
173
174 return ERROR_OK;
175 }