target.c 125 KB
Newer Older
1
2
3
4
/***************************************************************************
 *   Copyright (C) 2005 by Dominic Rath                                    *
 *   Dominic.Rath@gmx.de                                                   *
 *                                                                         *
5
 *   Copyright (C) 2007-2009 Øyvind Harboe                                 *
6
7
 *   oyvind.harboe@zylin.com                                               *
 *                                                                         *
8
9
10
 *   Copyright (C) 2008, Duane Ellis                                       *
 *   openocd@duaneeellis.com                                               *
 *                                                                         *
11
12
13
 *   Copyright (C) 2008 by Spencer Oliver                                  *
 *   spen@spen-soft.co.uk                                                  *
 *                                                                         *
14
15
16
 *   Copyright (C) 2008 by Rick Altherr                                    *
 *   kc8apf@kc8apf.net>                                                    *
 *                                                                         *
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
 *   This program is free software; you can redistribute it and/or modify  *
 *   it under the terms of the GNU General Public License as published by  *
 *   the Free Software Foundation; either version 2 of the License, or     *
 *   (at your option) any later version.                                   *
 *                                                                         *
 *   This program is distributed in the hope that it will be useful,       *
 *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
 *   GNU General Public License for more details.                          *
 *                                                                         *
 *   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.             *
 ***************************************************************************/
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif

36
37
38
#include <helper/time_support.h>
#include <jtag/jtag.h>

39
#include "target.h"
40
#include "target_type.h"
41
#include "target_request.h"
42
#include "breakpoints.h"
43
44
45
#include "register.h"
#include "trace.h"
#include "image.h"
46
47


48
49
50
51
static int target_array2mem(Jim_Interp *interp, struct target *target,
		int argc, Jim_Obj *const *argv);
static int target_mem2array(Jim_Interp *interp, struct target *target,
		int argc, Jim_Obj *const *argv);
52

53
/* targets */
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
extern struct target_type arm7tdmi_target;
extern struct target_type arm720t_target;
extern struct target_type arm9tdmi_target;
extern struct target_type arm920t_target;
extern struct target_type arm966e_target;
extern struct target_type arm926ejs_target;
extern struct target_type fa526_target;
extern struct target_type feroceon_target;
extern struct target_type dragonite_target;
extern struct target_type xscale_target;
extern struct target_type cortexm3_target;
extern struct target_type cortexa8_target;
extern struct target_type arm11_target;
extern struct target_type mips_m4k_target;
extern struct target_type avr_target;
69
extern struct target_type dsp563xx_target;
Zachary T Welch's avatar
Zachary T Welch committed
70
extern struct target_type testee_target;
71
72

struct target_type *target_types[] =
73
74
75
76
77
78
79
{
	&arm7tdmi_target,
	&arm9tdmi_target,
	&arm920t_target,
	&arm720t_target,
	&arm966e_target,
	&arm926ejs_target,
80
	&fa526_target,
81
	&feroceon_target,
82
	&dragonite_target,
83
84
	&xscale_target,
	&cortexm3_target,
85
	&cortexa8_target,
oharboe's avatar
oharboe committed
86
	&arm11_target,
ntfreak's avatar
ntfreak committed
87
	&mips_m4k_target,
88
	&avr_target,
89
	&dsp563xx_target,
Zachary T Welch's avatar
Zachary T Welch committed
90
	&testee_target,
91
92
93
	NULL,
};

Zachary T Welch's avatar
Zachary T Welch committed
94
struct target *all_targets = NULL;
95
struct target_event_callback *target_event_callbacks = NULL;
96
struct target_timer_callback *target_timer_callbacks = NULL;
97

98
static const Jim_Nvp nvp_assert[] = {
99
100
101
102
103
104
105
	{ .name = "assert", NVP_ASSERT },
	{ .name = "deassert", NVP_DEASSERT },
	{ .name = "T", NVP_ASSERT },
	{ .name = "F", NVP_DEASSERT },
	{ .name = "t", NVP_ASSERT },
	{ .name = "f", NVP_DEASSERT },
	{ .name = NULL, .value = -1 }
106
107
};

108
static const Jim_Nvp nvp_error_target[] = {
109
110
111
112
113
114
115
116
117
118
119
120
121
122
	{ .value = ERROR_TARGET_INVALID, .name = "err-invalid" },
	{ .value = ERROR_TARGET_INIT_FAILED, .name = "err-init-failed" },
	{ .value = ERROR_TARGET_TIMEOUT, .name = "err-timeout" },
	{ .value = ERROR_TARGET_NOT_HALTED, .name = "err-not-halted" },
	{ .value = ERROR_TARGET_FAILURE, .name = "err-failure" },
	{ .value = ERROR_TARGET_UNALIGNED_ACCESS   , .name = "err-unaligned-access" },
	{ .value = ERROR_TARGET_DATA_ABORT , .name = "err-data-abort" },
	{ .value = ERROR_TARGET_RESOURCE_NOT_AVAILABLE , .name = "err-resource-not-available" },
	{ .value = ERROR_TARGET_TRANSLATION_FAULT  , .name = "err-translation-fault" },
	{ .value = ERROR_TARGET_NOT_RUNNING, .name = "err-not-running" },
	{ .value = ERROR_TARGET_NOT_EXAMINED, .name = "err-not-examined" },
	{ .value = -1, .name = NULL }
};

123
const char *target_strerror_safe(int err)
124
125
126
{
	const Jim_Nvp *n;

127
	n = Jim_Nvp_value2name_simple(nvp_error_target, err);
zwelch's avatar
zwelch committed
128
	if (n->name == NULL) {
129
130
131
132
133
134
		return "unknown";
	} else {
		return n->name;
	}
}

135
static const Jim_Nvp nvp_target_event[] = {
136
137
	{ .value = TARGET_EVENT_OLD_gdb_program_config , .name = "old-gdb_program_config" },
	{ .value = TARGET_EVENT_OLD_pre_resume         , .name = "old-pre_resume" },
138

139
	{ .value = TARGET_EVENT_GDB_HALT, .name = "gdb-halt" },
140
141
142
143
144
	{ .value = TARGET_EVENT_HALTED, .name = "halted" },
	{ .value = TARGET_EVENT_RESUMED, .name = "resumed" },
	{ .value = TARGET_EVENT_RESUME_START, .name = "resume-start" },
	{ .value = TARGET_EVENT_RESUME_END, .name = "resume-end" },

145
146
147
	{ .name = "gdb-start", .value = TARGET_EVENT_GDB_START },
	{ .name = "gdb-end", .value = TARGET_EVENT_GDB_END },

148
	/* historical name */
149

150
	{ .value = TARGET_EVENT_RESET_START, .name = "reset-start" },
151
152

	{ .value = TARGET_EVENT_RESET_ASSERT_PRE,    .name = "reset-assert-pre" },
153
	{ .value = TARGET_EVENT_RESET_ASSERT,        .name = "reset-assert" },
154
155
156
157
158
159
160
	{ .value = TARGET_EVENT_RESET_ASSERT_POST,   .name = "reset-assert-post" },
	{ .value = TARGET_EVENT_RESET_DEASSERT_PRE,  .name = "reset-deassert-pre" },
	{ .value = TARGET_EVENT_RESET_DEASSERT_POST, .name = "reset-deassert-post" },
	{ .value = TARGET_EVENT_RESET_HALT_PRE,      .name = "reset-halt-pre" },
	{ .value = TARGET_EVENT_RESET_HALT_POST,     .name = "reset-halt-post" },
	{ .value = TARGET_EVENT_RESET_WAIT_PRE,      .name = "reset-wait-pre" },
	{ .value = TARGET_EVENT_RESET_WAIT_POST,     .name = "reset-wait-post" },
161
162
	{ .value = TARGET_EVENT_RESET_INIT,          .name = "reset-init" },
	{ .value = TARGET_EVENT_RESET_END,           .name = "reset-end" },
163

164
	{ .value = TARGET_EVENT_EXAMINE_START, .name = "examine-start" },
165
	{ .value = TARGET_EVENT_EXAMINE_END, .name = "examine-end" },
166

167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
	{ .value = TARGET_EVENT_DEBUG_HALTED, .name = "debug-halted" },
	{ .value = TARGET_EVENT_DEBUG_RESUMED, .name = "debug-resumed" },

	{ .value = TARGET_EVENT_GDB_ATTACH, .name = "gdb-attach" },
	{ .value = TARGET_EVENT_GDB_DETACH, .name = "gdb-detach" },

	{ .value = TARGET_EVENT_GDB_FLASH_WRITE_START, .name = "gdb-flash-write-start" },
	{ .value = TARGET_EVENT_GDB_FLASH_WRITE_END  , .name = "gdb-flash-write-end"   },

	{ .value = TARGET_EVENT_GDB_FLASH_ERASE_START, .name = "gdb-flash-erase-start" },
	{ .value = TARGET_EVENT_GDB_FLASH_ERASE_END  , .name = "gdb-flash-erase-end" },

	{ .value = TARGET_EVENT_RESUME_START, .name = "resume-start" },
	{ .value = TARGET_EVENT_RESUMED     , .name = "resume-ok" },
	{ .value = TARGET_EVENT_RESUME_END  , .name = "resume-end" },

	{ .name = NULL, .value = -1 }
184
185
};

186
static const Jim_Nvp nvp_target_state[] = {
187
188
189
190
191
192
	{ .name = "unknown", .value = TARGET_UNKNOWN },
	{ .name = "running", .value = TARGET_RUNNING },
	{ .name = "halted",  .value = TARGET_HALTED },
	{ .name = "reset",   .value = TARGET_RESET },
	{ .name = "debug-running", .value = TARGET_DEBUG_RUNNING },
	{ .name = NULL, .value = -1 },
193
194
};

195
static const Jim_Nvp nvp_target_debug_reason [] = {
196
197
198
199
200
201
202
203
204
205
	{ .name = "debug-request"            , .value = DBG_REASON_DBGRQ },
	{ .name = "breakpoint"               , .value = DBG_REASON_BREAKPOINT },
	{ .name = "watchpoint"               , .value = DBG_REASON_WATCHPOINT },
	{ .name = "watchpoint-and-breakpoint", .value = DBG_REASON_WPTANDBKPT },
	{ .name = "single-step"              , .value = DBG_REASON_SINGLESTEP },
	{ .name = "target-not-halted"        , .value = DBG_REASON_NOTHALTED  },
	{ .name = "undefined"                , .value = DBG_REASON_UNDEFINED },
	{ .name = NULL, .value = -1 },
};

206
static const Jim_Nvp nvp_target_endian[] = {
207
208
209
	{ .name = "big",    .value = TARGET_BIG_ENDIAN },
	{ .name = "little", .value = TARGET_LITTLE_ENDIAN },
	{ .name = "be",     .value = TARGET_BIG_ENDIAN },
210
	{ .name = "le",     .value = TARGET_LITTLE_ENDIAN },
211
212
213
	{ .name = NULL,     .value = -1 },
};

214
static const Jim_Nvp nvp_reset_modes[] = {
215
216
217
218
219
220
221
	{ .name = "unknown", .value = RESET_UNKNOWN },
	{ .name = "run"    , .value = RESET_RUN },
	{ .name = "halt"   , .value = RESET_HALT },
	{ .name = "init"   , .value = RESET_INIT },
	{ .name = NULL     , .value = -1 },
};

222
223
224
225
226
227
228
229
230
231
232
233
234
const char *debug_reason_name(struct target *t)
{
	const char *cp;

	cp = Jim_Nvp_value2name_simple(nvp_target_debug_reason,
			t->debug_reason)->name;
	if (!cp) {
		LOG_ERROR("Invalid debug reason: %d", (int)(t->debug_reason));
		cp = "(*BUG*unknown*BUG*)";
	}
	return cp;
}

235
const char *
Zachary T Welch's avatar
Zachary T Welch committed
236
target_state_name( struct target *t )
237
238
239
240
241
242
243
244
245
246
{
	const char *cp;
	cp = Jim_Nvp_value2name_simple(nvp_target_state, t->state)->name;
	if( !cp ){
		LOG_ERROR("Invalid target state: %d", (int)(t->state));
		cp = "(*BUG*unknown*BUG*)";
	}
	return cp;
}

247
/* determine the number of the new target */
248
static int new_target_number(void)
249
{
Zachary T Welch's avatar
Zachary T Welch committed
250
	struct target *t;
251
252
253
254
255
	int x;

	/* number is 0 based */
	x = -1;
	t = all_targets;
zwelch's avatar
zwelch committed
256
257
	while (t) {
		if (x < t->target_number) {
258
259
260
261
			x = t->target_number;
		}
		t = t->next;
	}
zwelch's avatar
zwelch committed
262
	return x + 1;
263
264
}

265
/* read a uint32_t from a buffer in target memory endianness */
Zachary T Welch's avatar
Zachary T Welch committed
266
uint32_t target_buffer_get_u32(struct target *target, const uint8_t *buffer)
267
268
269
270
271
272
273
{
	if (target->endianness == TARGET_LITTLE_ENDIAN)
		return le_to_h_u32(buffer);
	else
		return be_to_h_u32(buffer);
}

zwelch's avatar
zwelch committed
274
/* read a uint16_t from a buffer in target memory endianness */
Zachary T Welch's avatar
Zachary T Welch committed
275
uint16_t target_buffer_get_u16(struct target *target, const uint8_t *buffer)
276
277
278
279
280
281
282
{
	if (target->endianness == TARGET_LITTLE_ENDIAN)
		return le_to_h_u16(buffer);
	else
		return be_to_h_u16(buffer);
}

283
/* read a uint8_t from a buffer in target memory endianness */
Zachary T Welch's avatar
Zachary T Welch committed
284
uint8_t target_buffer_get_u8(struct target *target, const uint8_t *buffer)
285
286
287
288
{
	return *buffer & 0x0ff;
}

289
/* write a uint32_t to a buffer in target memory endianness */
Zachary T Welch's avatar
Zachary T Welch committed
290
void target_buffer_set_u32(struct target *target, uint8_t *buffer, uint32_t value)
291
292
293
294
295
296
297
{
	if (target->endianness == TARGET_LITTLE_ENDIAN)
		h_u32_to_le(buffer, value);
	else
		h_u32_to_be(buffer, value);
}

zwelch's avatar
zwelch committed
298
/* write a uint16_t to a buffer in target memory endianness */
Zachary T Welch's avatar
Zachary T Welch committed
299
void target_buffer_set_u16(struct target *target, uint8_t *buffer, uint16_t value)
300
301
302
303
304
305
306
{
	if (target->endianness == TARGET_LITTLE_ENDIAN)
		h_u16_to_le(buffer, value);
	else
		h_u16_to_be(buffer, value);
}

307
/* write a uint8_t to a buffer in target memory endianness */
Zachary T Welch's avatar
Zachary T Welch committed
308
void target_buffer_set_u8(struct target *target, uint8_t *buffer, uint8_t value)
309
310
311
312
{
	*buffer = value;
}

313
/* return a pointer to a configured target; id is name or number */
Zachary T Welch's avatar
Zachary T Welch committed
314
struct target *get_target(const char *id)
315
{
Zachary T Welch's avatar
Zachary T Welch committed
316
	struct target *target;
317
318
319
320
321
322
323
324
325

	/* try as tcltarget name */
	for (target = all_targets; target; target = target->next) {
		if (target->cmd_name == NULL)
			continue;
		if (strcmp(id, target->cmd_name) == 0)
			return target;
	}

326
327
	/* It's OK to remove this fallback sometime after August 2010 or so */

328
	/* no match, try as number */
329
330
	unsigned num;
	if (parse_uint(id, &num) != ERROR_OK)
331
332
333
		return NULL;

	for (target = all_targets; target; target = target->next) {
334
335
336
		if (target->target_number == (int)num) {
			LOG_WARNING("use '%s' as target identifier, not '%u'",
					target->cmd_name, num);
337
			return target;
338
		}
339
340
341
342
343
	}

	return NULL;
}

344
/* returns a pointer to the n-th configured target */
Zachary T Welch's avatar
Zachary T Welch committed
345
static struct target *get_target_by_num(int num)
346
{
Zachary T Welch's avatar
Zachary T Welch committed
347
	struct target *target = all_targets;
348

zwelch's avatar
zwelch committed
349
350
	while (target) {
		if (target->target_number == num) {
351
			return target;
352
		}
353
354
355
356
357
358
		target = target->next;
	}

	return NULL;
}

359
struct target* get_current_target(struct command_context *cmd_ctx)
360
{
Zachary T Welch's avatar
Zachary T Welch committed
361
	struct target *target = get_target_by_num(cmd_ctx->current_target);
oharboe's avatar
oharboe committed
362

363
364
	if (target == NULL)
	{
365
		LOG_ERROR("BUG: current_target out of bounds");
366
367
368
		exit(-1);
	}

oharboe's avatar
oharboe committed
369
	return target;
370
371
}

Zachary T Welch's avatar
Zachary T Welch committed
372
int target_poll(struct target *target)
373
{
374
375
	int retval;

376
	/* We can't poll until after examine */
377
	if (!target_was_examined(target))
378
379
380
381
	{
		/* Fail silently lest we pollute the log */
		return ERROR_FAIL;
	}
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404

	retval = target->type->poll(target);
	if (retval != ERROR_OK)
		return retval;

	if (target->halt_issued)
	{
		if (target->state == TARGET_HALTED)
		{
			target->halt_issued = false;
		} else
		{
			long long t = timeval_ms() - target->halt_issued_time;
			if (t>1000)
			{
				target->halt_issued = false;
				LOG_INFO("Halt timed out, wake up GDB.");
				target_call_event_callbacks(target, TARGET_EVENT_GDB_HALT);
			}
		}
	}

	return ERROR_OK;
405
406
}

Zachary T Welch's avatar
Zachary T Welch committed
407
int target_halt(struct target *target)
408
{
409
	int retval;
410
	/* We can't poll until after examine */
411
	if (!target_was_examined(target))
412
413
414
415
	{
		LOG_ERROR("Target not examined yet");
		return ERROR_FAIL;
	}
416
417
418
419
420
421
422
423
424

	retval = target->type->halt(target);
	if (retval != ERROR_OK)
		return retval;

	target->halt_issued = true;
	target->halt_issued_time = timeval_ms();

	return ERROR_OK;
425
426
}

David Brownell's avatar
David Brownell committed
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
/**
 * Make the target (re)start executing using its saved execution
 * context (possibly with some modifications).
 *
 * @param target Which target should start executing.
 * @param current True to use the target's saved program counter instead
 *	of the address parameter
 * @param address Optionally used as the program counter.
 * @param handle_breakpoints True iff breakpoints at the resumption PC
 *	should be skipped.  (For example, maybe execution was stopped by
 *	such a breakpoint, in which case it would be counterprodutive to
 *	let it re-trigger.
 * @param debug_execution False if all working areas allocated by OpenOCD
 *	should be released and/or restored to their original contents.
 *	(This would for example be true to run some downloaded "helper"
 *	algorithm code, which resides in one such working buffer and uses
 *	another for data storage.)
 *
 * @todo Resolve the ambiguity about what the "debug_execution" flag
 * signifies.  For example, Target implementations don't agree on how
 * it relates to invalidation of the register cache, or to whether
 * breakpoints and watchpoints should be enabled.  (It would seem wrong
 * to enable breakpoints when running downloaded "helper" algorithms
 * (debug_execution true), since the breakpoints would be set to match
 * target firmware being debugged, not the helper algorithm.... and
 * enabling them could cause such helpers to malfunction (for example,
 * by overwriting data with a breakpoint instruction.  On the other
 * hand the infrastructure for running such helpers might use this
 * procedure but rely on hardware breakpoint to detect termination.)
 */
Zachary T Welch's avatar
Zachary T Welch committed
457
int target_resume(struct target *target, int current, uint32_t address, int handle_breakpoints, int debug_execution)
458
{
459
	int retval;
oharboe's avatar
oharboe committed
460

461
	/* We can't poll until after examine */
462
	if (!target_was_examined(target))
463
464
465
466
	{
		LOG_ERROR("Target not examined yet");
		return ERROR_FAIL;
	}
oharboe's avatar
oharboe committed
467

David Brownell's avatar
David Brownell committed
468
469
470
	/* note that resume *must* be asynchronous. The CPU can halt before
	 * we poll. The CPU can even halt at the current PC as a result of
	 * a software breakpoint being inserted by (a bug?) the application.
oharboe's avatar
oharboe committed
471
	 */
472
473
	if ((retval = target->type->resume(target, current, address, handle_breakpoints, debug_execution)) != ERROR_OK)
		return retval;
oharboe's avatar
oharboe committed
474

475
	return retval;
476
477
}

478
int target_process_reset(struct command_context *cmd_ctx, enum target_reset_mode reset_mode)
479
480
{
	char buf[100];
481
	int retval;
482
	Jim_Nvp *n;
483
	n = Jim_Nvp_value2name_simple(nvp_reset_modes, reset_mode);
zwelch's avatar
zwelch committed
484
	if (n->name == NULL) {
485
486
487
488
		LOG_ERROR("invalid reset mode");
		return ERROR_FAIL;
	}

489
490
491
492
	/* disable polling during reset to make reset event scripts
	 * more predictable, i.e. dr/irscan & pathmove in events will
	 * not have JTAG operations injected into the middle of a sequence.
	 */
493
494
495
	bool save_poll = jtag_poll_get_enabled();

	jtag_poll_set_enabled(false);
496

497
	sprintf(buf, "ocd_process_reset %s", n->name);
498
	retval = Jim_Eval(cmd_ctx->interp, buf);
499

500
	jtag_poll_set_enabled(save_poll);
501

zwelch's avatar
zwelch committed
502
	if (retval != JIM_OK) {
503
		Jim_PrintErrorMessage(cmd_ctx->interp);
504
505
		return ERROR_FAIL;
	}
506
507

	/* We want any events to be processed before the prompt */
508
	retval = target_call_timer_callbacks_now();
509

Øyvind Harboe's avatar
Øyvind Harboe committed
510
511
512
513
514
	struct target *target;
	for (target = all_targets; target; target = target->next) {
		target->type->check_reset(target);
	}

515
	return retval;
516
517
}

Zachary T Welch's avatar
Zachary T Welch committed
518
static int identity_virt2phys(struct target *target,
David Brownell's avatar
David Brownell committed
519
		uint32_t virtual, uint32_t *physical)
520
521
522
523
524
{
	*physical = virtual;
	return ERROR_OK;
}

Zachary T Welch's avatar
Zachary T Welch committed
525
static int no_mmu(struct target *target, int *enabled)
526
{
527
	*enabled = 0;
528
529
530
	return ERROR_OK;
}

Zachary T Welch's avatar
Zachary T Welch committed
531
static int default_examine(struct target *target)
532
{
533
	target_set_examined(target);
534
535
536
	return ERROR_OK;
}

Øyvind Harboe's avatar
Øyvind Harboe committed
537
538
539
540
541
542
/* no check by default */
static int default_check_reset(struct target *target)
{
	return ERROR_OK;
}

Zachary T Welch's avatar
Zachary T Welch committed
543
int target_examine_one(struct target *target)
zwelch's avatar
zwelch committed
544
545
546
547
{
	return target->type->examine(target);
}

zwelch's avatar
zwelch committed
548
549
static int jtag_enable_callback(enum jtag_event event, void *priv)
{
Zachary T Welch's avatar
Zachary T Welch committed
550
	struct target *target = priv;
zwelch's avatar
zwelch committed
551
552
553
554
555
556
557
558
559

	if (event != JTAG_TAP_EVENT_ENABLE || !target->tap->enabled)
		return ERROR_OK;

	jtag_unregister_event_callback(jtag_enable_callback, target);
	return target_examine_one(target);
}


zwelch's avatar
zwelch committed
560
/* Targets that correctly implement init + examine, i.e.
561
 * no communication with target during init:
oharboe's avatar
oharboe committed
562
563
 *
 * XScale
564
 */
ntfreak's avatar
ntfreak committed
565
int target_examine(void)
566
567
{
	int retval = ERROR_OK;
Zachary T Welch's avatar
Zachary T Welch committed
568
	struct target *target;
zwelch's avatar
zwelch committed
569
570

	for (target = all_targets; target; target = target->next)
571
	{
zwelch's avatar
zwelch committed
572
573
574
575
		/* defer examination, but don't skip it */
		if (!target->tap->enabled) {
			jtag_register_event_callback(jtag_enable_callback,
					target);
zwelch's avatar
zwelch committed
576
			continue;
zwelch's avatar
zwelch committed
577
		}
zwelch's avatar
zwelch committed
578
		if ((retval = target_examine_one(target)) != ERROR_OK)
579
580
581
582
			return retval;
	}
	return retval;
}
583
const char *target_type_name(struct target *target)
zwelch's avatar
zwelch committed
584
585
586
{
	return target->type->name;
}
587

Zachary T Welch's avatar
Zachary T Welch committed
588
static int target_write_memory_imp(struct target *target, uint32_t address, uint32_t size, uint32_t count, uint8_t *buffer)
589
{
590
	if (!target_was_examined(target))
591
592
593
594
595
596
597
	{
		LOG_ERROR("Target not examined yet");
		return ERROR_FAIL;
	}
	return target->type->write_memory_imp(target, address, size, count, buffer);
}

Zachary T Welch's avatar
Zachary T Welch committed
598
static int target_read_memory_imp(struct target *target, uint32_t address, uint32_t size, uint32_t count, uint8_t *buffer)
599
{
600
	if (!target_was_examined(target))
601
602
603
604
605
606
607
	{
		LOG_ERROR("Target not examined yet");
		return ERROR_FAIL;
	}
	return target->type->read_memory_imp(target, address, size, count, buffer);
}

Zachary T Welch's avatar
Zachary T Welch committed
608
static int target_soft_reset_halt_imp(struct target *target)
609
{
610
	if (!target_was_examined(target))
611
612
613
614
	{
		LOG_ERROR("Target not examined yet");
		return ERROR_FAIL;
	}
615
616
	if (!target->type->soft_reset_halt_imp) {
		LOG_ERROR("Target %s does not support soft_reset_halt",
617
				target_name(target));
618
619
		return ERROR_FAIL;
	}
620
621
622
	return target->type->soft_reset_halt_imp(target);
}

Zachary T Welch's avatar
Zachary T Welch committed
623
static int target_run_algorithm_imp(struct target *target, int num_mem_params, struct mem_param *mem_params, int num_reg_params, struct reg_param *reg_param, uint32_t entry_point, uint32_t exit_point, int timeout_ms, void *arch_info)
624
{
625
	if (!target_was_examined(target))
626
627
628
629
630
631
	{
		LOG_ERROR("Target not examined yet");
		return ERROR_FAIL;
	}
	return target->type->run_algorithm_imp(target, num_mem_params, mem_params, num_reg_params, reg_param, entry_point, exit_point, timeout_ms, arch_info);
}
632

Zachary T Welch's avatar
Zachary T Welch committed
633
int target_read_memory(struct target *target,
634
		uint32_t address, uint32_t size, uint32_t count, uint8_t *buffer)
zwelch's avatar
zwelch committed
635
636
637
638
{
	return target->type->read_memory(target, address, size, count, buffer);
}

Zachary T Welch's avatar
Zachary T Welch committed
639
int target_read_phys_memory(struct target *target,
640
641
642
643
644
		uint32_t address, uint32_t size, uint32_t count, uint8_t *buffer)
{
	return target->type->read_phys_memory(target, address, size, count, buffer);
}

Zachary T Welch's avatar
Zachary T Welch committed
645
int target_write_memory(struct target *target,
646
		uint32_t address, uint32_t size, uint32_t count, uint8_t *buffer)
zwelch's avatar
zwelch committed
647
648
649
{
	return target->type->write_memory(target, address, size, count, buffer);
}
650

Zachary T Welch's avatar
Zachary T Welch committed
651
int target_write_phys_memory(struct target *target,
652
653
654
655
656
		uint32_t address, uint32_t size, uint32_t count, uint8_t *buffer)
{
	return target->type->write_phys_memory(target, address, size, count, buffer);
}

Zachary T Welch's avatar
Zachary T Welch committed
657
int target_bulk_write_memory(struct target *target,
658
		uint32_t address, uint32_t count, uint8_t *buffer)
zwelch's avatar
zwelch committed
659
660
661
662
{
	return target->type->bulk_write_memory(target, address, count, buffer);
}

Zachary T Welch's avatar
Zachary T Welch committed
663
int target_add_breakpoint(struct target *target,
664
		struct breakpoint *breakpoint)
665
{
666
667
668
669
	if (target->state != TARGET_HALTED) {
		LOG_WARNING("target %s is not halted", target->cmd_name);
		return ERROR_TARGET_NOT_HALTED;
	}
670
671
	return target->type->add_breakpoint(target, breakpoint);
}
Zachary T Welch's avatar
Zachary T Welch committed
672
int target_remove_breakpoint(struct target *target,
673
		struct breakpoint *breakpoint)
674
675
676
677
{
	return target->type->remove_breakpoint(target, breakpoint);
}

Zachary T Welch's avatar
Zachary T Welch committed
678
int target_add_watchpoint(struct target *target,
679
		struct watchpoint *watchpoint)
680
{
681
682
683
684
	if (target->state != TARGET_HALTED) {
		LOG_WARNING("target %s is not halted", target->cmd_name);
		return ERROR_TARGET_NOT_HALTED;
	}
685
686
	return target->type->add_watchpoint(target, watchpoint);
}
Zachary T Welch's avatar
Zachary T Welch committed
687
int target_remove_watchpoint(struct target *target,
688
		struct watchpoint *watchpoint)
689
690
691
{
	return target->type->remove_watchpoint(target, watchpoint);
}
zwelch's avatar
zwelch committed
692

Zachary T Welch's avatar
Zachary T Welch committed
693
int target_get_gdb_reg_list(struct target *target,
Zachary T Welch's avatar
Zachary T Welch committed
694
		struct reg **reg_list[], int *reg_list_size)
zwelch's avatar
zwelch committed
695
696
697
{
	return target->type->get_gdb_reg_list(target, reg_list, reg_list_size);
}
Zachary T Welch's avatar
Zachary T Welch committed
698
int target_step(struct target *target,
699
		int current, uint32_t address, int handle_breakpoints)
zwelch's avatar
zwelch committed
700
701
702
703
{
	return target->type->step(target, current, address, handle_breakpoints);
}

zwelch's avatar
zwelch committed
704

Zachary T Welch's avatar
Zachary T Welch committed
705
int target_run_algorithm(struct target *target,
706
		int num_mem_params, struct mem_param *mem_params,
707
		int num_reg_params, struct reg_param *reg_param,
708
		uint32_t entry_point, uint32_t exit_point,
zwelch's avatar
zwelch committed
709
710
711
712
713
714
715
		int timeout_ms, void *arch_info)
{
	return target->type->run_algorithm(target,
			num_mem_params, mem_params, num_reg_params, reg_param,
			entry_point, exit_point, timeout_ms, arch_info);
}

716
717
718
719
720
/**
 * Reset the @c examined flag for the given target.
 * Pure paranoia -- targets are zeroed on allocation.
 */
static void target_reset_examined(struct target *target)
721
{
722
	target->examined = false;
723
724
}

725
static int
Zachary T Welch's avatar
Zachary T Welch committed
726
err_read_phys_memory(struct target *target, uint32_t address,
727
		uint32_t size, uint32_t count, uint8_t *buffer)
728
{
729
	LOG_ERROR("Not implemented: %s", __func__);
730
	return ERROR_FAIL;
731
732
}

733
static int
Zachary T Welch's avatar
Zachary T Welch committed
734
err_write_phys_memory(struct target *target, uint32_t address,
735
		uint32_t size, uint32_t count, uint8_t *buffer)
736
{
737
	LOG_ERROR("Not implemented: %s", __func__);
738
	return ERROR_FAIL;
739
740
}

741
742
static int handle_target(void *priv);

743
744
static int target_init_one(struct command_context *cmd_ctx,
		struct target *target)
745
{
746
	target_reset_examined(target);
oharboe's avatar
oharboe committed
747

748
749
750
	struct target_type *type = target->type;
	if (type->examine == NULL)
		type->examine = default_examine;
751

Øyvind Harboe's avatar
Øyvind Harboe committed
752
753
754
	if (type->check_reset== NULL)
		type->check_reset = default_check_reset;

755
756
757
758
759
760
	int retval = type->init_target(cmd_ctx, target);
	if (ERROR_OK != retval)
	{
		LOG_ERROR("target '%s' init failed", target_name(target));
		return retval;
	}
oharboe's avatar
oharboe committed
761

762
763
764
765
766
767
768
769
770
771
	/**
	 * @todo get rid of those *memory_imp() methods, now that all
	 * callers are using target_*_memory() accessors ... and make
	 * sure the "physical" paths handle the same issues.
	 */
	/* a non-invasive way(in terms of patches) to add some code that
	 * runs before the type->write/read_memory implementation
	 */
	type->write_memory_imp = target->type->write_memory;
	type->write_memory = target_write_memory_imp;
oharboe's avatar
oharboe committed
772

773
774
	type->read_memory_imp = target->type->read_memory;
	type->read_memory = target_read_memory_imp;
775

776
777
	type->soft_reset_halt_imp = target->type->soft_reset_halt;
	type->soft_reset_halt = target_soft_reset_halt_imp;
David Brownell's avatar
David Brownell committed
778

779
780
	type->run_algorithm_imp = target->type->run_algorithm;
	type->run_algorithm = target_run_algorithm_imp;
781

782
783
784
785
786
787
788
789
790
791
792
793
794
795
796
797
798
799
800
801
802
803
804
805
806
	/* Sanity-check MMU support ... stub in what we must, to help
	 * implement it in stages, but warn if we need to do so.
	 */
	if (type->mmu)
	{
		if (type->write_phys_memory == NULL)
		{
			LOG_ERROR("type '%s' is missing write_phys_memory",
					type->name);
			type->write_phys_memory = err_write_phys_memory;
		}
		if (type->read_phys_memory == NULL)
		{
			LOG_ERROR("type '%s' is missing read_phys_memory",
					type->name);
			type->read_phys_memory = err_read_phys_memory;
		}
		if (type->virt2phys == NULL)
		{
			LOG_ERROR("type '%s' is missing virt2phys", type->name);
			type->virt2phys = identity_virt2phys;
		}
	}
	else
	{
807
808
809
810
		/* Make sure no-MMU targets all behave the same:  make no
		 * distinction between physical and virtual addresses, and
		 * ensure that virt2phys() is always an identity mapping.
		 */
811
812
813
814
		if (type->write_phys_memory || type->read_phys_memory
				|| type->virt2phys)
		{
			LOG_WARNING("type '%s' has bad MMU hooks", type->name);
815
		}
816
817
818
819
820

		type->mmu = no_mmu;
		type->write_phys_memory = type->write_memory;
		type->read_phys_memory = type->read_memory;
		type->virt2phys = identity_virt2phys;
821
	}
822
823
	return ERROR_OK;
}
oharboe's avatar
oharboe committed
824

825
826
827
828
829
830
int target_init(struct command_context *cmd_ctx)
{
	struct target *target;
	int retval;

	for (target = all_targets; target; target = target->next)
831
	{
832
833
		retval = target_init_one(cmd_ctx, target);
		if (ERROR_OK != retval)
834
			return retval;
835
	}
oharboe's avatar
oharboe committed
836

837
838
839
840
841
842
843
844
845
846
847
848
	if (!all_targets)
		return ERROR_OK;

	retval = target_register_user_commands(cmd_ctx);
	if (ERROR_OK != retval)
		return retval;

	retval = target_register_timer_callback(&handle_target,
			100, 1, cmd_ctx->interp);
	if (ERROR_OK != retval)
		return retval;

849
850
851
	return ERROR_OK;
}

852
853
854
855
856
857
858
859
860
861
862
863
864
865
866
867
868
COMMAND_HANDLER(handle_target_init_command)
{
	if (CMD_ARGC != 0)
		return ERROR_COMMAND_SYNTAX_ERROR;

	static bool target_initialized = false;
	if (target_initialized)
	{
		LOG_INFO("'target init' has already been called");
		return ERROR_OK;
	}
	target_initialized = true;

	LOG_DEBUG("Initializing targets...");
	return target_init(CMD_CTX);
}

Zachary T Welch's avatar
Zachary T Welch committed
869
int target_register_event_callback(int (*callback)(struct target *target, enum target_event event, void *priv), void *priv)
870
{
871
	struct target_event_callback **callbacks_p = &target_event_callbacks;
oharboe's avatar
oharboe committed
872

873
874
875
876
	if (callback == NULL)
	{
		return ERROR_INVALID_ARGUMENTS;
	}
oharboe's avatar
oharboe committed
877

878
879
880
881
882
883
	if (*callbacks_p)
	{
		while ((*callbacks_p)->next)
			callbacks_p = &((*callbacks_p)->next);
		callbacks_p = &((*callbacks_p)->next);
	}
oharboe's avatar
oharboe committed
884

885
	(*callbacks_p) = malloc(sizeof(struct target_event_callback));
886
887
888
	(*callbacks_p)->callback = callback;
	(*callbacks_p)->priv = priv;
	(*callbacks_p)->next = NULL;
oharboe's avatar
oharboe committed
889

890
891
892
893
894
	return ERROR_OK;
}

int target_register_timer_callback(int (*callback)(void *priv), int time_ms, int periodic, void *priv)
{
895
	struct target_timer_callback **callbacks_p = &target_timer_callbacks;
896
	struct timeval now;
oharboe's avatar
oharboe committed
897

898
899
900
901
	if (callback == NULL)
	{
		return ERROR_INVALID_ARGUMENTS;
	}
oharboe's avatar
oharboe committed
902

903
904
905
906
907
908
	if (*callbacks_p)
	{
		while ((*callbacks_p)->next)
			callbacks_p = &((*callbacks_p)->next);
		callbacks_p = &((*callbacks_p)->next);
	}
oharboe's avatar
oharboe committed
909

910
	(*callbacks_p) = malloc(sizeof(struct target_timer_callback));
911
912
913
	(*callbacks_p)->callback = callback;
	(*callbacks_p)->periodic = periodic;
	(*callbacks_p)->time_ms = time_ms;
oharboe's avatar
oharboe committed
914

915
916
917
918
919
920
921
922
923
	gettimeofday(&now, NULL);
	(*callbacks_p)->when.tv_usec = now.tv_usec + (time_ms % 1000) * 1000;
	time_ms -= (time_ms % 1000);
	(*callbacks_p)->when.tv_sec = now.tv_sec + (time_ms / 1000);
	if ((*callbacks_p)->when.tv_usec > 1000000)
	{
		(*callbacks_p)->when.tv_usec = (*callbacks_p)->when.tv_usec - 1000000;
		(*callbacks_p)->when.tv_sec += 1;
	}
oharboe's avatar
oharboe committed
924

925
926
	(*callbacks_p)->priv = priv;
	(*callbacks_p)->next = NULL;
oharboe's avatar
oharboe committed
927

928
929
930
	return ERROR_OK;
}

Zachary T Welch's avatar
Zachary T Welch committed
931
int target_unregister_event_callback(int (*callback)(struct target *target, enum target_event event, void *priv), void *priv)
932
{
933
934
	struct target_event_callback **p = &target_event_callbacks;
	struct target_event_callback *c = target_event_callbacks;
oharboe's avatar
oharboe committed
935

936
937
938
939
	if (callback == NULL)
	{
		return ERROR_INVALID_ARGUMENTS;
	}
oharboe's avatar
oharboe committed
940

941
942
	while (c)
	{
943
		struct target_event_callback *next = c->next;
944
945
946
947
948
949
950
951
952
953
		if ((c->callback == callback) && (c->priv == priv))
		{
			*p = next;
			free(c);
			return ERROR_OK;
		}
		else
			p = &(c->next);
		c = next;
	}
oharboe's avatar
oharboe committed
954

955
956
957
958
959
	return ERROR_OK;
}

int target_unregister_timer_callback(int (*callback)(void *priv), void *priv)
{
960
961
	struct target_timer_callback **p = &target_timer_callbacks;
	struct target_timer_callback *c = target_timer_callbacks;
oharboe's avatar
oharboe committed
962

963
964
965
966
	if (callback == NULL)
	{
		return ERROR_INVALID_ARGUMENTS;
	}
oharboe's avatar
oharboe committed
967

968
969
	while (c)
	{
970
		struct target_timer_callback *next = c->next;
971
972
973
974
975
976
977
978
979
980
		if ((c->callback == callback) && (c->priv == priv))
		{
			*p = next;
			free(c);
			return ERROR_OK;
		}
		else
			p = &(c->next);
		c = next;
	}
oharboe's avatar
oharboe committed
981

982
983
984
	return ERROR_OK;
}

Zachary T Welch's avatar
Zachary T Welch committed
985
int target_call_event_callbacks(struct target *target, enum target_event event)
986
{
987
988
	struct target_event_callback *callback = target_event_callbacks;
	struct target_event_callback *next_callback;
oharboe's avatar
oharboe committed
989

990
991
992
	if (event == TARGET_EVENT_HALTED)
	{
		/* execute early halted first */
993
		target_call_event_callbacks(target, TARGET_EVENT_GDB_HALT);
994
995
	}

996
997
	LOG_DEBUG("target event %i (%s)",
			  event,
998
			  Jim_Nvp_value2name_simple(nvp_target_event, event)->name);
oharboe's avatar
oharboe committed
999

1000
	target_handle_event(target, event);
For faster browsing, not all history is shown. View entire blame