Code Review / openocd.git / blob
? search:
summary | shortlog | log | commit | commitdiff | review | tree
history | raw | HEAD
build: cleanup src/target directory
[openocd.git] / src / target / target_request.c
1 /***************************************************************************
2 * Copyright (C) 2007 by Dominic Rath *
3 * Dominic.Rath@gmx.de *
4 * *
5 * Copyright (C) 2007,2008 Øyvind Harboe *
6 * oyvind.harboe@zylin.com *
7 * *
8 * Copyright (C) 2008 by Spencer Oliver *
9 * spen@spen-soft.co.uk *
10 * *
11 * This program is free software; you can redistribute it and/or modify *
12 * it under the terms of the GNU General Public License as published by *
13 * the Free Software Foundation; either version 2 of the License, or *
14 * (at your option) any later version. *
15 * *
16 * This program is distributed in the hope that it will be useful, *
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
19 * GNU General Public License for more details. *
20 * *
21 * You should have received a copy of the GNU General Public License *
22 * along with this program; if not, write to the *
23 * Free Software Foundation, Inc., *
24 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
25 ***************************************************************************/
26
27 #ifdef HAVE_CONFIG_H
28 #include "config.h"
29 #endif
30
31 #include <helper/log.h>
32 #include <helper/binarybuffer.h>
33
34 #include "target.h"
35 #include "target_request.h"
36 #include "target_type.h"
37 #include "trace.h"
38
39 static bool got_message;
40
41 bool target_got_message(void)
42 {
43 bool t = got_message;
44 got_message = false;
45 return t;
46 }
47
48 static int charmsg_mode;
49
50 static int target_asciimsg(struct target *target, uint32_t length)
51 {
52 char *msg = malloc(DIV_ROUND_UP(length + 1, 4) * 4);
53 struct debug_msg_receiver *c = target->dbgmsg;
54
55 target->type->target_request_data(target, DIV_ROUND_UP(length, 4), (uint8_t *)msg);
56 msg[length] = 0;
57
58 LOG_DEBUG("%s", msg);
59
60 while (c) {
61 command_print(c->cmd_ctx, "%s", msg);
62 c = c->next;
63 }
64
65 return ERROR_OK;
66 }
67
68 static int target_charmsg(struct target *target, uint8_t msg)
69 {
70 LOG_USER_N("%c", msg);
71
72 return ERROR_OK;
73 }
74
75 static int target_hexmsg(struct target *target, int size, uint32_t length)
76 {
77 uint8_t *data = malloc(DIV_ROUND_UP(length * size, 4) * 4);
78 char line[128];
79 int line_len;
80 struct debug_msg_receiver *c = target->dbgmsg;
81 uint32_t i;
82
83 LOG_DEBUG("size: %i, length: %i", (int)size, (int)length);
84
85 target->type->target_request_data(target, DIV_ROUND_UP(length * size, 4), (uint8_t *)data);
86
87 line_len = 0;
88 for (i = 0; i < length; i++) {
89 switch (size) {
90 case 4:
91 line_len += snprintf(line + line_len, 128 - line_len, "%8.8" PRIx32 " ", le_to_h_u32(data + (4*i)));
92 break;
93 case 2:
94 line_len += snprintf(line + line_len, 128 - line_len, "%4.4x ", le_to_h_u16(data + (2*i)));
95 break;
96 case 1:
97 line_len += snprintf(line + line_len, 128 - line_len, "%2.2x ", data[i]);
98 break;
99 }
100
101 if ((i%8 == 7) || (i == length - 1)) {
102 LOG_DEBUG("%s", line);
103
104 while (c) {
105 command_print(c->cmd_ctx, "%s", line);
106 c = c->next;
107 }
108 c = target->dbgmsg;
109 line_len = 0;
110 }
111 }
112
113 free(data);
114
115 return ERROR_OK;
116 }
117
118 /* handle requests from the target received by a target specific
119 * side-band channel (e.g. ARM7/9 DCC)
120 */
121 int target_request(struct target *target, uint32_t request)
122 {
123 target_req_cmd_t target_req_cmd = request & 0xff;
124
125 /* Record that we got a target message for back-off algorithm */
126 got_message = true;
127
128 if (charmsg_mode) {
129 target_charmsg(target, target_req_cmd);
130 return ERROR_OK;
131 }
132
133 switch (target_req_cmd) {
134 case TARGET_REQ_TRACEMSG:
135 trace_point(target, (request & 0xffffff00) >> 8);
136 break;
137 case TARGET_REQ_DEBUGMSG:
138 if (((request & 0xff00) >> 8) == 0)
139 target_asciimsg(target, (request & 0xffff0000) >> 16);
140 else
141 target_hexmsg(target, (request & 0xff00) >> 8, (request & 0xffff0000) >> 16);
142 break;
143 case TARGET_REQ_DEBUGCHAR:
144 target_charmsg(target, (request & 0x00ff0000) >> 16);
145 break;
146 /* case TARGET_REQ_SEMIHOSTING:
147 * break;
148 */
149 default:
150 LOG_ERROR("unknown target request: %2.2x", target_req_cmd);
151 break;
152 }
153
154 return ERROR_OK;
155 }
156
157 static int add_debug_msg_receiver(struct command_context *cmd_ctx, struct target *target)
158 {
159 struct debug_msg_receiver **p = &target->dbgmsg;
160
161 if (target == NULL)
162 return ERROR_COMMAND_SYNTAX_ERROR;
163
164 /* see if there's already a list */
165 if (*p) {
166 /* find end of linked list */
167 p = &target->dbgmsg;
168 while ((*p)->next)
169 p = &((*p)->next);
170 p = &((*p)->next);
171 }
172
173 /* add new debug message receiver */
174 (*p) = malloc(sizeof(struct debug_msg_receiver));
175 (*p)->cmd_ctx = cmd_ctx;
176 (*p)->next = NULL;
177
178 /* enable callback */
179 target->dbg_msg_enabled = 1;
180
181 return ERROR_OK;
182 }
183
184 static struct debug_msg_receiver *find_debug_msg_receiver(struct command_context *cmd_ctx,
185 struct target *target)
186 {
187 int do_all_targets = 0;
188
189 /* if no target has been specified search all of them */
190 if (target == NULL) {
191 /* if no targets haven been specified */
192 if (all_targets == NULL)
193 return NULL;
194
195 target = all_targets;
196 do_all_targets = 1;
197 }
198
199 /* so we target != null */
200 struct debug_msg_receiver **p = &target->dbgmsg;
201 do {
202 while (*p) {
203 if ((*p)->cmd_ctx == cmd_ctx)
204 return *p;
205 p = &((*p)->next);
206 }
207
208 target = target->next;
209 } while (target && do_all_targets);
210
211 return NULL;
212 }
213
214 int delete_debug_msg_receiver(struct command_context *cmd_ctx, struct target *target)
215 {
216 struct debug_msg_receiver **p;
217 struct debug_msg_receiver *c;
218 int do_all_targets = 0;
219
220 /* if no target has been specified search all of them */
221 if (target == NULL) {
222 /* if no targets haven been specified */
223 if (all_targets == NULL)
224 return ERROR_OK;
225
226 target = all_targets;
227 do_all_targets = 1;
228 }
229
230 do {
231 p = &target->dbgmsg;
232 c = *p;
233 while (c) {
234 struct debug_msg_receiver *next = c->next;
235 if (c->cmd_ctx == cmd_ctx) {
236 *p = next;
237 free(c);
238 if (*p == NULL) {
239 /* disable callback */
240 target->dbg_msg_enabled = 0;
241 }
242 return ERROR_OK;
243 } else
244 p = &(c->next);
245 c = next;
246 }
247
248 target = target->next;
249 } while (target && do_all_targets);
250
251 return ERROR_OK;
252 }
253
254 COMMAND_HANDLER(handle_target_request_debugmsgs_command)
255 {
256 struct target *target = get_current_target(CMD_CTX);
257
258 int receiving = 0;
259
260 /* see if reciever is already registered */
261 if (find_debug_msg_receiver(CMD_CTX, target) != NULL)
262 receiving = 1;
263
264 if (CMD_ARGC > 0) {
265 if (!strcmp(CMD_ARGV[0], "enable") || !strcmp(CMD_ARGV[0], "charmsg")) {
266 /* don't register if this command context is already receiving */
267 if (!receiving) {
268 receiving = 1;
269 add_debug_msg_receiver(CMD_CTX, target);
270 }
271 charmsg_mode = !strcmp(CMD_ARGV[0], "charmsg");
272 } else if (!strcmp(CMD_ARGV[0], "disable")) {
273 /* no need to delete a receiver if none is registered */
274 if (receiving) {
275 receiving = 0;
276 delete_debug_msg_receiver(CMD_CTX, target);
277 }
278 } else
279 return ERROR_COMMAND_SYNTAX_ERROR;
280 }
281
282 command_print(CMD_CTX, "receiving debug messages from current target %s",
283 (receiving) ? (charmsg_mode ? "charmsg" : "enabled") : "disabled");
284 return ERROR_OK;
285 }
286
287 static const struct command_registration target_req_exec_command_handlers[] = {
288 {
289 .name = "debugmsgs",
290 .handler = handle_target_request_debugmsgs_command,
291 .mode = COMMAND_EXEC,
292 .help = "display and/or modify reception of debug messages from target",
293 .usage = "['enable'|'charmsg'|'disable']",
294 },
295 COMMAND_REGISTRATION_DONE
296 };
297 static const struct command_registration target_req_command_handlers[] = {
298 {
299 .name = "target_request",
300 .mode = COMMAND_ANY,
301 .help = "target request command group",
302 .usage = "",
303 .chain = target_req_exec_command_handlers,
304 },
305 COMMAND_REGISTRATION_DONE
306 };
307
308 int target_request_register_commands(struct command_context *cmd_ctx)
309 {
310 return register_commands(cmd_ctx, NULL, target_req_command_handlers);
311 }
Open On-Chip Debugger

Linking to existing account procedure

If you already have an account and want to add another login method you MUST first sign in with your existing account and then change URL to read https://review.openocd.org/login/?link to get to this page again but this time it'll work for linking. Thank you.

SSH host keys fingerprints

1024 SHA256:YKx8b7u5ZWdcbp7/4AeXNaqElP49m6QrwfXaqQGJAOk gerrit-code-review@openocd.zylin.com (DSA)
384 SHA256:jHIbSQa4REvwCFG4cq5LBlBLxmxSqelQPem/EXIrxjk gerrit-code-review@openocd.org (ECDSA)
521 SHA256:UAOPYkU9Fjtcao0Ul/Rrlnj/OsQvt+pgdYSZ4jOYdgs gerrit-code-review@openocd.org (ECDSA)
256 SHA256:A13M5QlnozFOvTllybRZH6vm7iSt0XLxbA48yfc2yfY gerrit-code-review@openocd.org (ECDSA)
256 SHA256:spYMBqEYoAOtK7yZBrcwE8ZpYt6b68Cfh9yEVetvbXg gerrit-code-review@openocd.org (ED25519)
+--[ED25519 256]--+
|=..              |
|+o..   .         |
|*.o   . .        |
|+B . . .         |
|Bo. = o S        |
|Oo.+ + =         |
|oB=.* = . o      |
| =+=.+   + E     |
|. .=o   . o      |
+----[SHA256]-----+
2048 SHA256:0Onrb7/PHjpo6iVZ7xQX2riKN83FJ3KGU0TvI0TaFG4 gerrit-code-review@openocd.zylin.com (RSA)