1
2
3
13
14
15
16
17
18
26
27
28
34
35
36
37
38
39
40
41
42
43
44
45
46
47
51
52
53
54
55
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
99
100
101
102
103
104
105
108
109
110
111
112
113
114
115
116
117
121
122
142
143
144
145
146
147
148
149
150
151
152
153
154
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
238
239
240
241
242
243
244
245
246
247
248
252
253
254
255
256
257
274
275
276
277
278
279
280
290
300
301
/* ... */
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include <helper/log.h>
#include <helper/binarybuffer.h>
#include "target.h"
#include "target_request.h"
#include "target_type.h"
#include "trace.h"
6 includes
static bool got_message;
bool target_got_message(void)
{
bool t = got_message;
got_message = false;
return t;
}{ ... }
static int charmsg_mode;
static int target_asciimsg(struct target *target, uint32_t length)
{
char *msg = malloc(DIV_ROUND_UP(length + 1, 4) * 4);
struct debug_msg_receiver *c = target->dbgmsg;
target->type->target_request_data(target, DIV_ROUND_UP(length, 4), (uint8_t *)msg);
msg[length] = 0;
LOG_DEBUG("%s", msg);
while (c) {
command_output_text(c->cmd_ctx, msg);
c = c->next;
}while (c) { ... }
return ERROR_OK;
}{ ... }
static int target_charmsg(struct target *target, uint8_t msg)
{
LOG_USER_N("%c", msg);
return ERROR_OK;
}{ ... }
static int target_hexmsg(struct target *target, int size, uint32_t length)
{
uint8_t *data = malloc(DIV_ROUND_UP(length * size, 4) * 4);
char line[128];
int line_len;
struct debug_msg_receiver *c = target->dbgmsg;
uint32_t i;
LOG_DEBUG("size: %i, length: %i", (int)size, (int)length);
target->type->target_request_data(target, DIV_ROUND_UP(length * size, 4), (uint8_t *)data);
line_len = 0;
for (i = 0; i < length; i++) {
switch (size) {
case 4:
line_len += snprintf(line + line_len, 128 - line_len, "%8.8" PRIx32 " ", le_to_h_u32(data + (4*i)));
break;case 4:
case 2:
line_len += snprintf(line + line_len, 128 - line_len, "%4.4x ", le_to_h_u16(data + (2*i)));
break;case 2:
case 1:
line_len += snprintf(line + line_len, 128 - line_len, "%2.2x ", data[i]);
break;case 1:
}switch (size) { ... }
if ((i%8 == 7) || (i == length - 1)) {
LOG_DEBUG("%s", line);
while (c) {
command_output_text(c->cmd_ctx, line);
c = c->next;
}while (c) { ... }
c = target->dbgmsg;
line_len = 0;
}if ((i%8 == 7) || (i == length - 1)) { ... }
}for (i = 0; i < length; i++) { ... }
free(data);
return ERROR_OK;
}{ ... }
/* ... */
int target_request(struct target *target, uint32_t request)
{
target_req_cmd_t target_req_cmd = request & 0xff;
assert(target->type->target_request_data);
got_message = true;
if (charmsg_mode) {
target_charmsg(target, target_req_cmd);
return ERROR_OK;
}if (charmsg_mode) { ... }
switch (target_req_cmd) {
case TARGET_REQ_TRACEMSG:
trace_point(target, (request & 0xffffff00) >> 8);
break;case TARGET_REQ_TRACEMSG:
case TARGET_REQ_DEBUGMSG:
if (((request & 0xff00) >> 8) == 0)
target_asciimsg(target, (request & 0xffff0000) >> 16);
else
target_hexmsg(target, (request & 0xff00) >> 8, (request & 0xffff0000) >> 16);
break;case TARGET_REQ_DEBUGMSG:
case TARGET_REQ_DEBUGCHAR:
target_charmsg(target, (request & 0x00ff0000) >> 16);
break;
/* ... */
case TARGET_REQ_DEBUGCHAR: default:
LOG_ERROR("unknown target request: %2.2x", target_req_cmd);
break;default
}switch (target_req_cmd) { ... }
return ERROR_OK;
}{ ... }
static int add_debug_msg_receiver(struct command_context *cmd_ctx, struct target *target)
{
struct debug_msg_receiver **p = &target->dbgmsg;
if (!target)
return ERROR_COMMAND_SYNTAX_ERROR;
if (*p) {
while ((*p)->next)
p = &((*p)->next);
p = &((*p)->next);
}if (*p) { ... }
(*p) = malloc(sizeof(struct debug_msg_receiver));
(*p)->cmd_ctx = cmd_ctx;
(*p)->next = NULL;
target->dbg_msg_enabled = true;
return ERROR_OK;
}{ ... }
static struct debug_msg_receiver *find_debug_msg_receiver(struct command_context *cmd_ctx,
struct target *target)
{
int do_all_targets = 0;
if (!target) {
if (!all_targets)
return NULL;
target = all_targets;
do_all_targets = 1;
}if (!target) { ... }
struct debug_msg_receiver **p = &target->dbgmsg;
do {
while (*p) {
if ((*p)->cmd_ctx == cmd_ctx)
return *p;
p = &((*p)->next);
}while (*p) { ... }
target = target->next;
...} while (target && do_all_targets);
return NULL;
}{ ... }
int delete_debug_msg_receiver(struct command_context *cmd_ctx, struct target *target)
{
struct debug_msg_receiver **p;
struct debug_msg_receiver *c;
int do_all_targets = 0;
if (!target) {
if (!all_targets)
return ERROR_OK;
target = all_targets;
do_all_targets = 1;
}if (!target) { ... }
do {
p = &target->dbgmsg;
c = *p;
while (c) {
struct debug_msg_receiver *next = c->next;
if (c->cmd_ctx == cmd_ctx) {
*p = next;
free(c);
if (!*p) {
target->dbg_msg_enabled = false;
}if (!*p) { ... }
return ERROR_OK;
}if (c->cmd_ctx == cmd_ctx) { ... } else
p = &(c->next);
c = next;
}while (c) { ... }
target = target->next;
...} while (target && do_all_targets);
return ERROR_OK;
}{ ... }
COMMAND_HANDLER(handle_target_request_debugmsgs_command)
{
struct target *target = get_current_target(CMD_CTX);
int receiving = 0;
if (!target->type->target_request_data) {
LOG_ERROR("Target %s does not support target requests", target_name(target));
return ERROR_OK;
}if (!target->type->target_request_data) { ... }
if (find_debug_msg_receiver(CMD_CTX, target))
receiving = 1;
if (CMD_ARGC > 0) {
if (!strcmp(CMD_ARGV[0], "enable") || !strcmp(CMD_ARGV[0], "charmsg")) {
if (!receiving) {
receiving = 1;
add_debug_msg_receiver(CMD_CTX, target);
}if (!receiving) { ... }
charmsg_mode = !strcmp(CMD_ARGV[0], "charmsg");
}if (!strcmp(CMD_ARGV[0], "enable") || !strcmp(CMD_ARGV[0], "charmsg")) { ... } else if (!strcmp(CMD_ARGV[0], "disable")) {
if (receiving) {
receiving = 0;
delete_debug_msg_receiver(CMD_CTX, target);
}if (receiving) { ... }
}else if (!strcmp(CMD_ARGV[0], "disable")) { ... } else
return ERROR_COMMAND_SYNTAX_ERROR;
}if (CMD_ARGC > 0) { ... }
command_print(CMD, "receiving debug messages from current target %s",
(receiving) ? (charmsg_mode ? "charmsg" : "enabled") : "disabled");
return ERROR_OK;
}{ ... }
static const struct command_registration target_req_exec_command_handlers[] = {
{
.name = "debugmsgs",
.handler = handle_target_request_debugmsgs_command,
.mode = COMMAND_EXEC,
.help = "display and/or modify reception of debug messages from target",
.usage = "['enable'|'charmsg'|'disable']",
...},
COMMAND_REGISTRATION_DONE
...};
static const struct command_registration target_req_command_handlers[] = {
{
.name = "target_request",
.mode = COMMAND_ANY,
.help = "target request command group",
.usage = "",
.chain = target_req_exec_command_handlers,
...},
COMMAND_REGISTRATION_DONE
...};
int target_request_register_commands(struct command_context *cmd_ctx)
{
return register_commands(cmd_ctx, NULL, target_req_command_handlers);
}{ ... }