Code Review / openocd.git / blob
? search:
summary | shortlog | log | commit | commitdiff | review | tree
history | raw | HEAD
command_handler: change 'cmd_ctx' to CMD_CTX
[openocd.git] / src / target / armv7m.c
1 /***************************************************************************
2 * Copyright (C) 2005 by Dominic Rath *
3 * Dominic.Rath@gmx.de *
4 * *
5 * Copyright (C) 2006 by Magnus Lundin *
6 * lundin@mlu.mine.nu *
7 * *
8 * Copyright (C) 2008 by Spencer Oliver *
9 * spen@spen-soft.co.uk *
10 * *
11 * Copyright (C) 2007,2008 Øyvind Harboe *
12 * oyvind.harboe@zylin.com *
13 * *
14 * This program is free software; you can redistribute it and/or modify *
15 * it under the terms of the GNU General Public License as published by *
16 * the Free Software Foundation; either version 2 of the License, or *
17 * (at your option) any later version. *
18 * *
19 * This program is distributed in the hope that it will be useful, *
20 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
21 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
22 * GNU General Public License for more details. *
23 * *
24 * You should have received a copy of the GNU General Public License *
25 * along with this program; if not, write to the *
26 * Free Software Foundation, Inc., *
27 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
28 * *
29 * ARMv7-M Architecture, Application Level Reference Manual *
30 * ARM DDI 0405C (September 2008) *
31 * *
32 ***************************************************************************/
33 #ifdef HAVE_CONFIG_H
34 #include "config.h"
35 #endif
36
37 #include "breakpoints.h"
38 #include "target.h"
39 #include "armv7m.h"
40 #include "algorithm.h"
41 #include "register.h"
42
43
44 #if 0
45 #define _DEBUG_INSTRUCTION_EXECUTION_
46 #endif
47
48 /** Maps from enum armv7m_mode (except ARMV7M_MODE_ANY) to name. */
49 char *armv7m_mode_strings[] =
50 {
51 "Thread", "Thread (User)", "Handler",
52 };
53
54 static char *armv7m_exception_strings[] =
55 {
56 "", "Reset", "NMI", "HardFault",
57 "MemManage", "BusFault", "UsageFault", "RESERVED",
58 "RESERVED", "RESERVED", "RESERVED", "SVCall",
59 "DebugMonitor", "RESERVED", "PendSV", "SysTick"
60 };
61
62 /* FIXME these dummies are IDENTICAL to the armv4_5, arm11, and armv7a
63 * ones... except for naming/scoping
64 */
65 static uint8_t armv7m_gdb_dummy_fp_value[12];
66
67 static struct reg armv7m_gdb_dummy_fp_reg =
68 {
69 .name = "GDB dummy floating-point register",
70 .value = armv7m_gdb_dummy_fp_value,
71 .dirty = 0,
72 .valid = 1,
73 .size = 96,
74 .arch_info = NULL,
75 };
76
77 static uint8_t armv7m_gdb_dummy_fps_value[4];
78
79 static struct reg armv7m_gdb_dummy_fps_reg =
80 {
81 .name = "GDB dummy floating-point status register",
82 .value = armv7m_gdb_dummy_fps_value,
83 .dirty = 0,
84 .valid = 1,
85 .size = 32,
86 .arch_info = NULL,
87 };
88
89 #ifdef ARMV7_GDB_HACKS
90 uint8_t armv7m_gdb_dummy_cpsr_value[] = {0, 0, 0, 0};
91
92 struct reg armv7m_gdb_dummy_cpsr_reg =
93 {
94 .name = "GDB dummy cpsr register",
95 .value = armv7m_gdb_dummy_cpsr_value,
96 .dirty = 0,
97 .valid = 1,
98 .size = 32,
99 .arch_info = NULL,
100 };
101 #endif
102
103 /*
104 * These registers are not memory-mapped. The ARMv7-M profile includes
105 * memory mapped registers too, such as for the NVIC (interrupt controller)
106 * and SysTick (timer) modules; those can mostly be treated as peripherals.
107 *
108 * The ARMv6-M profile is almost identical in this respect, except that it
109 * doesn't include basepri or faultmask registers.
110 */
111 static const struct {
112 unsigned id;
113 char *name;
114 unsigned bits;
115 } armv7m_regs[] = {
116 { ARMV7M_R0, "r0", 32 },
117 { ARMV7M_R1, "r1", 32 },
118 { ARMV7M_R2, "r2", 32 },
119 { ARMV7M_R3, "r3", 32 },
120
121 { ARMV7M_R4, "r4", 32 },
122 { ARMV7M_R5, "r5", 32 },
123 { ARMV7M_R6, "r6", 32 },
124 { ARMV7M_R7, "r7", 32 },
125
126 { ARMV7M_R8, "r8", 32 },
127 { ARMV7M_R9, "r9", 32 },
128 { ARMV7M_R10, "r10", 32 },
129 { ARMV7M_R11, "r11", 32 },
130
131 { ARMV7M_R12, "r12", 32 },
132 { ARMV7M_R13, "sp", 32 },
133 { ARMV7M_R14, "lr", 32 },
134 { ARMV7M_PC, "pc", 32 },
135
136 { ARMV7M_xPSR, "xPSR", 32 },
137 { ARMV7M_MSP, "msp", 32 },
138 { ARMV7M_PSP, "psp", 32 },
139
140 { ARMV7M_PRIMASK, "primask", 1 },
141 { ARMV7M_BASEPRI, "basepri", 8 },
142 { ARMV7M_FAULTMASK, "faultmask", 1 },
143 { ARMV7M_CONTROL, "control", 2 },
144 };
145
146 #define ARMV7M_NUM_REGS ARRAY_SIZE(armv7m_regs)
147
148 /**
149 * Restores target context using the cache of core registers set up
150 * by armv7m_build_reg_cache(), calling optional core-specific hooks.
151 */
152 int armv7m_restore_context(struct target *target)
153 {
154 int i;
155 struct armv7m_common *armv7m = target_to_armv7m(target);
156
157 LOG_DEBUG(" ");
158
159 if (armv7m->pre_restore_context)
160 armv7m->pre_restore_context(target);
161
162 for (i = ARMV7M_NUM_REGS - 1; i >= 0; i--)
163 {
164 if (armv7m->core_cache->reg_list[i].dirty)
165 {
166 armv7m->write_core_reg(target, i);
167 }
168 }
169
170 if (armv7m->post_restore_context)
171 armv7m->post_restore_context(target);
172
173 return ERROR_OK;
174 }
175
176 /* Core state functions */
177
178 /**
179 * Maps ISR number (from xPSR) to name.
180 * Note that while names and meanings for the first sixteen are standardized
181 * (with zero not a true exception), external interrupts are only numbered.
182 * They are assigned by vendors, which generally assign different numbers to
183 * peripherals (such as UART0 or a USB peripheral controller).
184 */
185 char *armv7m_exception_string(int number)
186 {
187 static char enamebuf[32];
188
189 if ((number < 0) | (number > 511))
190 return "Invalid exception";
191 if (number < 16)
192 return armv7m_exception_strings[number];
193 sprintf(enamebuf, "External Interrupt(%i)", number - 16);
194 return enamebuf;
195 }
196
197 static int armv7m_get_core_reg(struct reg *reg)
198 {
199 int retval;
200 struct armv7m_core_reg *armv7m_reg = reg->arch_info;
201 struct target *target = armv7m_reg->target;
202 struct armv7m_common *armv7m = target_to_armv7m(target);
203
204 if (target->state != TARGET_HALTED)
205 {
206 return ERROR_TARGET_NOT_HALTED;
207 }
208
209 retval = armv7m->read_core_reg(target, armv7m_reg->num);
210
211 return retval;
212 }
213
214 static int armv7m_set_core_reg(struct reg *reg, uint8_t *buf)
215 {
216 struct armv7m_core_reg *armv7m_reg = reg->arch_info;
217 struct target *target = armv7m_reg->target;
218 uint32_t value = buf_get_u32(buf, 0, 32);
219
220 if (target->state != TARGET_HALTED)
221 {
222 return ERROR_TARGET_NOT_HALTED;
223 }
224
225 buf_set_u32(reg->value, 0, 32, value);
226 reg->dirty = 1;
227 reg->valid = 1;
228
229 return ERROR_OK;
230 }
231
232 static int armv7m_read_core_reg(struct target *target, unsigned num)
233 {
234 uint32_t reg_value;
235 int retval;
236 struct armv7m_core_reg * armv7m_core_reg;
237 struct armv7m_common *armv7m = target_to_armv7m(target);
238
239 if (num >= ARMV7M_NUM_REGS)
240 return ERROR_INVALID_ARGUMENTS;
241
242 armv7m_core_reg = armv7m->core_cache->reg_list[num].arch_info;
243 retval = armv7m->load_core_reg_u32(target, armv7m_core_reg->type, armv7m_core_reg->num, &reg_value);
244 buf_set_u32(armv7m->core_cache->reg_list[num].value, 0, 32, reg_value);
245 armv7m->core_cache->reg_list[num].valid = 1;
246 armv7m->core_cache->reg_list[num].dirty = 0;
247
248 return retval;
249 }
250
251 static int armv7m_write_core_reg(struct target *target, unsigned num)
252 {
253 int retval;
254 uint32_t reg_value;
255 struct armv7m_core_reg *armv7m_core_reg;
256 struct armv7m_common *armv7m = target_to_armv7m(target);
257
258 if (num >= ARMV7M_NUM_REGS)
259 return ERROR_INVALID_ARGUMENTS;
260
261 reg_value = buf_get_u32(armv7m->core_cache->reg_list[num].value, 0, 32);
262 armv7m_core_reg = armv7m->core_cache->reg_list[num].arch_info;
263 retval = armv7m->store_core_reg_u32(target, armv7m_core_reg->type, armv7m_core_reg->num, reg_value);
264 if (retval != ERROR_OK)
265 {
266 LOG_ERROR("JTAG failure");
267 armv7m->core_cache->reg_list[num].dirty = armv7m->core_cache->reg_list[num].valid;
268 return ERROR_JTAG_DEVICE_ERROR;
269 }
270 LOG_DEBUG("write core reg %i value 0x%" PRIx32 "", num , reg_value);
271 armv7m->core_cache->reg_list[num].valid = 1;
272 armv7m->core_cache->reg_list[num].dirty = 0;
273
274 return ERROR_OK;
275 }
276
277 /** Invalidates cache of core registers set up by armv7m_build_reg_cache(). */
278 int armv7m_invalidate_core_regs(struct target *target)
279 {
280 struct armv7m_common *armv7m = target_to_armv7m(target);
281 int i;
282
283 for (i = 0; i < armv7m->core_cache->num_regs; i++)
284 {
285 armv7m->core_cache->reg_list[i].valid = 0;
286 armv7m->core_cache->reg_list[i].dirty = 0;
287 }
288
289 return ERROR_OK;
290 }
291
292 /**
293 * Returns generic ARM userspace registers to GDB.
294 * GDB doesn't quite understand that most ARMs don't have floating point
295 * hardware, so this also fakes a set of long-obsolete FPA registers that
296 * are not used in EABI based software stacks.
297 */
298 int armv7m_get_gdb_reg_list(struct target *target, struct reg **reg_list[], int *reg_list_size)
299 {
300 struct armv7m_common *armv7m = target_to_armv7m(target);
301 int i;
302
303 *reg_list_size = 26;
304 *reg_list = malloc(sizeof(struct reg*) * (*reg_list_size));
305
306 /*
307 * GDB register packet format for ARM:
308 * - the first 16 registers are r0..r15
309 * - (obsolete) 8 FPA registers
310 * - (obsolete) FPA status
311 * - CPSR
312 */
313 for (i = 0; i < 16; i++)
314 {
315 (*reg_list)[i] = &armv7m->core_cache->reg_list[i];
316 }
317
318 for (i = 16; i < 24; i++)
319 {
320 (*reg_list)[i] = &armv7m_gdb_dummy_fp_reg;
321 }
322
323 (*reg_list)[24] = &armv7m_gdb_dummy_fps_reg;
324
325 #ifdef ARMV7_GDB_HACKS
326 /* use dummy cpsr reg otherwise gdb may try and set the thumb bit */
327 (*reg_list)[25] = &armv7m_gdb_dummy_cpsr_reg;
328
329 /* ARMV7M is always in thumb mode, try to make GDB understand this
330 * if it does not support this arch */
331 *((char*)armv7m->core_cache->reg_list[15].value) |= 1;
332 #else
333 (*reg_list)[25] = &armv7m->core_cache->reg_list[ARMV7M_xPSR];
334 #endif
335
336 return ERROR_OK;
337 }
338
339 /* run to exit point. return error if exit point was not reached. */
340 static int armv7m_run_and_wait(struct target *target, uint32_t entry_point, int timeout_ms, uint32_t exit_point, struct armv7m_common *armv7m)
341 {
342 uint32_t pc;
343 int retval;
344 /* This code relies on the target specific resume() and poll()->debug_entry()
345 * sequence to write register values to the processor and the read them back */
346 if ((retval = target_resume(target, 0, entry_point, 1, 1)) != ERROR_OK)
347 {
348 return retval;
349 }
350
351 retval = target_wait_state(target, TARGET_HALTED, timeout_ms);
352 /* If the target fails to halt due to the breakpoint, force a halt */
353 if (retval != ERROR_OK || target->state != TARGET_HALTED)
354 {
355 if ((retval = target_halt(target)) != ERROR_OK)
356 return retval;
357 if ((retval = target_wait_state(target, TARGET_HALTED, 500)) != ERROR_OK)
358 {
359 return retval;
360 }
361 return ERROR_TARGET_TIMEOUT;
362 }
363
364 armv7m->load_core_reg_u32(target, ARMV7M_REGISTER_CORE_GP, 15, &pc);
365 if (pc != exit_point)
366 {
367 LOG_DEBUG("failed algoritm halted at 0x%" PRIx32 " ", pc);
368 return ERROR_TARGET_TIMEOUT;
369 }
370
371 return ERROR_OK;
372 }
373
374 /** Runs a Thumb algorithm in the target. */
375 int armv7m_run_algorithm(struct target *target,
376 int num_mem_params, struct mem_param *mem_params,
377 int num_reg_params, struct reg_param *reg_params,
378 uint32_t entry_point, uint32_t exit_point,
379 int timeout_ms, void *arch_info)
380 {
381 struct armv7m_common *armv7m = target_to_armv7m(target);
382 struct armv7m_algorithm *armv7m_algorithm_info = arch_info;
383 enum armv7m_mode core_mode = armv7m->core_mode;
384 int retval = ERROR_OK;
385 uint32_t context[ARMV7M_NUM_REGS];
386
387 if (armv7m_algorithm_info->common_magic != ARMV7M_COMMON_MAGIC)
388 {
389 LOG_ERROR("current target isn't an ARMV7M target");
390 return ERROR_TARGET_INVALID;
391 }
392
393 if (target->state != TARGET_HALTED)
394 {
395 LOG_WARNING("target not halted");
396 return ERROR_TARGET_NOT_HALTED;
397 }
398
399 /* refresh core register cache */
400 /* Not needed if core register cache is always consistent with target process state */
401 for (unsigned i = 0; i < ARMV7M_NUM_REGS; i++)
402 {
403 if (!armv7m->core_cache->reg_list[i].valid)
404 armv7m->read_core_reg(target, i);
405 context[i] = buf_get_u32(armv7m->core_cache->reg_list[i].value, 0, 32);
406 }
407
408 for (int i = 0; i < num_mem_params; i++)
409 {
410 if ((retval = target_write_buffer(target, mem_params[i].address, mem_params[i].size, mem_params[i].value)) != ERROR_OK)
411 return retval;
412 }
413
414 for (int i = 0; i < num_reg_params; i++)
415 {
416 struct reg *reg = register_get_by_name(armv7m->core_cache, reg_params[i].reg_name, 0);
417 // uint32_t regvalue;
418
419 if (!reg)
420 {
421 LOG_ERROR("BUG: register '%s' not found", reg_params[i].reg_name);
422 return ERROR_INVALID_ARGUMENTS;
423 }
424
425 if (reg->size != reg_params[i].size)
426 {
427 LOG_ERROR("BUG: register '%s' size doesn't match reg_params[i].size", reg_params[i].reg_name);
428 return ERROR_INVALID_ARGUMENTS;
429 }
430
431 // regvalue = buf_get_u32(reg_params[i].value, 0, 32);
432 armv7m_set_core_reg(reg, reg_params[i].value);
433 }
434
435 if (armv7m_algorithm_info->core_mode != ARMV7M_MODE_ANY)
436 {
437 LOG_DEBUG("setting core_mode: 0x%2.2x", armv7m_algorithm_info->core_mode);
438 buf_set_u32(armv7m->core_cache->reg_list[ARMV7M_CONTROL].value,
439 0, 1, armv7m_algorithm_info->core_mode);
440 armv7m->core_cache->reg_list[ARMV7M_CONTROL].dirty = 1;
441 armv7m->core_cache->reg_list[ARMV7M_CONTROL].valid = 1;
442 }
443
444 /* REVISIT speed things up (3% or so in one case) by requiring
445 * algorithms to include a BKPT instruction at each exit point.
446 * This eliminates overheads of adding/removing a breakpoint.
447 */
448
449 /* ARMV7M always runs in Thumb state */
450 if ((retval = breakpoint_add(target, exit_point, 2, BKPT_SOFT)) != ERROR_OK)
451 {
452 LOG_ERROR("can't add breakpoint to finish algorithm execution");
453 return ERROR_TARGET_FAILURE;
454 }
455
456 retval = armv7m_run_and_wait(target, entry_point, timeout_ms, exit_point, armv7m);
457
458 breakpoint_remove(target, exit_point);
459
460 if (retval != ERROR_OK)
461 {
462 return retval;
463 }
464
465 /* Read memory values to mem_params[] */
466 for (int i = 0; i < num_mem_params; i++)
467 {
468 if (mem_params[i].direction != PARAM_OUT)
469 if ((retval = target_read_buffer(target, mem_params[i].address, mem_params[i].size, mem_params[i].value)) != ERROR_OK)
470 {
471 return retval;
472 }
473 }
474
475 /* Copy core register values to reg_params[] */
476 for (int i = 0; i < num_reg_params; i++)
477 {
478 if (reg_params[i].direction != PARAM_OUT)
479 {
480 struct reg *reg = register_get_by_name(armv7m->core_cache, reg_params[i].reg_name, 0);
481
482 if (!reg)
483 {
484 LOG_ERROR("BUG: register '%s' not found", reg_params[i].reg_name);
485 return ERROR_INVALID_ARGUMENTS;
486 }
487
488 if (reg->size != reg_params[i].size)
489 {
490 LOG_ERROR("BUG: register '%s' size doesn't match reg_params[i].size", reg_params[i].reg_name);
491 return ERROR_INVALID_ARGUMENTS;
492 }
493
494 buf_set_u32(reg_params[i].value, 0, 32, buf_get_u32(reg->value, 0, 32));
495 }
496 }
497
498 for (int i = ARMV7M_NUM_REGS - 1; i >= 0; i--)
499 {
500 uint32_t regvalue;
501 regvalue = buf_get_u32(armv7m->core_cache->reg_list[i].value, 0, 32);
502 if (regvalue != context[i])
503 {
504 LOG_DEBUG("restoring register %s with value 0x%8.8" PRIx32,
505 armv7m->core_cache->reg_list[i].name, context[i]);
506 buf_set_u32(armv7m->core_cache->reg_list[i].value,
507 0, 32, context[i]);
508 armv7m->core_cache->reg_list[i].valid = 1;
509 armv7m->core_cache->reg_list[i].dirty = 1;
510 }
511 }
512
513 armv7m->core_mode = core_mode;
514
515 return retval;
516 }
517
518 /** Logs summary of ARMv7-M state for a halted target. */
519 int armv7m_arch_state(struct target *target)
520 {
521 struct armv7m_common *armv7m = target_to_armv7m(target);
522 uint32_t ctrl, sp;
523
524 ctrl = buf_get_u32(armv7m->core_cache->reg_list[ARMV7M_CONTROL].value, 0, 32);
525 sp = buf_get_u32(armv7m->core_cache->reg_list[ARMV7M_R13].value, 0, 32);
526
527 LOG_USER("target halted due to %s, current mode: %s %s\n"
528 "xPSR: %#8.8" PRIx32 " pc: %#8.8" PRIx32 " %csp: %#8.8" PRIx32,
529 Jim_Nvp_value2name_simple(nvp_target_debug_reason,
530 target->debug_reason)->name,
531 armv7m_mode_strings[armv7m->core_mode],
532 armv7m_exception_string(armv7m->exception_number),
533 buf_get_u32(armv7m->core_cache->reg_list[ARMV7M_xPSR].value, 0, 32),
534 buf_get_u32(armv7m->core_cache->reg_list[ARMV7M_PC].value, 0, 32),
535 (ctrl & 0x02) ? 'p' : 'm',
536 sp);
537
538 return ERROR_OK;
539 }
540 static const struct reg_arch_type armv7m_reg_type = {
541 .get = armv7m_get_core_reg,
542 .set = armv7m_set_core_reg,
543 };
544
545 /** Builds cache of architecturally defined registers. */
546 struct reg_cache *armv7m_build_reg_cache(struct target *target)
547 {
548 struct armv7m_common *armv7m = target_to_armv7m(target);
549 int num_regs = ARMV7M_NUM_REGS;
550 struct reg_cache **cache_p = register_get_last_cache_p(&target->reg_cache);
551 struct reg_cache *cache = malloc(sizeof(struct reg_cache));
552 struct reg *reg_list = calloc(num_regs, sizeof(struct reg));
553 struct armv7m_core_reg *arch_info = calloc(num_regs, sizeof(struct armv7m_core_reg));
554 int i;
555
556 register_init_dummy(&armv7m_gdb_dummy_fps_reg);
557 #ifdef ARMV7_GDB_HACKS
558 register_init_dummy(&armv7m_gdb_dummy_cpsr_reg);
559 #endif
560 register_init_dummy(&armv7m_gdb_dummy_fp_reg);
561
562 /* Build the process context cache */
563 cache->name = "arm v7m registers";
564 cache->next = NULL;
565 cache->reg_list = reg_list;
566 cache->num_regs = num_regs;
567 (*cache_p) = cache;
568 armv7m->core_cache = cache;
569
570 for (i = 0; i < num_regs; i++)
571 {
572 arch_info[i].num = armv7m_regs[i].id;
573 arch_info[i].target = target;
574 arch_info[i].armv7m_common = armv7m;
575 reg_list[i].name = armv7m_regs[i].name;
576 reg_list[i].size = armv7m_regs[i].bits;
577 reg_list[i].value = calloc(1, 4);
578 reg_list[i].dirty = 0;
579 reg_list[i].valid = 0;
580 reg_list[i].type = &armv7m_reg_type;
581 reg_list[i].arch_info = &arch_info[i];
582 }
583
584 return cache;
585 }
586
587 /** Sets up target as a generic ARMv7-M core */
588 int armv7m_init_arch_info(struct target *target, struct armv7m_common *armv7m)
589 {
590 /* register arch-specific functions */
591
592 target->arch_info = armv7m;
593 armv7m->read_core_reg = armv7m_read_core_reg;
594 armv7m->write_core_reg = armv7m_write_core_reg;
595
596 return ERROR_OK;
597 }
598
599 /** Generates a CRC32 checksum of a memory region. */
600 int armv7m_checksum_memory(struct target *target,
601 uint32_t address, uint32_t count, uint32_t* checksum)
602 {
603 struct working_area *crc_algorithm;
604 struct armv7m_algorithm armv7m_info;
605 struct reg_param reg_params[2];
606 int retval;
607
608 static const uint16_t cortex_m3_crc_code[] = {
609 0x4602, /* mov r2, r0 */
610 0xF04F, 0x30FF, /* mov r0, #0xffffffff */
611 0x460B, /* mov r3, r1 */
612 0xF04F, 0x0400, /* mov r4, #0 */
613 0xE013, /* b ncomp */
614 /* nbyte: */
615 0x5D11, /* ldrb r1, [r2, r4] */
616 0xF8DF, 0x7028, /* ldr r7, CRC32XOR */
617 0xEA80, 0x6001, /* eor r0, r0, r1, asl #24 */
618
619 0xF04F, 0x0500, /* mov r5, #0 */
620 /* loop: */
621 0x2800, /* cmp r0, #0 */
622 0xEA4F, 0x0640, /* mov r6, r0, asl #1 */
623 0xF105, 0x0501, /* add r5, r5, #1 */
624 0x4630, /* mov r0, r6 */
625 0xBFB8, /* it lt */
626 0xEA86, 0x0007, /* eor r0, r6, r7 */
627 0x2D08, /* cmp r5, #8 */
628 0xD1F4, /* bne loop */
629
630 0xF104, 0x0401, /* add r4, r4, #1 */
631 /* ncomp: */
632 0x429C, /* cmp r4, r3 */
633 0xD1E9, /* bne nbyte */
634 /* end: */
635 0xE7FE, /* b end */
636 0x1DB7, 0x04C1 /* CRC32XOR: .word 0x04C11DB7 */
637 };
638
639 uint32_t i;
640
641 if (target_alloc_working_area(target, sizeof(cortex_m3_crc_code), &crc_algorithm) != ERROR_OK)
642 {
643 return ERROR_TARGET_RESOURCE_NOT_AVAILABLE;
644 }
645
646 /* convert flash writing code into a buffer in target endianness */
647 for (i = 0; i < (sizeof(cortex_m3_crc_code)/sizeof(uint16_t)); i++)
648 if ((retval = target_write_u16(target, crc_algorithm->address + i*sizeof(uint16_t), cortex_m3_crc_code[i])) != ERROR_OK)
649 {
650 return retval;
651 }
652
653 armv7m_info.common_magic = ARMV7M_COMMON_MAGIC;
654 armv7m_info.core_mode = ARMV7M_MODE_ANY;
655
656 init_reg_param(&reg_params[0], "r0", 32, PARAM_IN_OUT);
657 init_reg_param(&reg_params[1], "r1", 32, PARAM_OUT);
658
659 buf_set_u32(reg_params[0].value, 0, 32, address);
660 buf_set_u32(reg_params[1].value, 0, 32, count);
661
662 if ((retval = target_run_algorithm(target, 0, NULL, 2, reg_params,
663 crc_algorithm->address, crc_algorithm->address + (sizeof(cortex_m3_crc_code)-6), 20000, &armv7m_info)) != ERROR_OK)
664 {
665 LOG_ERROR("error executing cortex_m3 crc algorithm");
666 destroy_reg_param(&reg_params[0]);
667 destroy_reg_param(&reg_params[1]);
668 target_free_working_area(target, crc_algorithm);
669 return retval;
670 }
671
672 *checksum = buf_get_u32(reg_params[0].value, 0, 32);
673
674 destroy_reg_param(&reg_params[0]);
675 destroy_reg_param(&reg_params[1]);
676
677 target_free_working_area(target, crc_algorithm);
678
679 return ERROR_OK;
680 }
681
682 /** Checks whether a memory region is zeroed. */
683 int armv7m_blank_check_memory(struct target *target,
684 uint32_t address, uint32_t count, uint32_t* blank)
685 {
686 struct working_area *erase_check_algorithm;
687 struct reg_param reg_params[3];
688 struct armv7m_algorithm armv7m_info;
689 int retval;
690 uint32_t i;
691
692 static const uint16_t erase_check_code[] =
693 {
694 /* loop: */
695 0xF810, 0x3B01, /* ldrb r3, [r0], #1 */
696 0xEA02, 0x0203, /* and r2, r2, r3 */
697 0x3901, /* subs r1, r1, #1 */
698 0xD1F9, /* bne loop */
699 /* end: */
700 0xE7FE, /* b end */
701 };
702
703 /* make sure we have a working area */
704 if (target_alloc_working_area(target, sizeof(erase_check_code), &erase_check_algorithm) != ERROR_OK)
705 {
706 return ERROR_TARGET_RESOURCE_NOT_AVAILABLE;
707 }
708
709 /* convert flash writing code into a buffer in target endianness */
710 for (i = 0; i < (sizeof(erase_check_code)/sizeof(uint16_t)); i++)
711 target_write_u16(target, erase_check_algorithm->address + i*sizeof(uint16_t), erase_check_code[i]);
712
713 armv7m_info.common_magic = ARMV7M_COMMON_MAGIC;
714 armv7m_info.core_mode = ARMV7M_MODE_ANY;
715
716 init_reg_param(&reg_params[0], "r0", 32, PARAM_OUT);
717 buf_set_u32(reg_params[0].value, 0, 32, address);
718
719 init_reg_param(&reg_params[1], "r1", 32, PARAM_OUT);
720 buf_set_u32(reg_params[1].value, 0, 32, count);
721
722 init_reg_param(&reg_params[2], "r2", 32, PARAM_IN_OUT);
723 buf_set_u32(reg_params[2].value, 0, 32, 0xff);
724
725 if ((retval = target_run_algorithm(target, 0, NULL, 3, reg_params,
726 erase_check_algorithm->address, erase_check_algorithm->address + (sizeof(erase_check_code)-2), 10000, &armv7m_info)) != ERROR_OK)
727 {
728 destroy_reg_param(&reg_params[0]);
729 destroy_reg_param(&reg_params[1]);
730 destroy_reg_param(&reg_params[2]);
731 target_free_working_area(target, erase_check_algorithm);
732 return 0;
733 }
734
735 *blank = buf_get_u32(reg_params[2].value, 0, 32);
736
737 destroy_reg_param(&reg_params[0]);
738 destroy_reg_param(&reg_params[1]);
739 destroy_reg_param(&reg_params[2]);
740
741 target_free_working_area(target, erase_check_algorithm);
742
743 return ERROR_OK;
744 }
745
746 /*--------------------------------------------------------------------------*/
747
748 /*
749 * Only stuff below this line should need to verify that its target
750 * is an ARMv7-M node.
751 *
752 * FIXME yet none of it _does_ verify target types yet!
753 */
754
755
756 /*
757 * Return the debug ap baseaddress in hexadecimal;
758 * no extra output to simplify script processing
759 */
760 COMMAND_HANDLER(handle_dap_baseaddr_command)
761 {
762 struct target *target = get_current_target(CMD_CTX);
763 struct armv7m_common *armv7m = target_to_armv7m(target);
764 struct swjdp_common *swjdp = &armv7m->swjdp_info;
765 uint32_t apsel, apselsave, baseaddr;
766 int retval;
767
768 apselsave = swjdp->apsel;
769 switch (CMD_ARGC) {
770 case 0:
771 apsel = swjdp->apsel;
772 break;
773 case 1:
774 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], apsel);
775 break;
776 default:
777 return ERROR_COMMAND_SYNTAX_ERROR;
778 }
779
780 if (apselsave != apsel)
781 dap_ap_select(swjdp, apsel);
782
783 dap_ap_read_reg_u32(swjdp, 0xF8, &baseaddr);
784 retval = swjdp_transaction_endcheck(swjdp);
785 command_print(CMD_CTX, "0x%8.8" PRIx32 "", baseaddr);
786
787 if (apselsave != apsel)
788 dap_ap_select(swjdp, apselsave);
789
790 return retval;
791 }
792
793 /*
794 * Return the debug ap id in hexadecimal;
795 * no extra output to simplify script processing
796 */
797 COMMAND_HANDLER(handle_dap_apid_command)
798 {
799 struct target *target = get_current_target(CMD_CTX);
800 struct armv7m_common *armv7m = target_to_armv7m(target);
801 struct swjdp_common *swjdp = &armv7m->swjdp_info;
802
803 return CALL_COMMAND_HANDLER(dap_apid_command, swjdp);
804 }
805
806 COMMAND_HANDLER(handle_dap_apsel_command)
807 {
808 struct target *target = get_current_target(CMD_CTX);
809 struct armv7m_common *armv7m = target_to_armv7m(target);
810 struct swjdp_common *swjdp = &armv7m->swjdp_info;
811
812 return CALL_COMMAND_HANDLER(dap_apsel_command, swjdp);
813 }
814
815 COMMAND_HANDLER(handle_dap_memaccess_command)
816 {
817 struct target *target = get_current_target(CMD_CTX);
818 struct armv7m_common *armv7m = target_to_armv7m(target);
819 struct swjdp_common *swjdp = &armv7m->swjdp_info;
820
821 return CALL_COMMAND_HANDLER(dap_memaccess_command, swjdp);
822 }
823
824
825 COMMAND_HANDLER(handle_dap_info_command)
826 {
827 struct target *target = get_current_target(CMD_CTX);
828 struct armv7m_common *armv7m = target_to_armv7m(target);
829 struct swjdp_common *swjdp = &armv7m->swjdp_info;
830 uint32_t apsel;
831
832 switch (CMD_ARGC) {
833 case 0:
834 apsel = swjdp->apsel;
835 break;
836 case 1:
837 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], apsel);
838 break;
839 default:
840 return ERROR_COMMAND_SYNTAX_ERROR;
841 }
842
843 return dap_info_command(CMD_CTX, swjdp, apsel);
844 }
845
846 /** Registers commands used to access DAP resources. */
847 int armv7m_register_commands(struct command_context *cmd_ctx)
848 {
849 struct command *arm_adi_v5_dap_cmd;
850
851 arm_adi_v5_dap_cmd = register_command(cmd_ctx, NULL, "dap",
852 NULL, COMMAND_ANY,
853 "cortex dap specific commands");
854
855 register_command(cmd_ctx, arm_adi_v5_dap_cmd, "info",
856 handle_dap_info_command, COMMAND_EXEC,
857 "Displays dap info for ap [num],"
858 "default currently selected AP");
859 register_command(cmd_ctx, arm_adi_v5_dap_cmd, "apsel",
860 handle_dap_apsel_command, COMMAND_EXEC,
861 "Select a different AP [num] (default 0)");
862 register_command(cmd_ctx, arm_adi_v5_dap_cmd, "apid",
863 handle_dap_apid_command, COMMAND_EXEC,
864 "Displays id reg from AP [num], "
865 "default currently selected AP");
866 register_command(cmd_ctx, arm_adi_v5_dap_cmd, "baseaddr",
867 handle_dap_baseaddr_command, COMMAND_EXEC,
868 "Displays debug base address from AP [num],"
869 "default currently selected AP");
870 register_command(cmd_ctx, arm_adi_v5_dap_cmd, "memaccess",
871 handle_dap_memaccess_command, COMMAND_EXEC,
872 "set/get number of extra tck for mem-ap "
873 "memory bus access [0-255]");
874
875 return ERROR_OK;
876 }
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)