cleanup: rename armv4_5 to arm for readability
[openocd.git] / src / target / arm720t.c
1 /***************************************************************************
2 * Copyright (C) 2005 by Dominic Rath *
3 * Dominic.Rath@gmx.de *
4 * *
5 * Copyright (C) 2009 by Øyvind Harboe *
6 * oyvind.harboe@zylin.com *
7 * *
8 * This program is free software; you can redistribute it and/or modify *
9 * it under the terms of the GNU General Public License as published by *
10 * the Free Software Foundation; either version 2 of the License, or *
11 * (at your option) any later version. *
12 * *
13 * This program is distributed in the hope that it will be useful, *
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
16 * GNU General Public License for more details. *
17 * *
18 * You should have received a copy of the GNU General Public License *
19 * along with this program; if not, write to the *
20 * Free Software Foundation, Inc., *
21 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
22 ***************************************************************************/
23 #ifdef HAVE_CONFIG_H
24 #include "config.h"
25 #endif
26
27 #include "arm720t.h"
28 #include <helper/time_support.h>
29 #include "target_type.h"
30 #include "register.h"
31 #include "arm_opcodes.h"
32
33
34 /*
35 * ARM720 is an ARM7TDMI-S with MMU and ETM7. For information, see
36 * ARM DDI 0229C especially Chapter 9 about debug support.
37 */
38
39 #if 0
40 #define _DEBUG_INSTRUCTION_EXECUTION_
41 #endif
42
43 static int arm720t_scan_cp15(struct target *target,
44 uint32_t out, uint32_t *in, int instruction, int clock_arg)
45 {
46 int retval;
47 struct arm720t_common *arm720t = target_to_arm720(target);
48 struct arm_jtag *jtag_info;
49 struct scan_field fields[2];
50 uint8_t out_buf[4];
51 uint8_t instruction_buf = instruction;
52
53 jtag_info = &arm720t->arm7_9_common.jtag_info;
54
55 buf_set_u32(out_buf, 0, 32, flip_u32(out, 32));
56
57 if ((retval = arm_jtag_scann(jtag_info, 0xf, TAP_DRPAUSE)) != ERROR_OK)
58 {
59 return retval;
60 }
61 if ((retval = arm_jtag_set_instr(jtag_info, jtag_info->intest_instr, NULL, TAP_DRPAUSE)) != ERROR_OK)
62 {
63 return retval;
64 }
65
66 fields[0].num_bits = 1;
67 fields[0].out_value = &instruction_buf;
68 fields[0].in_value = NULL;
69
70 fields[1].num_bits = 32;
71 fields[1].out_value = out_buf;
72 fields[1].in_value = NULL;
73
74 if (in)
75 {
76 fields[1].in_value = (uint8_t *)in;
77 jtag_add_dr_scan(jtag_info->tap, 2, fields, TAP_DRPAUSE);
78 jtag_add_callback(arm7flip32, (jtag_callback_data_t)in);
79 } else
80 {
81 jtag_add_dr_scan(jtag_info->tap, 2, fields, TAP_DRPAUSE);
82 }
83
84 if (clock_arg)
85 jtag_add_runtest(0, TAP_DRPAUSE);
86
87 #ifdef _DEBUG_INSTRUCTION_EXECUTION_
88 if ((retval = jtag_execute_queue()) != ERROR_OK)
89 {
90 return retval;
91 }
92
93 if (in)
94 LOG_DEBUG("out: %8.8x, in: %8.8x, instruction: %i, clock: %i", out, *in, instruction, clock);
95 else
96 LOG_DEBUG("out: %8.8x, instruction: %i, clock: %i", out, instruction, clock_arg);
97 #else
98 LOG_DEBUG("out: %8.8" PRIx32 ", instruction: %i, clock: %i", out, instruction, clock_arg);
99 #endif
100
101 return ERROR_OK;
102 }
103
104 static int arm720t_read_cp15(struct target *target, uint32_t opcode, uint32_t *value)
105 {
106 /* fetch CP15 opcode */
107 arm720t_scan_cp15(target, opcode, NULL, 1, 1);
108 /* "DECODE" stage */
109 arm720t_scan_cp15(target, ARMV4_5_NOP, NULL, 1, 1);
110 /* "EXECUTE" stage (1) */
111 arm720t_scan_cp15(target, ARMV4_5_NOP, NULL, 1, 0);
112 arm720t_scan_cp15(target, 0x0, NULL, 0, 1);
113 /* "EXECUTE" stage (2) */
114 arm720t_scan_cp15(target, 0x0, NULL, 0, 1);
115 /* "EXECUTE" stage (3), CDATA is read */
116 arm720t_scan_cp15(target, ARMV4_5_NOP, value, 1, 1);
117
118 return ERROR_OK;
119 }
120
121 static int arm720t_write_cp15(struct target *target, uint32_t opcode, uint32_t value)
122 {
123 /* fetch CP15 opcode */
124 arm720t_scan_cp15(target, opcode, NULL, 1, 1);
125 /* "DECODE" stage */
126 arm720t_scan_cp15(target, ARMV4_5_NOP, NULL, 1, 1);
127 /* "EXECUTE" stage (1) */
128 arm720t_scan_cp15(target, ARMV4_5_NOP, NULL, 1, 0);
129 arm720t_scan_cp15(target, 0x0, NULL, 0, 1);
130 /* "EXECUTE" stage (2) */
131 arm720t_scan_cp15(target, value, NULL, 0, 1);
132 arm720t_scan_cp15(target, ARMV4_5_NOP, NULL, 1, 1);
133
134 return ERROR_OK;
135 }
136
137 static int arm720t_get_ttb(struct target *target, uint32_t *result)
138 {
139 uint32_t ttb = 0x0;
140
141 int retval;
142
143 retval = arm720t_read_cp15(target, 0xee120f10, &ttb);
144 if (retval != ERROR_OK)
145 return retval;
146 retval = jtag_execute_queue();
147 if (retval != ERROR_OK)
148 return retval;
149
150 ttb &= 0xffffc000;
151
152 *result = ttb;
153
154 return ERROR_OK;
155 }
156
157 static int arm720t_disable_mmu_caches(struct target *target,
158 int mmu, int d_u_cache, int i_cache)
159 {
160 uint32_t cp15_control;
161 int retval;
162
163 /* read cp15 control register */
164 retval = arm720t_read_cp15(target, 0xee110f10, &cp15_control);
165 if (retval != ERROR_OK)
166 return retval;
167 retval = jtag_execute_queue();
168 if (retval != ERROR_OK)
169 return retval;
170
171 if (mmu)
172 cp15_control &= ~0x1U;
173
174 if (d_u_cache || i_cache)
175 cp15_control &= ~0x4U;
176
177 retval = arm720t_write_cp15(target, 0xee010f10, cp15_control);
178 return retval;
179 }
180
181 static int arm720t_enable_mmu_caches(struct target *target,
182 int mmu, int d_u_cache, int i_cache)
183 {
184 uint32_t cp15_control;
185 int retval;
186
187 /* read cp15 control register */
188 retval = arm720t_read_cp15(target, 0xee110f10, &cp15_control);
189 if (retval != ERROR_OK)
190 return retval;
191 retval = jtag_execute_queue();
192 if (retval != ERROR_OK)
193 return retval;
194
195 if (mmu)
196 cp15_control |= 0x1U;
197
198 if (d_u_cache || i_cache)
199 cp15_control |= 0x4U;
200
201 retval = arm720t_write_cp15(target, 0xee010f10, cp15_control);
202 return retval;
203 }
204
205 static int arm720t_post_debug_entry(struct target *target)
206 {
207 struct arm720t_common *arm720t = target_to_arm720(target);
208 int retval;
209
210 /* examine cp15 control reg */
211 retval = arm720t_read_cp15(target, 0xee110f10, &arm720t->cp15_control_reg);
212 if (retval != ERROR_OK)
213 return retval;
214 retval = jtag_execute_queue();
215 if (retval != ERROR_OK)
216 return retval;
217 LOG_DEBUG("cp15_control_reg: %8.8" PRIx32 "", arm720t->cp15_control_reg);
218
219 arm720t->armv4_5_mmu.mmu_enabled = (arm720t->cp15_control_reg & 0x1U) ? 1 : 0;
220 arm720t->armv4_5_mmu.armv4_5_cache.d_u_cache_enabled = (arm720t->cp15_control_reg & 0x4U) ? 1 : 0;
221 arm720t->armv4_5_mmu.armv4_5_cache.i_cache_enabled = 0;
222
223 /* save i/d fault status and address register */
224 retval = arm720t_read_cp15(target, 0xee150f10, &arm720t->fsr_reg);
225 if (retval != ERROR_OK)
226 return retval;
227 retval = arm720t_read_cp15(target, 0xee160f10, &arm720t->far_reg);
228 if (retval != ERROR_OK)
229 return retval;
230 retval = jtag_execute_queue();
231 return retval;
232 }
233
234 static void arm720t_pre_restore_context(struct target *target)
235 {
236 struct arm720t_common *arm720t = target_to_arm720(target);
237
238 /* restore i/d fault status and address register */
239 arm720t_write_cp15(target, 0xee050f10, arm720t->fsr_reg);
240 arm720t_write_cp15(target, 0xee060f10, arm720t->far_reg);
241 }
242
243 static int arm720t_verify_pointer(struct command_context *cmd_ctx,
244 struct arm720t_common *arm720t)
245 {
246 if (arm720t->common_magic != ARM720T_COMMON_MAGIC) {
247 command_print(cmd_ctx, "target is not an ARM720");
248 return ERROR_TARGET_INVALID;
249 }
250 return ERROR_OK;
251 }
252
253 static int arm720t_arch_state(struct target *target)
254 {
255 struct arm720t_common *arm720t = target_to_arm720(target);
256
257 static const char *state[] =
258 {
259 "disabled", "enabled"
260 };
261
262 arm_arch_state(target);
263 LOG_USER("MMU: %s, Cache: %s",
264 state[arm720t->armv4_5_mmu.mmu_enabled],
265 state[arm720t->armv4_5_mmu.armv4_5_cache.d_u_cache_enabled]);
266
267 return ERROR_OK;
268 }
269
270 static int arm720_mmu(struct target *target, int *enabled)
271 {
272 if (target->state != TARGET_HALTED) {
273 LOG_ERROR("%s: target not halted", __func__);
274 return ERROR_TARGET_INVALID;
275 }
276
277 *enabled = target_to_arm720(target)->armv4_5_mmu.mmu_enabled;
278 return ERROR_OK;
279 }
280
281 static int arm720_virt2phys(struct target *target,
282 uint32_t virtual, uint32_t *physical)
283 {
284 uint32_t cb;
285 struct arm720t_common *arm720t = target_to_arm720(target);
286
287 uint32_t ret;
288 int retval = armv4_5_mmu_translate_va(target,
289 &arm720t->armv4_5_mmu, virtual, &cb, &ret);
290 if (retval != ERROR_OK)
291 return retval;
292 *physical = ret;
293 return ERROR_OK;
294 }
295
296 static int arm720t_read_memory(struct target *target,
297 uint32_t address, uint32_t size, uint32_t count, uint8_t *buffer)
298 {
299 int retval;
300 struct arm720t_common *arm720t = target_to_arm720(target);
301
302 /* disable cache, but leave MMU enabled */
303 if (arm720t->armv4_5_mmu.armv4_5_cache.d_u_cache_enabled)
304 {
305 retval = arm720t_disable_mmu_caches(target, 0, 1, 0);
306 if (retval != ERROR_OK)
307 return retval;
308 }
309 retval = arm7_9_read_memory(target, address, size, count, buffer);
310
311 if (arm720t->armv4_5_mmu.armv4_5_cache.d_u_cache_enabled)
312 {
313 retval = arm720t_enable_mmu_caches(target, 0, 1, 0);
314 if (retval != ERROR_OK)
315 return retval;
316 }
317
318 return retval;
319 }
320
321 static int arm720t_read_phys_memory(struct target *target,
322 uint32_t address, uint32_t size, uint32_t count, uint8_t *buffer)
323 {
324 struct arm720t_common *arm720t = target_to_arm720(target);
325
326 return armv4_5_mmu_read_physical(target, &arm720t->armv4_5_mmu, address, size, count, buffer);
327 }
328
329 static int arm720t_write_phys_memory(struct target *target,
330 uint32_t address, uint32_t size, uint32_t count, const uint8_t *buffer)
331 {
332 struct arm720t_common *arm720t = target_to_arm720(target);
333
334 return armv4_5_mmu_write_physical(target, &arm720t->armv4_5_mmu, address, size, count, buffer);
335 }
336
337 static int arm720t_soft_reset_halt(struct target *target)
338 {
339 int retval = ERROR_OK;
340 struct arm720t_common *arm720t = target_to_arm720(target);
341 struct reg *dbg_stat = &arm720t->arm7_9_common
342 .eice_cache->reg_list[EICE_DBG_STAT];
343 struct arm *arm = &arm720t->arm7_9_common.arm;
344
345 if ((retval = target_halt(target)) != ERROR_OK)
346 {
347 return retval;
348 }
349
350 long long then = timeval_ms();
351 int timeout;
352 while (!(timeout = ((timeval_ms()-then) > 1000)))
353 {
354 if (buf_get_u32(dbg_stat->value, EICE_DBG_STATUS_DBGACK, 1) == 0)
355 {
356 embeddedice_read_reg(dbg_stat);
357 if ((retval = jtag_execute_queue()) != ERROR_OK)
358 {
359 return retval;
360 }
361 } else
362 {
363 break;
364 }
365 if (debug_level >= 3)
366 {
367 alive_sleep(100);
368 } else
369 {
370 keep_alive();
371 }
372 }
373 if (timeout)
374 {
375 LOG_ERROR("Failed to halt CPU after 1 sec");
376 return ERROR_TARGET_TIMEOUT;
377 }
378
379 target->state = TARGET_HALTED;
380
381 /* SVC, ARM state, IRQ and FIQ disabled */
382 uint32_t cpsr;
383
384 cpsr = buf_get_u32(arm->cpsr->value, 0, 32);
385 cpsr &= ~0xff;
386 cpsr |= 0xd3;
387 arm_set_cpsr(arm, cpsr);
388 arm->cpsr->dirty = 1;
389
390 /* start fetching from 0x0 */
391 buf_set_u32(arm->pc->value, 0, 32, 0x0);
392 arm->pc->dirty = 1;
393 arm->pc->valid = 1;
394
395 retval = arm720t_disable_mmu_caches(target, 1, 1, 1);
396 if (retval != ERROR_OK)
397 return retval;
398 arm720t->armv4_5_mmu.mmu_enabled = 0;
399 arm720t->armv4_5_mmu.armv4_5_cache.d_u_cache_enabled = 0;
400 arm720t->armv4_5_mmu.armv4_5_cache.i_cache_enabled = 0;
401
402 if ((retval = target_call_event_callbacks(target, TARGET_EVENT_HALTED)) != ERROR_OK)
403 {
404 return retval;
405 }
406
407 return ERROR_OK;
408 }
409
410 static int arm720t_init_target(struct command_context *cmd_ctx, struct target *target)
411 {
412 return arm7tdmi_init_target(cmd_ctx, target);
413 }
414
415 /* FIXME remove forward decls */
416 static int arm720t_mrc(struct target *target, int cpnum,
417 uint32_t op1, uint32_t op2,
418 uint32_t CRn, uint32_t CRm,
419 uint32_t *value);
420 static int arm720t_mcr(struct target *target, int cpnum,
421 uint32_t op1, uint32_t op2,
422 uint32_t CRn, uint32_t CRm,
423 uint32_t value);
424
425 static int arm720t_init_arch_info(struct target *target,
426 struct arm720t_common *arm720t, struct jtag_tap *tap)
427 {
428 struct arm7_9_common *arm7_9 = &arm720t->arm7_9_common;
429
430 arm7_9->arm.mrc = arm720t_mrc;
431 arm7_9->arm.mcr = arm720t_mcr;
432
433 arm7tdmi_init_arch_info(target, arm7_9, tap);
434
435 arm720t->common_magic = ARM720T_COMMON_MAGIC;
436
437 arm7_9->post_debug_entry = arm720t_post_debug_entry;
438 arm7_9->pre_restore_context = arm720t_pre_restore_context;
439
440 arm720t->armv4_5_mmu.armv4_5_cache.ctype = -1;
441 arm720t->armv4_5_mmu.get_ttb = arm720t_get_ttb;
442 arm720t->armv4_5_mmu.read_memory = arm7_9_read_memory;
443 arm720t->armv4_5_mmu.write_memory = arm7_9_write_memory;
444 arm720t->armv4_5_mmu.disable_mmu_caches = arm720t_disable_mmu_caches;
445 arm720t->armv4_5_mmu.enable_mmu_caches = arm720t_enable_mmu_caches;
446 arm720t->armv4_5_mmu.has_tiny_pages = 0;
447 arm720t->armv4_5_mmu.mmu_enabled = 0;
448
449 return ERROR_OK;
450 }
451
452 static int arm720t_target_create(struct target *target, Jim_Interp *interp)
453 {
454 struct arm720t_common *arm720t = calloc(1, sizeof(*arm720t));
455
456 arm720t->arm7_9_common.arm.is_armv4 = true;
457 return arm720t_init_arch_info(target, arm720t, target->tap);
458 }
459
460 COMMAND_HANDLER(arm720t_handle_cp15_command)
461 {
462 int retval;
463 struct target *target = get_current_target(CMD_CTX);
464 struct arm720t_common *arm720t = target_to_arm720(target);
465
466 retval = arm720t_verify_pointer(CMD_CTX, arm720t);
467 if (retval != ERROR_OK)
468 return retval;
469
470
471 if (target->state != TARGET_HALTED)
472 {
473 command_print(CMD_CTX, "target must be stopped for \"%s\" command", CMD_NAME);
474 return ERROR_OK;
475 }
476
477 /* one or more argument, access a single register (write if second argument is given */
478 if (CMD_ARGC >= 1)
479 {
480 uint32_t opcode;
481 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], opcode);
482
483 if (CMD_ARGC == 1)
484 {
485 uint32_t value;
486 if ((retval = arm720t_read_cp15(target, opcode, &value)) != ERROR_OK)
487 {
488 command_print(CMD_CTX, "couldn't access cp15 with opcode 0x%8.8" PRIx32 "", opcode);
489 return ERROR_OK;
490 }
491
492 if ((retval = jtag_execute_queue()) != ERROR_OK)
493 {
494 return retval;
495 }
496
497 command_print(CMD_CTX, "0x%8.8" PRIx32 ": 0x%8.8" PRIx32 "", opcode, value);
498 }
499 else if (CMD_ARGC == 2)
500 {
501 uint32_t value;
502 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[1], value);
503
504 if ((retval = arm720t_write_cp15(target, opcode, value)) != ERROR_OK)
505 {
506 command_print(CMD_CTX, "couldn't access cp15 with opcode 0x%8.8" PRIx32 "", opcode);
507 return ERROR_OK;
508 }
509 command_print(CMD_CTX, "0x%8.8" PRIx32 ": 0x%8.8" PRIx32 "", opcode, value);
510 }
511 }
512
513 return ERROR_OK;
514 }
515
516 static int arm720t_mrc(struct target *target, int cpnum,
517 uint32_t op1, uint32_t op2,
518 uint32_t CRn, uint32_t CRm,
519 uint32_t *value)
520 {
521 if (cpnum!=15)
522 {
523 LOG_ERROR("Only cp15 is supported");
524 return ERROR_FAIL;
525 }
526
527 /* read "to" r0 */
528 return arm720t_read_cp15(target,
529 ARMV4_5_MRC(cpnum, op1, 0, CRn, CRm, op2),
530 value);
531
532 }
533
534 static int arm720t_mcr(struct target *target, int cpnum,
535 uint32_t op1, uint32_t op2,
536 uint32_t CRn, uint32_t CRm,
537 uint32_t value)
538 {
539 if (cpnum!=15)
540 {
541 LOG_ERROR("Only cp15 is supported");
542 return ERROR_FAIL;
543 }
544
545 /* write "from" r0 */
546 return arm720t_write_cp15(target,
547 ARMV4_5_MCR(cpnum, op1, 0, CRn, CRm, op2),
548 value);
549 }
550
551 static const struct command_registration arm720t_exec_command_handlers[] = {
552 {
553 .name = "cp15",
554 .handler = arm720t_handle_cp15_command,
555 .mode = COMMAND_EXEC,
556 /* prefer using less error-prone "arm mcr" or "arm mrc" */
557 .help = "display/modify cp15 register using ARM opcode"
558 " (DEPRECATED)",
559 .usage = "instruction [value]",
560 },
561 COMMAND_REGISTRATION_DONE
562 };
563
564 static const struct command_registration arm720t_command_handlers[] = {
565 {
566 .chain = arm7_9_command_handlers,
567 },
568 {
569 .name = "arm720t",
570 .mode = COMMAND_ANY,
571 .help = "arm720t command group",
572 .usage = "",
573 .chain = arm720t_exec_command_handlers,
574 },
575 COMMAND_REGISTRATION_DONE
576 };
577
578 /** Holds methods for ARM720 targets. */
579 struct target_type arm720t_target =
580 {
581 .name = "arm720t",
582
583 .poll = arm7_9_poll,
584 .arch_state = arm720t_arch_state,
585
586 .halt = arm7_9_halt,
587 .resume = arm7_9_resume,
588 .step = arm7_9_step,
589
590 .assert_reset = arm7_9_assert_reset,
591 .deassert_reset = arm7_9_deassert_reset,
592 .soft_reset_halt = arm720t_soft_reset_halt,
593
594 .get_gdb_reg_list = arm_get_gdb_reg_list,
595
596 .read_memory = arm720t_read_memory,
597 .write_memory = arm7_9_write_memory,
598 .read_phys_memory = arm720t_read_phys_memory,
599 .write_phys_memory = arm720t_write_phys_memory,
600 .mmu = arm720_mmu,
601 .virt2phys = arm720_virt2phys,
602
603 .bulk_write_memory = arm7_9_bulk_write_memory,
604
605 .checksum_memory = arm_checksum_memory,
606 .blank_check_memory = arm_blank_check_memory,
607
608 .run_algorithm = armv4_5_run_algorithm,
609
610 .add_breakpoint = arm7_9_add_breakpoint,
611 .remove_breakpoint = arm7_9_remove_breakpoint,
612 .add_watchpoint = arm7_9_add_watchpoint,
613 .remove_watchpoint = arm7_9_remove_watchpoint,
614
615 .commands = arm720t_command_handlers,
616 .target_create = arm720t_target_create,
617 .init_target = arm720t_init_target,
618 .examine = arm7_9_examine,
619 .check_reset = arm7_9_check_reset,
620 };

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)