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