d9544e9ebca68f576b8f66168dcca13174bd187b
[openocd.git] / src / target / arm_adi_v5.c
1 /***************************************************************************
2 * Copyright (C) 2006 by Magnus Lundin *
3 * lundin@mlu.mine.nu *
4 * *
5 * Copyright (C) 2008 by Spencer Oliver *
6 * spen@spen-soft.co.uk *
7 * *
8 * Copyright (C) 2009-2010 by Oyvind Harboe *
9 * oyvind.harboe@zylin.com *
10 * *
11 * Copyright (C) 2009-2010 by David Brownell *
12 * *
13 * Copyright (C) 2013 by Andreas Fritiofson *
14 * andreas.fritiofson@gmail.com *
15 * *
16 * Copyright (C) 2019-2021, Ampere Computing LLC *
17 * *
18 * This program is free software; you can redistribute it and/or modify *
19 * it under the terms of the GNU General Public License as published by *
20 * the Free Software Foundation; either version 2 of the License, or *
21 * (at your option) any later version. *
22 * *
23 * This program is distributed in the hope that it will be useful, *
24 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
25 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
26 * GNU General Public License for more details. *
27 * *
28 * You should have received a copy of the GNU General Public License *
29 * along with this program. If not, see <http://www.gnu.org/licenses/>. *
30 ***************************************************************************/
31
32 /**
33 * @file
34 * This file implements support for the ARM Debug Interface version 5 (ADIv5)
35 * debugging architecture. Compared with previous versions, this includes
36 * a low pin-count Serial Wire Debug (SWD) alternative to JTAG for message
37 * transport, and focuses on memory mapped resources as defined by the
38 * CoreSight architecture.
39 *
40 * A key concept in ADIv5 is the Debug Access Port, or DAP. A DAP has two
41 * basic components: a Debug Port (DP) transporting messages to and from a
42 * debugger, and an Access Port (AP) accessing resources. Three types of DP
43 * are defined. One uses only JTAG for communication, and is called JTAG-DP.
44 * One uses only SWD for communication, and is called SW-DP. The third can
45 * use either SWD or JTAG, and is called SWJ-DP. The most common type of AP
46 * is used to access memory mapped resources and is called a MEM-AP. Also a
47 * JTAG-AP is also defined, bridging to JTAG resources; those are uncommon.
48 *
49 * This programming interface allows DAP pipelined operations through a
50 * transaction queue. This primarily affects AP operations (such as using
51 * a MEM-AP to access memory or registers). If the current transaction has
52 * not finished by the time the next one must begin, and the ORUNDETECT bit
53 * is set in the DP_CTRL_STAT register, the SSTICKYORUN status is set and
54 * further AP operations will fail. There are two basic methods to avoid
55 * such overrun errors. One involves polling for status instead of using
56 * transaction pipelining. The other involves adding delays to ensure the
57 * AP has enough time to complete one operation before starting the next
58 * one. (For JTAG these delays are controlled by memaccess_tck.)
59 */
60
61 /*
62 * Relevant specifications from ARM include:
63 *
64 * ARM(tm) Debug Interface v5 Architecture Specification ARM IHI 0031E
65 * CoreSight(tm) v1.0 Architecture Specification ARM IHI 0029B
66 *
67 * CoreSight(tm) DAP-Lite TRM, ARM DDI 0316D
68 * Cortex-M3(tm) TRM, ARM DDI 0337G
69 */
70
71 #ifdef HAVE_CONFIG_H
72 #include "config.h"
73 #endif
74
75 #include "jtag/interface.h"
76 #include "arm.h"
77 #include "arm_adi_v5.h"
78 #include "arm_coresight.h"
79 #include "jtag/swd.h"
80 #include "transport/transport.h"
81 #include <helper/align.h>
82 #include <helper/jep106.h>
83 #include <helper/time_support.h>
84 #include <helper/list.h>
85 #include <helper/jim-nvp.h>
86
87 /* ARM ADI Specification requires at least 10 bits used for TAR autoincrement */
88
89 /*
90 uint32_t tar_block_size(uint32_t address)
91 Return the largest block starting at address that does not cross a tar block size alignment boundary
92 */
93 static uint32_t max_tar_block_size(uint32_t tar_autoincr_block, target_addr_t address)
94 {
95 return tar_autoincr_block - ((tar_autoincr_block - 1) & address);
96 }
97
98 /***************************************************************************
99 * *
100 * DP and MEM-AP register access through APACC and DPACC *
101 * *
102 ***************************************************************************/
103
104 static int mem_ap_setup_csw(struct adiv5_ap *ap, uint32_t csw)
105 {
106 csw |= ap->csw_default;
107
108 if (csw != ap->csw_value) {
109 /* LOG_DEBUG("DAP: Set CSW %x",csw); */
110 int retval = dap_queue_ap_write(ap, MEM_AP_REG_CSW, csw);
111 if (retval != ERROR_OK) {
112 ap->csw_value = 0;
113 return retval;
114 }
115 ap->csw_value = csw;
116 }
117 return ERROR_OK;
118 }
119
120 static int mem_ap_setup_tar(struct adiv5_ap *ap, target_addr_t tar)
121 {
122 if (!ap->tar_valid || tar != ap->tar_value) {
123 /* LOG_DEBUG("DAP: Set TAR %x",tar); */
124 int retval = dap_queue_ap_write(ap, MEM_AP_REG_TAR, (uint32_t)(tar & 0xffffffffUL));
125 if (retval == ERROR_OK && is_64bit_ap(ap)) {
126 /* See if bits 63:32 of tar is different from last setting */
127 if ((ap->tar_value >> 32) != (tar >> 32))
128 retval = dap_queue_ap_write(ap, MEM_AP_REG_TAR64, (uint32_t)(tar >> 32));
129 }
130 if (retval != ERROR_OK) {
131 ap->tar_valid = false;
132 return retval;
133 }
134 ap->tar_value = tar;
135 ap->tar_valid = true;
136 }
137 return ERROR_OK;
138 }
139
140 static int mem_ap_read_tar(struct adiv5_ap *ap, target_addr_t *tar)
141 {
142 uint32_t lower;
143 uint32_t upper = 0;
144
145 int retval = dap_queue_ap_read(ap, MEM_AP_REG_TAR, &lower);
146 if (retval == ERROR_OK && is_64bit_ap(ap))
147 retval = dap_queue_ap_read(ap, MEM_AP_REG_TAR64, &upper);
148
149 if (retval != ERROR_OK) {
150 ap->tar_valid = false;
151 return retval;
152 }
153
154 retval = dap_run(ap->dap);
155 if (retval != ERROR_OK) {
156 ap->tar_valid = false;
157 return retval;
158 }
159
160 *tar = (((target_addr_t)upper) << 32) | (target_addr_t)lower;
161
162 ap->tar_value = *tar;
163 ap->tar_valid = true;
164 return ERROR_OK;
165 }
166
167 static uint32_t mem_ap_get_tar_increment(struct adiv5_ap *ap)
168 {
169 switch (ap->csw_value & CSW_ADDRINC_MASK) {
170 case CSW_ADDRINC_SINGLE:
171 switch (ap->csw_value & CSW_SIZE_MASK) {
172 case CSW_8BIT:
173 return 1;
174 case CSW_16BIT:
175 return 2;
176 case CSW_32BIT:
177 return 4;
178 default:
179 return 0;
180 }
181 case CSW_ADDRINC_PACKED:
182 return 4;
183 }
184 return 0;
185 }
186
187 /* mem_ap_update_tar_cache is called after an access to MEM_AP_REG_DRW
188 */
189 static void mem_ap_update_tar_cache(struct adiv5_ap *ap)
190 {
191 if (!ap->tar_valid)
192 return;
193
194 uint32_t inc = mem_ap_get_tar_increment(ap);
195 if (inc >= max_tar_block_size(ap->tar_autoincr_block, ap->tar_value))
196 ap->tar_valid = false;
197 else
198 ap->tar_value += inc;
199 }
200
201 /**
202 * Queue transactions setting up transfer parameters for the
203 * currently selected MEM-AP.
204 *
205 * Subsequent transfers using registers like MEM_AP_REG_DRW or MEM_AP_REG_BD2
206 * initiate data reads or writes using memory or peripheral addresses.
207 * If the CSW is configured for it, the TAR may be automatically
208 * incremented after each transfer.
209 *
210 * @param ap The MEM-AP.
211 * @param csw MEM-AP Control/Status Word (CSW) register to assign. If this
212 * matches the cached value, the register is not changed.
213 * @param tar MEM-AP Transfer Address Register (TAR) to assign. If this
214 * matches the cached address, the register is not changed.
215 *
216 * @return ERROR_OK if the transaction was properly queued, else a fault code.
217 */
218 static int mem_ap_setup_transfer(struct adiv5_ap *ap, uint32_t csw, target_addr_t tar)
219 {
220 int retval;
221 retval = mem_ap_setup_csw(ap, csw);
222 if (retval != ERROR_OK)
223 return retval;
224 retval = mem_ap_setup_tar(ap, tar);
225 if (retval != ERROR_OK)
226 return retval;
227 return ERROR_OK;
228 }
229
230 /**
231 * Asynchronous (queued) read of a word from memory or a system register.
232 *
233 * @param ap The MEM-AP to access.
234 * @param address Address of the 32-bit word to read; it must be
235 * readable by the currently selected MEM-AP.
236 * @param value points to where the word will be stored when the
237 * transaction queue is flushed (assuming no errors).
238 *
239 * @return ERROR_OK for success. Otherwise a fault code.
240 */
241 int mem_ap_read_u32(struct adiv5_ap *ap, target_addr_t address,
242 uint32_t *value)
243 {
244 int retval;
245
246 /* Use banked addressing (REG_BDx) to avoid some link traffic
247 * (updating TAR) when reading several consecutive addresses.
248 */
249 retval = mem_ap_setup_transfer(ap,
250 CSW_32BIT | (ap->csw_value & CSW_ADDRINC_MASK),
251 address & 0xFFFFFFFFFFFFFFF0ull);
252 if (retval != ERROR_OK)
253 return retval;
254
255 return dap_queue_ap_read(ap, MEM_AP_REG_BD0 | (address & 0xC), value);
256 }
257
258 /**
259 * Synchronous read of a word from memory or a system register.
260 * As a side effect, this flushes any queued transactions.
261 *
262 * @param ap The MEM-AP to access.
263 * @param address Address of the 32-bit word to read; it must be
264 * readable by the currently selected MEM-AP.
265 * @param value points to where the result will be stored.
266 *
267 * @return ERROR_OK for success; *value holds the result.
268 * Otherwise a fault code.
269 */
270 int mem_ap_read_atomic_u32(struct adiv5_ap *ap, target_addr_t address,
271 uint32_t *value)
272 {
273 int retval;
274
275 retval = mem_ap_read_u32(ap, address, value);
276 if (retval != ERROR_OK)
277 return retval;
278
279 return dap_run(ap->dap);
280 }
281
282 /**
283 * Asynchronous (queued) write of a word to memory or a system register.
284 *
285 * @param ap The MEM-AP to access.
286 * @param address Address to be written; it must be writable by
287 * the currently selected MEM-AP.
288 * @param value Word that will be written to the address when transaction
289 * queue is flushed (assuming no errors).
290 *
291 * @return ERROR_OK for success. Otherwise a fault code.
292 */
293 int mem_ap_write_u32(struct adiv5_ap *ap, target_addr_t address,
294 uint32_t value)
295 {
296 int retval;
297
298 /* Use banked addressing (REG_BDx) to avoid some link traffic
299 * (updating TAR) when writing several consecutive addresses.
300 */
301 retval = mem_ap_setup_transfer(ap,
302 CSW_32BIT | (ap->csw_value & CSW_ADDRINC_MASK),
303 address & 0xFFFFFFFFFFFFFFF0ull);
304 if (retval != ERROR_OK)
305 return retval;
306
307 return dap_queue_ap_write(ap, MEM_AP_REG_BD0 | (address & 0xC),
308 value);
309 }
310
311 /**
312 * Synchronous write of a word to memory or a system register.
313 * As a side effect, this flushes any queued transactions.
314 *
315 * @param ap The MEM-AP to access.
316 * @param address Address to be written; it must be writable by
317 * the currently selected MEM-AP.
318 * @param value Word that will be written.
319 *
320 * @return ERROR_OK for success; the data was written. Otherwise a fault code.
321 */
322 int mem_ap_write_atomic_u32(struct adiv5_ap *ap, target_addr_t address,
323 uint32_t value)
324 {
325 int retval = mem_ap_write_u32(ap, address, value);
326
327 if (retval != ERROR_OK)
328 return retval;
329
330 return dap_run(ap->dap);
331 }
332
333 /**
334 * Synchronous write of a block of memory, using a specific access size.
335 *
336 * @param ap The MEM-AP to access.
337 * @param buffer The data buffer to write. No particular alignment is assumed.
338 * @param size Which access size to use, in bytes. 1, 2 or 4.
339 * @param count The number of writes to do (in size units, not bytes).
340 * @param address Address to be written; it must be writable by the currently selected MEM-AP.
341 * @param addrinc Whether the target address should be increased for each write or not. This
342 * should normally be true, except when writing to e.g. a FIFO.
343 * @return ERROR_OK on success, otherwise an error code.
344 */
345 static int mem_ap_write(struct adiv5_ap *ap, const uint8_t *buffer, uint32_t size, uint32_t count,
346 target_addr_t address, bool addrinc)
347 {
348 struct adiv5_dap *dap = ap->dap;
349 size_t nbytes = size * count;
350 const uint32_t csw_addrincr = addrinc ? CSW_ADDRINC_SINGLE : CSW_ADDRINC_OFF;
351 uint32_t csw_size;
352 target_addr_t addr_xor;
353 int retval = ERROR_OK;
354
355 /* TI BE-32 Quirks mode:
356 * Writes on big-endian TMS570 behave very strangely. Observed behavior:
357 * size write address bytes written in order
358 * 4 TAR ^ 0 (val >> 24), (val >> 16), (val >> 8), (val)
359 * 2 TAR ^ 2 (val >> 8), (val)
360 * 1 TAR ^ 3 (val)
361 * For example, if you attempt to write a single byte to address 0, the processor
362 * will actually write a byte to address 3.
363 *
364 * To make writes of size < 4 work as expected, we xor a value with the address before
365 * setting the TAP, and we set the TAP after every transfer rather then relying on
366 * address increment. */
367
368 if (size == 4) {
369 csw_size = CSW_32BIT;
370 addr_xor = 0;
371 } else if (size == 2) {
372 csw_size = CSW_16BIT;
373 addr_xor = dap->ti_be_32_quirks ? 2 : 0;
374 } else if (size == 1) {
375 csw_size = CSW_8BIT;
376 addr_xor = dap->ti_be_32_quirks ? 3 : 0;
377 } else {
378 return ERROR_TARGET_UNALIGNED_ACCESS;
379 }
380
381 if (ap->unaligned_access_bad && (address % size != 0))
382 return ERROR_TARGET_UNALIGNED_ACCESS;
383
384 while (nbytes > 0) {
385 uint32_t this_size = size;
386
387 /* Select packed transfer if possible */
388 if (addrinc && ap->packed_transfers && nbytes >= 4
389 && max_tar_block_size(ap->tar_autoincr_block, address) >= 4) {
390 this_size = 4;
391 retval = mem_ap_setup_csw(ap, csw_size | CSW_ADDRINC_PACKED);
392 } else {
393 retval = mem_ap_setup_csw(ap, csw_size | csw_addrincr);
394 }
395
396 if (retval != ERROR_OK)
397 break;
398
399 retval = mem_ap_setup_tar(ap, address ^ addr_xor);
400 if (retval != ERROR_OK)
401 return retval;
402
403 /* How many source bytes each transfer will consume, and their location in the DRW,
404 * depends on the type of transfer and alignment. See ARM document IHI0031C. */
405 uint32_t outvalue = 0;
406 uint32_t drw_byte_idx = address;
407 if (dap->ti_be_32_quirks) {
408 switch (this_size) {
409 case 4:
410 outvalue |= (uint32_t)*buffer++ << 8 * (3 ^ (drw_byte_idx++ & 3) ^ addr_xor);
411 outvalue |= (uint32_t)*buffer++ << 8 * (3 ^ (drw_byte_idx++ & 3) ^ addr_xor);
412 outvalue |= (uint32_t)*buffer++ << 8 * (3 ^ (drw_byte_idx++ & 3) ^ addr_xor);
413 outvalue |= (uint32_t)*buffer++ << 8 * (3 ^ (drw_byte_idx & 3) ^ addr_xor);
414 break;
415 case 2:
416 outvalue |= (uint32_t)*buffer++ << 8 * (1 ^ (drw_byte_idx++ & 3) ^ addr_xor);
417 outvalue |= (uint32_t)*buffer++ << 8 * (1 ^ (drw_byte_idx & 3) ^ addr_xor);
418 break;
419 case 1:
420 outvalue |= (uint32_t)*buffer++ << 8 * (0 ^ (drw_byte_idx & 3) ^ addr_xor);
421 break;
422 }
423 } else {
424 switch (this_size) {
425 case 4:
426 outvalue |= (uint32_t)*buffer++ << 8 * (drw_byte_idx++ & 3);
427 outvalue |= (uint32_t)*buffer++ << 8 * (drw_byte_idx++ & 3);
428 /* fallthrough */
429 case 2:
430 outvalue |= (uint32_t)*buffer++ << 8 * (drw_byte_idx++ & 3);
431 /* fallthrough */
432 case 1:
433 outvalue |= (uint32_t)*buffer++ << 8 * (drw_byte_idx & 3);
434 }
435 }
436
437 nbytes -= this_size;
438
439 retval = dap_queue_ap_write(ap, MEM_AP_REG_DRW, outvalue);
440 if (retval != ERROR_OK)
441 break;
442
443 mem_ap_update_tar_cache(ap);
444 if (addrinc)
445 address += this_size;
446 }
447
448 /* REVISIT: Might want to have a queued version of this function that does not run. */
449 if (retval == ERROR_OK)
450 retval = dap_run(dap);
451
452 if (retval != ERROR_OK) {
453 target_addr_t tar;
454 if (mem_ap_read_tar(ap, &tar) == ERROR_OK)
455 LOG_ERROR("Failed to write memory at " TARGET_ADDR_FMT, tar);
456 else
457 LOG_ERROR("Failed to write memory and, additionally, failed to find out where");
458 }
459
460 return retval;
461 }
462
463 /**
464 * Synchronous read of a block of memory, using a specific access size.
465 *
466 * @param ap The MEM-AP to access.
467 * @param buffer The data buffer to receive the data. No particular alignment is assumed.
468 * @param size Which access size to use, in bytes. 1, 2 or 4.
469 * @param count The number of reads to do (in size units, not bytes).
470 * @param adr Address to be read; it must be readable by the currently selected MEM-AP.
471 * @param addrinc Whether the target address should be increased after each read or not. This
472 * should normally be true, except when reading from e.g. a FIFO.
473 * @return ERROR_OK on success, otherwise an error code.
474 */
475 static int mem_ap_read(struct adiv5_ap *ap, uint8_t *buffer, uint32_t size, uint32_t count,
476 target_addr_t adr, bool addrinc)
477 {
478 struct adiv5_dap *dap = ap->dap;
479 size_t nbytes = size * count;
480 const uint32_t csw_addrincr = addrinc ? CSW_ADDRINC_SINGLE : CSW_ADDRINC_OFF;
481 uint32_t csw_size;
482 target_addr_t address = adr;
483 int retval = ERROR_OK;
484
485 /* TI BE-32 Quirks mode:
486 * Reads on big-endian TMS570 behave strangely differently than writes.
487 * They read from the physical address requested, but with DRW byte-reversed.
488 * For example, a byte read from address 0 will place the result in the high bytes of DRW.
489 * Also, packed 8-bit and 16-bit transfers seem to sometimes return garbage in some bytes,
490 * so avoid them. */
491
492 if (size == 4)
493 csw_size = CSW_32BIT;
494 else if (size == 2)
495 csw_size = CSW_16BIT;
496 else if (size == 1)
497 csw_size = CSW_8BIT;
498 else
499 return ERROR_TARGET_UNALIGNED_ACCESS;
500
501 if (ap->unaligned_access_bad && (adr % size != 0))
502 return ERROR_TARGET_UNALIGNED_ACCESS;
503
504 /* Allocate buffer to hold the sequence of DRW reads that will be made. This is a significant
505 * over-allocation if packed transfers are going to be used, but determining the real need at
506 * this point would be messy. */
507 uint32_t *read_buf = calloc(count, sizeof(uint32_t));
508 /* Multiplication count * sizeof(uint32_t) may overflow, calloc() is safe */
509 uint32_t *read_ptr = read_buf;
510 if (!read_buf) {
511 LOG_ERROR("Failed to allocate read buffer");
512 return ERROR_FAIL;
513 }
514
515 /* Queue up all reads. Each read will store the entire DRW word in the read buffer. How many
516 * useful bytes it contains, and their location in the word, depends on the type of transfer
517 * and alignment. */
518 while (nbytes > 0) {
519 uint32_t this_size = size;
520
521 /* Select packed transfer if possible */
522 if (addrinc && ap->packed_transfers && nbytes >= 4
523 && max_tar_block_size(ap->tar_autoincr_block, address) >= 4) {
524 this_size = 4;
525 retval = mem_ap_setup_csw(ap, csw_size | CSW_ADDRINC_PACKED);
526 } else {
527 retval = mem_ap_setup_csw(ap, csw_size | csw_addrincr);
528 }
529 if (retval != ERROR_OK)
530 break;
531
532 retval = mem_ap_setup_tar(ap, address);
533 if (retval != ERROR_OK)
534 break;
535
536 retval = dap_queue_ap_read(ap, MEM_AP_REG_DRW, read_ptr++);
537 if (retval != ERROR_OK)
538 break;
539
540 nbytes -= this_size;
541 if (addrinc)
542 address += this_size;
543
544 mem_ap_update_tar_cache(ap);
545 }
546
547 if (retval == ERROR_OK)
548 retval = dap_run(dap);
549
550 /* Restore state */
551 address = adr;
552 nbytes = size * count;
553 read_ptr = read_buf;
554
555 /* If something failed, read TAR to find out how much data was successfully read, so we can
556 * at least give the caller what we have. */
557 if (retval != ERROR_OK) {
558 target_addr_t tar;
559 if (mem_ap_read_tar(ap, &tar) == ERROR_OK) {
560 /* TAR is incremented after failed transfer on some devices (eg Cortex-M4) */
561 LOG_ERROR("Failed to read memory at " TARGET_ADDR_FMT, tar);
562 if (nbytes > tar - address)
563 nbytes = tar - address;
564 } else {
565 LOG_ERROR("Failed to read memory and, additionally, failed to find out where");
566 nbytes = 0;
567 }
568 }
569
570 /* Replay loop to populate caller's buffer from the correct word and byte lane */
571 while (nbytes > 0) {
572 uint32_t this_size = size;
573
574 if (addrinc && ap->packed_transfers && nbytes >= 4
575 && max_tar_block_size(ap->tar_autoincr_block, address) >= 4) {
576 this_size = 4;
577 }
578
579 if (dap->ti_be_32_quirks) {
580 switch (this_size) {
581 case 4:
582 *buffer++ = *read_ptr >> 8 * (3 - (address++ & 3));
583 *buffer++ = *read_ptr >> 8 * (3 - (address++ & 3));
584 /* fallthrough */
585 case 2:
586 *buffer++ = *read_ptr >> 8 * (3 - (address++ & 3));
587 /* fallthrough */
588 case 1:
589 *buffer++ = *read_ptr >> 8 * (3 - (address++ & 3));
590 }
591 } else {
592 switch (this_size) {
593 case 4:
594 *buffer++ = *read_ptr >> 8 * (address++ & 3);
595 *buffer++ = *read_ptr >> 8 * (address++ & 3);
596 /* fallthrough */
597 case 2:
598 *buffer++ = *read_ptr >> 8 * (address++ & 3);
599 /* fallthrough */
600 case 1:
601 *buffer++ = *read_ptr >> 8 * (address++ & 3);
602 }
603 }
604
605 read_ptr++;
606 nbytes -= this_size;
607 }
608
609 free(read_buf);
610 return retval;
611 }
612
613 int mem_ap_read_buf(struct adiv5_ap *ap,
614 uint8_t *buffer, uint32_t size, uint32_t count, target_addr_t address)
615 {
616 return mem_ap_read(ap, buffer, size, count, address, true);
617 }
618
619 int mem_ap_write_buf(struct adiv5_ap *ap,
620 const uint8_t *buffer, uint32_t size, uint32_t count, target_addr_t address)
621 {
622 return mem_ap_write(ap, buffer, size, count, address, true);
623 }
624
625 int mem_ap_read_buf_noincr(struct adiv5_ap *ap,
626 uint8_t *buffer, uint32_t size, uint32_t count, target_addr_t address)
627 {
628 return mem_ap_read(ap, buffer, size, count, address, false);
629 }
630
631 int mem_ap_write_buf_noincr(struct adiv5_ap *ap,
632 const uint8_t *buffer, uint32_t size, uint32_t count, target_addr_t address)
633 {
634 return mem_ap_write(ap, buffer, size, count, address, false);
635 }
636
637 /*--------------------------------------------------------------------------*/
638
639
640 #define DAP_POWER_DOMAIN_TIMEOUT (10)
641
642 /*--------------------------------------------------------------------------*/
643
644 /**
645 * Invalidate cached DP select and cached TAR and CSW of all APs
646 */
647 void dap_invalidate_cache(struct adiv5_dap *dap)
648 {
649 dap->select = DP_SELECT_INVALID;
650 dap->last_read = NULL;
651
652 int i;
653 for (i = 0; i <= DP_APSEL_MAX; i++) {
654 /* force csw and tar write on the next mem-ap access */
655 dap->ap[i].tar_valid = false;
656 dap->ap[i].csw_value = 0;
657 }
658 }
659
660 /**
661 * Initialize a DAP. This sets up the power domains, prepares the DP
662 * for further use and activates overrun checking.
663 *
664 * @param dap The DAP being initialized.
665 */
666 int dap_dp_init(struct adiv5_dap *dap)
667 {
668 int retval;
669
670 LOG_DEBUG("%s", adiv5_dap_name(dap));
671
672 dap->do_reconnect = false;
673 dap_invalidate_cache(dap);
674
675 /*
676 * Early initialize dap->dp_ctrl_stat.
677 * In jtag mode only, if the following queue run (in dap_dp_poll_register)
678 * fails and sets the sticky error, it will trigger the clearing
679 * of the sticky. Without this initialization system and debug power
680 * would be disabled while clearing the sticky error bit.
681 */
682 dap->dp_ctrl_stat = CDBGPWRUPREQ | CSYSPWRUPREQ;
683
684 /*
685 * This write operation clears the sticky error bit in jtag mode only and
686 * is ignored in swd mode. It also powers-up system and debug domains in
687 * both jtag and swd modes, if not done before.
688 */
689 retval = dap_queue_dp_write(dap, DP_CTRL_STAT, dap->dp_ctrl_stat | SSTICKYERR);
690 if (retval != ERROR_OK)
691 return retval;
692
693 retval = dap_queue_dp_read(dap, DP_CTRL_STAT, NULL);
694 if (retval != ERROR_OK)
695 return retval;
696
697 retval = dap_queue_dp_write(dap, DP_CTRL_STAT, dap->dp_ctrl_stat);
698 if (retval != ERROR_OK)
699 return retval;
700
701 /* Check that we have debug power domains activated */
702 LOG_DEBUG("DAP: wait CDBGPWRUPACK");
703 retval = dap_dp_poll_register(dap, DP_CTRL_STAT,
704 CDBGPWRUPACK, CDBGPWRUPACK,
705 DAP_POWER_DOMAIN_TIMEOUT);
706 if (retval != ERROR_OK)
707 return retval;
708
709 if (!dap->ignore_syspwrupack) {
710 LOG_DEBUG("DAP: wait CSYSPWRUPACK");
711 retval = dap_dp_poll_register(dap, DP_CTRL_STAT,
712 CSYSPWRUPACK, CSYSPWRUPACK,
713 DAP_POWER_DOMAIN_TIMEOUT);
714 if (retval != ERROR_OK)
715 return retval;
716 }
717
718 retval = dap_queue_dp_read(dap, DP_CTRL_STAT, NULL);
719 if (retval != ERROR_OK)
720 return retval;
721
722 /* With debug power on we can activate OVERRUN checking */
723 dap->dp_ctrl_stat = CDBGPWRUPREQ | CSYSPWRUPREQ | CORUNDETECT;
724 retval = dap_queue_dp_write(dap, DP_CTRL_STAT, dap->dp_ctrl_stat);
725 if (retval != ERROR_OK)
726 return retval;
727 retval = dap_queue_dp_read(dap, DP_CTRL_STAT, NULL);
728 if (retval != ERROR_OK)
729 return retval;
730
731 retval = dap_run(dap);
732 if (retval != ERROR_OK)
733 return retval;
734
735 return retval;
736 }
737
738 /**
739 * Initialize a DAP or do reconnect if DAP is not accessible.
740 *
741 * @param dap The DAP being initialized.
742 */
743 int dap_dp_init_or_reconnect(struct adiv5_dap *dap)
744 {
745 LOG_DEBUG("%s", adiv5_dap_name(dap));
746
747 /*
748 * Early initialize dap->dp_ctrl_stat.
749 * In jtag mode only, if the following atomic reads fail and set the
750 * sticky error, it will trigger the clearing of the sticky. Without this
751 * initialization system and debug power would be disabled while clearing
752 * the sticky error bit.
753 */
754 dap->dp_ctrl_stat = CDBGPWRUPREQ | CSYSPWRUPREQ;
755
756 dap->do_reconnect = false;
757
758 dap_dp_read_atomic(dap, DP_CTRL_STAT, NULL);
759 if (dap->do_reconnect) {
760 /* dap connect calls dap_dp_init() after transport dependent initialization */
761 return dap->ops->connect(dap);
762 } else {
763 return dap_dp_init(dap);
764 }
765 }
766
767 /**
768 * Initialize a DAP. This sets up the power domains, prepares the DP
769 * for further use, and arranges to use AP #0 for all AP operations
770 * until dap_ap-select() changes that policy.
771 *
772 * @param ap The MEM-AP being initialized.
773 */
774 int mem_ap_init(struct adiv5_ap *ap)
775 {
776 /* check that we support packed transfers */
777 uint32_t csw, cfg;
778 int retval;
779 struct adiv5_dap *dap = ap->dap;
780
781 /* Set ap->cfg_reg before calling mem_ap_setup_transfer(). */
782 /* mem_ap_setup_transfer() needs to know if the MEM_AP supports LPAE. */
783 retval = dap_queue_ap_read(ap, MEM_AP_REG_CFG, &cfg);
784 if (retval != ERROR_OK)
785 return retval;
786
787 retval = dap_run(dap);
788 if (retval != ERROR_OK)
789 return retval;
790
791 ap->cfg_reg = cfg;
792 ap->tar_valid = false;
793 ap->csw_value = 0; /* force csw and tar write */
794 retval = mem_ap_setup_transfer(ap, CSW_8BIT | CSW_ADDRINC_PACKED, 0);
795 if (retval != ERROR_OK)
796 return retval;
797
798 retval = dap_queue_ap_read(ap, MEM_AP_REG_CSW, &csw);
799 if (retval != ERROR_OK)
800 return retval;
801
802 retval = dap_run(dap);
803 if (retval != ERROR_OK)
804 return retval;
805
806 if (csw & CSW_ADDRINC_PACKED)
807 ap->packed_transfers = true;
808 else
809 ap->packed_transfers = false;
810
811 /* Packed transfers on TI BE-32 processors do not work correctly in
812 * many cases. */
813 if (dap->ti_be_32_quirks)
814 ap->packed_transfers = false;
815
816 LOG_DEBUG("MEM_AP Packed Transfers: %s",
817 ap->packed_transfers ? "enabled" : "disabled");
818
819 /* The ARM ADI spec leaves implementation-defined whether unaligned
820 * memory accesses work, only work partially, or cause a sticky error.
821 * On TI BE-32 processors, reads seem to return garbage in some bytes
822 * and unaligned writes seem to cause a sticky error.
823 * TODO: it would be nice to have a way to detect whether unaligned
824 * operations are supported on other processors. */
825 ap->unaligned_access_bad = dap->ti_be_32_quirks;
826
827 LOG_DEBUG("MEM_AP CFG: large data %d, long address %d, big-endian %d",
828 !!(cfg & MEM_AP_REG_CFG_LD), !!(cfg & MEM_AP_REG_CFG_LA), !!(cfg & MEM_AP_REG_CFG_BE));
829
830 return ERROR_OK;
831 }
832
833 /**
834 * Put the debug link into SWD mode, if the target supports it.
835 * The link's initial mode may be either JTAG (for example,
836 * with SWJ-DP after reset) or SWD.
837 *
838 * Note that targets using the JTAG-DP do not support SWD, and that
839 * some targets which could otherwise support it may have been
840 * configured to disable SWD signaling
841 *
842 * @param dap The DAP used
843 * @return ERROR_OK or else a fault code.
844 */
845 int dap_to_swd(struct adiv5_dap *dap)
846 {
847 LOG_DEBUG("Enter SWD mode");
848
849 return dap_send_sequence(dap, JTAG_TO_SWD);
850 }
851
852 /**
853 * Put the debug link into JTAG mode, if the target supports it.
854 * The link's initial mode may be either SWD or JTAG.
855 *
856 * Note that targets implemented with SW-DP do not support JTAG, and
857 * that some targets which could otherwise support it may have been
858 * configured to disable JTAG signaling
859 *
860 * @param dap The DAP used
861 * @return ERROR_OK or else a fault code.
862 */
863 int dap_to_jtag(struct adiv5_dap *dap)
864 {
865 LOG_DEBUG("Enter JTAG mode");
866
867 return dap_send_sequence(dap, SWD_TO_JTAG);
868 }
869
870 /* CID interpretation -- see ARM IHI 0029E table B2-7
871 * and ARM IHI 0031E table D1-2.
872 *
873 * From 2009/11/25 commit 21378f58b604:
874 * "OptimoDE DESS" is ARM's semicustom DSPish stuff.
875 * Let's keep it as is, for the time being
876 */
877 static const char *class_description[16] = {
878 [0x0] = "Generic verification component",
879 [0x1] = "ROM table",
880 [0x2] = "Reserved",
881 [0x3] = "Reserved",
882 [0x4] = "Reserved",
883 [0x5] = "Reserved",
884 [0x6] = "Reserved",
885 [0x7] = "Reserved",
886 [0x8] = "Reserved",
887 [0x9] = "CoreSight component",
888 [0xA] = "Reserved",
889 [0xB] = "Peripheral Test Block",
890 [0xC] = "Reserved",
891 [0xD] = "OptimoDE DESS", /* see above */
892 [0xE] = "Generic IP component",
893 [0xF] = "CoreLink, PrimeCell or System component",
894 };
895
896 #define ARCH_ID(architect, archid) ( \
897 (((architect) << ARM_CS_C9_DEVARCH_ARCHITECT_SHIFT) & ARM_CS_C9_DEVARCH_ARCHITECT_MASK) | \
898 (((archid) << ARM_CS_C9_DEVARCH_ARCHID_SHIFT) & ARM_CS_C9_DEVARCH_ARCHID_MASK) \
899 )
900
901 static const struct {
902 uint32_t arch_id;
903 const char *description;
904 } class0x9_devarch[] = {
905 /* keep same unsorted order as in ARM IHI0029E */
906 { ARCH_ID(ARM_ID, 0x0A00), "RAS architecture" },
907 { ARCH_ID(ARM_ID, 0x1A01), "Instrumentation Trace Macrocell (ITM) architecture" },
908 { ARCH_ID(ARM_ID, 0x1A02), "DWT architecture" },
909 { ARCH_ID(ARM_ID, 0x1A03), "Flash Patch and Breakpoint unit (FPB) architecture" },
910 { ARCH_ID(ARM_ID, 0x2A04), "Processor debug architecture (ARMv8-M)" },
911 { ARCH_ID(ARM_ID, 0x6A05), "Processor debug architecture (ARMv8-R)" },
912 { ARCH_ID(ARM_ID, 0x0A10), "PC sample-based profiling" },
913 { ARCH_ID(ARM_ID, 0x4A13), "Embedded Trace Macrocell (ETM) architecture" },
914 { ARCH_ID(ARM_ID, 0x1A14), "Cross Trigger Interface (CTI) architecture" },
915 { ARCH_ID(ARM_ID, 0x6A15), "Processor debug architecture (v8.0-A)" },
916 { ARCH_ID(ARM_ID, 0x7A15), "Processor debug architecture (v8.1-A)" },
917 { ARCH_ID(ARM_ID, 0x8A15), "Processor debug architecture (v8.2-A)" },
918 { ARCH_ID(ARM_ID, 0x2A16), "Processor Performance Monitor (PMU) architecture" },
919 { ARCH_ID(ARM_ID, 0x0A17), "Memory Access Port v2 architecture" },
920 { ARCH_ID(ARM_ID, 0x0A27), "JTAG Access Port v2 architecture" },
921 { ARCH_ID(ARM_ID, 0x0A31), "Basic trace router" },
922 { ARCH_ID(ARM_ID, 0x0A37), "Power requestor" },
923 { ARCH_ID(ARM_ID, 0x0A47), "Unknown Access Port v2 architecture" },
924 { ARCH_ID(ARM_ID, 0x0A50), "HSSTP architecture" },
925 { ARCH_ID(ARM_ID, 0x0A63), "System Trace Macrocell (STM) architecture" },
926 { ARCH_ID(ARM_ID, 0x0A75), "CoreSight ELA architecture" },
927 { ARCH_ID(ARM_ID, 0x0AF7), "CoreSight ROM architecture" },
928 };
929
930 #define DEVARCH_ID_MASK (ARM_CS_C9_DEVARCH_ARCHITECT_MASK | ARM_CS_C9_DEVARCH_ARCHID_MASK)
931 #define DEVARCH_ROM_C_0X9 ARCH_ID(ARM_ID, 0x0AF7)
932
933 static const char *class0x9_devarch_description(uint32_t devarch)
934 {
935 if (!(devarch & ARM_CS_C9_DEVARCH_PRESENT))
936 return "not present";
937
938 for (unsigned int i = 0; i < ARRAY_SIZE(class0x9_devarch); i++)
939 if ((devarch & DEVARCH_ID_MASK) == class0x9_devarch[i].arch_id)
940 return class0x9_devarch[i].description;
941
942 return "unknown";
943 }
944
945 static const struct {
946 enum ap_type type;
947 const char *description;
948 } ap_types[] = {
949 { AP_TYPE_JTAG_AP, "JTAG-AP" },
950 { AP_TYPE_COM_AP, "COM-AP" },
951 { AP_TYPE_AHB3_AP, "MEM-AP AHB3" },
952 { AP_TYPE_APB_AP, "MEM-AP APB2 or APB3" },
953 { AP_TYPE_AXI_AP, "MEM-AP AXI3 or AXI4" },
954 { AP_TYPE_AHB5_AP, "MEM-AP AHB5" },
955 { AP_TYPE_APB4_AP, "MEM-AP APB4" },
956 { AP_TYPE_AXI5_AP, "MEM-AP AXI5" },
957 { AP_TYPE_AHB5H_AP, "MEM-AP AHB5 with enhanced HPROT" },
958 };
959
960 static const char *ap_type_to_description(enum ap_type type)
961 {
962 for (unsigned int i = 0; i < ARRAY_SIZE(ap_types); i++)
963 if (type == ap_types[i].type)
964 return ap_types[i].description;
965
966 return "Unknown";
967 }
968
969 /*
970 * This function checks the ID for each access port to find the requested Access Port type
971 */
972 int dap_find_ap(struct adiv5_dap *dap, enum ap_type type_to_find, struct adiv5_ap **ap_out)
973 {
974 int ap_num;
975
976 /* Maximum AP number is 255 since the SELECT register is 8 bits */
977 for (ap_num = 0; ap_num <= DP_APSEL_MAX; ap_num++) {
978
979 /* read the IDR register of the Access Port */
980 uint32_t id_val = 0;
981
982 int retval = dap_queue_ap_read(dap_ap(dap, ap_num), AP_REG_IDR, &id_val);
983 if (retval != ERROR_OK)
984 return retval;
985
986 retval = dap_run(dap);
987
988 /* Reading register for a non-existent AP should not cause an error,
989 * but just to be sure, try to continue searching if an error does happen.
990 */
991 if (retval == ERROR_OK && (id_val & AP_TYPE_MASK) == type_to_find) {
992 LOG_DEBUG("Found %s at AP index: %d (IDR=0x%08" PRIX32 ")",
993 ap_type_to_description(type_to_find),
994 ap_num, id_val);
995
996 *ap_out = &dap->ap[ap_num];
997 return ERROR_OK;
998 }
999 }
1000
1001 LOG_DEBUG("No %s found", ap_type_to_description(type_to_find));
1002 return ERROR_FAIL;
1003 }
1004
1005 static int dap_get_debugbase(struct adiv5_ap *ap,
1006 target_addr_t *dbgbase, uint32_t *apid)
1007 {
1008 struct adiv5_dap *dap = ap->dap;
1009 int retval;
1010 uint32_t baseptr_upper, baseptr_lower;
1011
1012 if (ap->cfg_reg == MEM_AP_REG_CFG_INVALID) {
1013 retval = dap_queue_ap_read(ap, MEM_AP_REG_CFG, &ap->cfg_reg);
1014 if (retval != ERROR_OK)
1015 return retval;
1016 }
1017 retval = dap_queue_ap_read(ap, MEM_AP_REG_BASE, &baseptr_lower);
1018 if (retval != ERROR_OK)
1019 return retval;
1020 retval = dap_queue_ap_read(ap, AP_REG_IDR, apid);
1021 if (retval != ERROR_OK)
1022 return retval;
1023 /* MEM_AP_REG_BASE64 is defined as 'RES0'; can be read and then ignored on 32 bits AP */
1024 if (ap->cfg_reg == MEM_AP_REG_CFG_INVALID || is_64bit_ap(ap)) {
1025 retval = dap_queue_ap_read(ap, MEM_AP_REG_BASE64, &baseptr_upper);
1026 if (retval != ERROR_OK)
1027 return retval;
1028 }
1029
1030 retval = dap_run(dap);
1031 if (retval != ERROR_OK)
1032 return retval;
1033
1034 if (!is_64bit_ap(ap))
1035 baseptr_upper = 0;
1036 *dbgbase = (((target_addr_t)baseptr_upper) << 32) | baseptr_lower;
1037
1038 return ERROR_OK;
1039 }
1040
1041 static int _dap_lookup_cs_component(struct adiv5_ap *ap,
1042 target_addr_t dbgbase, uint8_t type, target_addr_t *addr, int32_t *idx)
1043 {
1044 uint32_t romentry, entry_offset = 0, devtype;
1045 target_addr_t component_base;
1046 int retval;
1047
1048 dbgbase &= 0xFFFFFFFFFFFFF000ull;
1049 *addr = 0;
1050
1051 do {
1052 retval = mem_ap_read_atomic_u32(ap, dbgbase |
1053 entry_offset, &romentry);
1054 if (retval != ERROR_OK)
1055 return retval;
1056
1057 component_base = dbgbase + (target_addr_t)(romentry & ARM_CS_ROMENTRY_OFFSET_MASK);
1058
1059 if (romentry & ARM_CS_ROMENTRY_PRESENT) {
1060 uint32_t c_cid1;
1061 retval = mem_ap_read_atomic_u32(ap, component_base + ARM_CS_CIDR1, &c_cid1);
1062 if (retval != ERROR_OK) {
1063 LOG_ERROR("Can't read component with base address " TARGET_ADDR_FMT
1064 ", the corresponding core might be turned off", component_base);
1065 return retval;
1066 }
1067 unsigned int class = (c_cid1 & ARM_CS_CIDR1_CLASS_MASK) >> ARM_CS_CIDR1_CLASS_SHIFT;
1068 if (class == ARM_CS_CLASS_0X1_ROM_TABLE) {
1069 retval = _dap_lookup_cs_component(ap, component_base,
1070 type, addr, idx);
1071 if (retval == ERROR_OK)
1072 break;
1073 if (retval != ERROR_TARGET_RESOURCE_NOT_AVAILABLE)
1074 return retval;
1075 }
1076
1077 retval = mem_ap_read_atomic_u32(ap, component_base + ARM_CS_C9_DEVTYPE, &devtype);
1078 if (retval != ERROR_OK)
1079 return retval;
1080 if ((devtype & ARM_CS_C9_DEVTYPE_MASK) == type) {
1081 if (!*idx) {
1082 *addr = component_base;
1083 break;
1084 } else
1085 (*idx)--;
1086 }
1087 }
1088 entry_offset += 4;
1089 } while ((romentry > 0) && (entry_offset < 0xf00));
1090
1091 if (!*addr)
1092 return ERROR_TARGET_RESOURCE_NOT_AVAILABLE;
1093
1094 return ERROR_OK;
1095 }
1096
1097 int dap_lookup_cs_component(struct adiv5_ap *ap, uint8_t type,
1098 target_addr_t *addr, int32_t core_id)
1099 {
1100 int32_t idx = core_id;
1101 target_addr_t dbgbase;
1102 uint32_t apid;
1103
1104 int retval = dap_get_debugbase(ap, &dbgbase, &apid);
1105 if (retval != ERROR_OK)
1106 return retval;
1107
1108 return _dap_lookup_cs_component(ap, dbgbase, type, addr, &idx);
1109 }
1110
1111 /** Holds registers and coordinates of a CoreSight component */
1112 struct cs_component_vals {
1113 struct adiv5_ap *ap;
1114 target_addr_t component_base;
1115 uint64_t pid;
1116 uint32_t cid;
1117 uint32_t devarch;
1118 uint32_t devid;
1119 uint32_t devtype_memtype;
1120 };
1121
1122 /**
1123 * Read the CoreSight registers needed during ROM Table Parsing (RTP).
1124 *
1125 * @param ap Pointer to AP containing the component.
1126 * @param component_base On MEM-AP access method, base address of the component.
1127 * @param v Pointer to the struct holding the value of registers.
1128 *
1129 * @return ERROR_OK on success, else a fault code.
1130 */
1131 static int rtp_read_cs_regs(struct adiv5_ap *ap, target_addr_t component_base,
1132 struct cs_component_vals *v)
1133 {
1134 assert(IS_ALIGNED(component_base, ARM_CS_ALIGN));
1135 assert(ap && v);
1136
1137 uint32_t cid0, cid1, cid2, cid3;
1138 uint32_t pid0, pid1, pid2, pid3, pid4;
1139 int retval = ERROR_OK;
1140
1141 v->ap = ap;
1142 v->component_base = component_base;
1143
1144 /* sort by offset to gain speed */
1145
1146 /*
1147 * Registers DEVARCH, DEVID and DEVTYPE are valid on Class 0x9 devices
1148 * only, but are at offset above 0xf00, so can be read on any device
1149 * without triggering error. Read them for eventual use on Class 0x9.
1150 */
1151 if (retval == ERROR_OK)
1152 retval = mem_ap_read_u32(ap, component_base + ARM_CS_C9_DEVARCH, &v->devarch);
1153
1154 if (retval == ERROR_OK)
1155 retval = mem_ap_read_u32(ap, component_base + ARM_CS_C9_DEVID, &v->devid);
1156
1157 /* Same address as ARM_CS_C1_MEMTYPE */
1158 if (retval == ERROR_OK)
1159 retval = mem_ap_read_u32(ap, component_base + ARM_CS_C9_DEVTYPE, &v->devtype_memtype);
1160
1161 if (retval == ERROR_OK)
1162 retval = mem_ap_read_u32(ap, component_base + ARM_CS_PIDR4, &pid4);
1163
1164 if (retval == ERROR_OK)
1165 retval = mem_ap_read_u32(ap, component_base + ARM_CS_PIDR0, &pid0);
1166 if (retval == ERROR_OK)
1167 retval = mem_ap_read_u32(ap, component_base + ARM_CS_PIDR1, &pid1);
1168 if (retval == ERROR_OK)
1169 retval = mem_ap_read_u32(ap, component_base + ARM_CS_PIDR2, &pid2);
1170 if (retval == ERROR_OK)
1171 retval = mem_ap_read_u32(ap, component_base + ARM_CS_PIDR3, &pid3);
1172
1173 if (retval == ERROR_OK)
1174 retval = mem_ap_read_u32(ap, component_base + ARM_CS_CIDR0, &cid0);
1175 if (retval == ERROR_OK)
1176 retval = mem_ap_read_u32(ap, component_base + ARM_CS_CIDR1, &cid1);
1177 if (retval == ERROR_OK)
1178 retval = mem_ap_read_u32(ap, component_base + ARM_CS_CIDR2, &cid2);
1179 if (retval == ERROR_OK)
1180 retval = mem_ap_read_u32(ap, component_base + ARM_CS_CIDR3, &cid3);
1181
1182 if (retval == ERROR_OK)
1183 retval = dap_run(ap->dap);
1184 if (retval != ERROR_OK) {
1185 LOG_DEBUG("Failed read CoreSight registers");
1186 return retval;
1187 }
1188
1189 v->cid = (cid3 & 0xff) << 24
1190 | (cid2 & 0xff) << 16
1191 | (cid1 & 0xff) << 8
1192 | (cid0 & 0xff);
1193 v->pid = (uint64_t)(pid4 & 0xff) << 32
1194 | (pid3 & 0xff) << 24
1195 | (pid2 & 0xff) << 16
1196 | (pid1 & 0xff) << 8
1197 | (pid0 & 0xff);
1198
1199 return ERROR_OK;
1200 }
1201
1202 /* Part number interpretations are from Cortex
1203 * core specs, the CoreSight components TRM
1204 * (ARM DDI 0314H), CoreSight System Design
1205 * Guide (ARM DGI 0012D) and ETM specs; also
1206 * from chip observation (e.g. TI SDTI).
1207 */
1208
1209 static const struct dap_part_nums {
1210 uint16_t designer_id;
1211 uint16_t part_num;
1212 const char *type;
1213 const char *full;
1214 } dap_part_nums[] = {
1215 { ARM_ID, 0x000, "Cortex-M3 SCS", "(System Control Space)", },
1216 { ARM_ID, 0x001, "Cortex-M3 ITM", "(Instrumentation Trace Module)", },
1217 { ARM_ID, 0x002, "Cortex-M3 DWT", "(Data Watchpoint and Trace)", },
1218 { ARM_ID, 0x003, "Cortex-M3 FPB", "(Flash Patch and Breakpoint)", },
1219 { ARM_ID, 0x008, "Cortex-M0 SCS", "(System Control Space)", },
1220 { ARM_ID, 0x00a, "Cortex-M0 DWT", "(Data Watchpoint and Trace)", },
1221 { ARM_ID, 0x00b, "Cortex-M0 BPU", "(Breakpoint Unit)", },
1222 { ARM_ID, 0x00c, "Cortex-M4 SCS", "(System Control Space)", },
1223 { ARM_ID, 0x00d, "CoreSight ETM11", "(Embedded Trace)", },
1224 { ARM_ID, 0x00e, "Cortex-M7 FPB", "(Flash Patch and Breakpoint)", },
1225 { ARM_ID, 0x193, "SoC-600 TSGEN", "(Timestamp Generator)", },
1226 { ARM_ID, 0x470, "Cortex-M1 ROM", "(ROM Table)", },
1227 { ARM_ID, 0x471, "Cortex-M0 ROM", "(ROM Table)", },
1228 { ARM_ID, 0x490, "Cortex-A15 GIC", "(Generic Interrupt Controller)", },
1229 { ARM_ID, 0x492, "Cortex-R52 GICD", "(Distributor)", },
1230 { ARM_ID, 0x493, "Cortex-R52 GICR", "(Redistributor)", },
1231 { ARM_ID, 0x4a1, "Cortex-A53 ROM", "(v8 Memory Map ROM Table)", },
1232 { ARM_ID, 0x4a2, "Cortex-A57 ROM", "(ROM Table)", },
1233 { ARM_ID, 0x4a3, "Cortex-A53 ROM", "(v7 Memory Map ROM Table)", },
1234 { ARM_ID, 0x4a4, "Cortex-A72 ROM", "(ROM Table)", },
1235 { ARM_ID, 0x4a9, "Cortex-A9 ROM", "(ROM Table)", },
1236 { ARM_ID, 0x4aa, "Cortex-A35 ROM", "(v8 Memory Map ROM Table)", },
1237 { ARM_ID, 0x4af, "Cortex-A15 ROM", "(ROM Table)", },
1238 { ARM_ID, 0x4b5, "Cortex-R5 ROM", "(ROM Table)", },
1239 { ARM_ID, 0x4b8, "Cortex-R52 ROM", "(ROM Table)", },
1240 { ARM_ID, 0x4c0, "Cortex-M0+ ROM", "(ROM Table)", },
1241 { ARM_ID, 0x4c3, "Cortex-M3 ROM", "(ROM Table)", },
1242 { ARM_ID, 0x4c4, "Cortex-M4 ROM", "(ROM Table)", },
1243 { ARM_ID, 0x4c7, "Cortex-M7 PPB ROM", "(Private Peripheral Bus ROM Table)", },
1244 { ARM_ID, 0x4c8, "Cortex-M7 ROM", "(ROM Table)", },
1245 { ARM_ID, 0x4e0, "Cortex-A35 ROM", "(v7 Memory Map ROM Table)", },
1246 { ARM_ID, 0x4e4, "Cortex-A76 ROM", "(ROM Table)", },
1247 { ARM_ID, 0x906, "CoreSight CTI", "(Cross Trigger)", },
1248 { ARM_ID, 0x907, "CoreSight ETB", "(Trace Buffer)", },
1249 { ARM_ID, 0x908, "CoreSight CSTF", "(Trace Funnel)", },
1250 { ARM_ID, 0x909, "CoreSight ATBR", "(Advanced Trace Bus Replicator)", },
1251 { ARM_ID, 0x910, "CoreSight ETM9", "(Embedded Trace)", },
1252 { ARM_ID, 0x912, "CoreSight TPIU", "(Trace Port Interface Unit)", },
1253 { ARM_ID, 0x913, "CoreSight ITM", "(Instrumentation Trace Macrocell)", },
1254 { ARM_ID, 0x914, "CoreSight SWO", "(Single Wire Output)", },
1255 { ARM_ID, 0x917, "CoreSight HTM", "(AHB Trace Macrocell)", },
1256 { ARM_ID, 0x920, "CoreSight ETM11", "(Embedded Trace)", },
1257 { ARM_ID, 0x921, "Cortex-A8 ETM", "(Embedded Trace)", },
1258 { ARM_ID, 0x922, "Cortex-A8 CTI", "(Cross Trigger)", },
1259 { ARM_ID, 0x923, "Cortex-M3 TPIU", "(Trace Port Interface Unit)", },
1260 { ARM_ID, 0x924, "Cortex-M3 ETM", "(Embedded Trace)", },
1261 { ARM_ID, 0x925, "Cortex-M4 ETM", "(Embedded Trace)", },
1262 { ARM_ID, 0x930, "Cortex-R4 ETM", "(Embedded Trace)", },
1263 { ARM_ID, 0x931, "Cortex-R5 ETM", "(Embedded Trace)", },
1264 { ARM_ID, 0x932, "CoreSight MTB-M0+", "(Micro Trace Buffer)", },
1265 { ARM_ID, 0x941, "CoreSight TPIU-Lite", "(Trace Port Interface Unit)", },
1266 { ARM_ID, 0x950, "Cortex-A9 PTM", "(Program Trace Macrocell)", },
1267 { ARM_ID, 0x955, "Cortex-A5 ETM", "(Embedded Trace)", },
1268 { ARM_ID, 0x95a, "Cortex-A72 ETM", "(Embedded Trace)", },
1269 { ARM_ID, 0x95b, "Cortex-A17 PTM", "(Program Trace Macrocell)", },
1270 { ARM_ID, 0x95d, "Cortex-A53 ETM", "(Embedded Trace)", },
1271 { ARM_ID, 0x95e, "Cortex-A57 ETM", "(Embedded Trace)", },
1272 { ARM_ID, 0x95f, "Cortex-A15 PTM", "(Program Trace Macrocell)", },
1273 { ARM_ID, 0x961, "CoreSight TMC", "(Trace Memory Controller)", },
1274 { ARM_ID, 0x962, "CoreSight STM", "(System Trace Macrocell)", },
1275 { ARM_ID, 0x975, "Cortex-M7 ETM", "(Embedded Trace)", },
1276 { ARM_ID, 0x9a0, "CoreSight PMU", "(Performance Monitoring Unit)", },
1277 { ARM_ID, 0x9a1, "Cortex-M4 TPIU", "(Trace Port Interface Unit)", },
1278 { ARM_ID, 0x9a4, "CoreSight GPR", "(Granular Power Requester)", },
1279 { ARM_ID, 0x9a5, "Cortex-A5 PMU", "(Performance Monitor Unit)", },
1280 { ARM_ID, 0x9a7, "Cortex-A7 PMU", "(Performance Monitor Unit)", },
1281 { ARM_ID, 0x9a8, "Cortex-A53 CTI", "(Cross Trigger)", },
1282 { ARM_ID, 0x9a9, "Cortex-M7 TPIU", "(Trace Port Interface Unit)", },
1283 { ARM_ID, 0x9ae, "Cortex-A17 PMU", "(Performance Monitor Unit)", },
1284 { ARM_ID, 0x9af, "Cortex-A15 PMU", "(Performance Monitor Unit)", },
1285 { ARM_ID, 0x9b6, "Cortex-R52 PMU/CTI/ETM", "(Performance Monitor Unit/Cross Trigger/ETM)", },
1286 { ARM_ID, 0x9b7, "Cortex-R7 PMU", "(Performance Monitor Unit)", },
1287 { ARM_ID, 0x9d3, "Cortex-A53 PMU", "(Performance Monitor Unit)", },
1288 { ARM_ID, 0x9d7, "Cortex-A57 PMU", "(Performance Monitor Unit)", },
1289 { ARM_ID, 0x9d8, "Cortex-A72 PMU", "(Performance Monitor Unit)", },
1290 { ARM_ID, 0x9da, "Cortex-A35 PMU/CTI/ETM", "(Performance Monitor Unit/Cross Trigger/ETM)", },
1291 { ARM_ID, 0x9e2, "SoC-600 APB-AP", "(APB4 Memory Access Port)", },
1292 { ARM_ID, 0x9e3, "SoC-600 AHB-AP", "(AHB5 Memory Access Port)", },
1293 { ARM_ID, 0x9e4, "SoC-600 AXI-AP", "(AXI Memory Access Port)", },
1294 { ARM_ID, 0x9e5, "SoC-600 APv1 Adapter", "(Access Port v1 Adapter)", },
1295 { ARM_ID, 0x9e6, "SoC-600 JTAG-AP", "(JTAG Access Port)", },
1296 { ARM_ID, 0x9e7, "SoC-600 TPIU", "(Trace Port Interface Unit)", },
1297 { ARM_ID, 0x9e8, "SoC-600 TMC ETR/ETS", "(Embedded Trace Router/Streamer)", },
1298 { ARM_ID, 0x9e9, "SoC-600 TMC ETB", "(Embedded Trace Buffer)", },
1299 { ARM_ID, 0x9ea, "SoC-600 TMC ETF", "(Embedded Trace FIFO)", },
1300 { ARM_ID, 0x9eb, "SoC-600 ATB Funnel", "(Trace Funnel)", },
1301 { ARM_ID, 0x9ec, "SoC-600 ATB Replicator", "(Trace Replicator)", },
1302 { ARM_ID, 0x9ed, "SoC-600 CTI", "(Cross Trigger)", },
1303 { ARM_ID, 0x9ee, "SoC-600 CATU", "(Address Translation Unit)", },
1304 { ARM_ID, 0xc05, "Cortex-A5 Debug", "(Debug Unit)", },
1305 { ARM_ID, 0xc07, "Cortex-A7 Debug", "(Debug Unit)", },
1306 { ARM_ID, 0xc08, "Cortex-A8 Debug", "(Debug Unit)", },
1307 { ARM_ID, 0xc09, "Cortex-A9 Debug", "(Debug Unit)", },
1308 { ARM_ID, 0xc0e, "Cortex-A17 Debug", "(Debug Unit)", },
1309 { ARM_ID, 0xc0f, "Cortex-A15 Debug", "(Debug Unit)", },
1310 { ARM_ID, 0xc14, "Cortex-R4 Debug", "(Debug Unit)", },
1311 { ARM_ID, 0xc15, "Cortex-R5 Debug", "(Debug Unit)", },
1312 { ARM_ID, 0xc17, "Cortex-R7 Debug", "(Debug Unit)", },
1313 { ARM_ID, 0xd03, "Cortex-A53 Debug", "(Debug Unit)", },
1314 { ARM_ID, 0xd04, "Cortex-A35 Debug", "(Debug Unit)", },
1315 { ARM_ID, 0xd07, "Cortex-A57 Debug", "(Debug Unit)", },
1316 { ARM_ID, 0xd08, "Cortex-A72 Debug", "(Debug Unit)", },
1317 { ARM_ID, 0xd0b, "Cortex-A76 Debug", "(Debug Unit)", },
1318 { ARM_ID, 0xd0c, "Neoverse N1", "(Debug Unit)", },
1319 { ARM_ID, 0xd13, "Cortex-R52 Debug", "(Debug Unit)", },
1320 { ARM_ID, 0xd49, "Neoverse N2", "(Debug Unit)", },
1321 { 0x017, 0x120, "TI SDTI", "(System Debug Trace Interface)", }, /* from OMAP3 memmap */
1322 { 0x017, 0x343, "TI DAPCTL", "", }, /* from OMAP3 memmap */
1323 { 0x017, 0x9af, "MSP432 ROM", "(ROM Table)" },
1324 { 0x01f, 0xcd0, "Atmel CPU with DSU", "(CPU)" },
1325 { 0x041, 0x1db, "XMC4500 ROM", "(ROM Table)" },
1326 { 0x041, 0x1df, "XMC4700/4800 ROM", "(ROM Table)" },
1327 { 0x041, 0x1ed, "XMC1000 ROM", "(ROM Table)" },
1328 { 0x065, 0x000, "SHARC+/Blackfin+", "", },
1329 { 0x070, 0x440, "Qualcomm QDSS Component v1", "(Qualcomm Designed CoreSight Component v1)", },
1330 { 0x0bf, 0x100, "Brahma-B53 Debug", "(Debug Unit)", },
1331 { 0x0bf, 0x9d3, "Brahma-B53 PMU", "(Performance Monitor Unit)", },
1332 { 0x0bf, 0x4a1, "Brahma-B53 ROM", "(ROM Table)", },
1333 { 0x0bf, 0x721, "Brahma-B53 ROM", "(ROM Table)", },
1334 { 0x1eb, 0x181, "Tegra 186 ROM", "(ROM Table)", },
1335 { 0x1eb, 0x202, "Denver ETM", "(Denver Embedded Trace)", },
1336 { 0x1eb, 0x211, "Tegra 210 ROM", "(ROM Table)", },
1337 { 0x1eb, 0x302, "Denver Debug", "(Debug Unit)", },
1338 { 0x1eb, 0x402, "Denver PMU", "(Performance Monitor Unit)", },
1339 };
1340
1341 static const struct dap_part_nums *pidr_to_part_num(unsigned int designer_id, unsigned int part_num)
1342 {
1343 static const struct dap_part_nums unknown = {
1344 .type = "Unrecognized",
1345 .full = "",
1346 };
1347
1348 for (unsigned int i = 0; i < ARRAY_SIZE(dap_part_nums); i++)
1349 if (dap_part_nums[i].designer_id == designer_id && dap_part_nums[i].part_num == part_num)
1350 return &dap_part_nums[i];
1351
1352 return &unknown;
1353 }
1354
1355 static int dap_devtype_display(struct command_invocation *cmd, uint32_t devtype)
1356 {
1357 const char *major = "Reserved", *subtype = "Reserved";
1358 const unsigned int minor = (devtype & ARM_CS_C9_DEVTYPE_SUB_MASK) >> ARM_CS_C9_DEVTYPE_SUB_SHIFT;
1359 const unsigned int devtype_major = (devtype & ARM_CS_C9_DEVTYPE_MAJOR_MASK) >> ARM_CS_C9_DEVTYPE_MAJOR_SHIFT;
1360 switch (devtype_major) {
1361 case 0:
1362 major = "Miscellaneous";
1363 switch (minor) {
1364 case 0:
1365 subtype = "other";
1366 break;
1367 case 4:
1368 subtype = "Validation component";
1369 break;
1370 }
1371 break;
1372 case 1:
1373 major = "Trace Sink";
1374 switch (minor) {
1375 case 0:
1376 subtype = "other";
1377 break;
1378 case 1:
1379 subtype = "Port";
1380 break;
1381 case 2:
1382 subtype = "Buffer";
1383 break;
1384 case 3:
1385 subtype = "Router";
1386 break;
1387 }
1388 break;
1389 case 2:
1390 major = "Trace Link";
1391 switch (minor) {
1392 case 0:
1393 subtype = "other";
1394 break;
1395 case 1:
1396 subtype = "Funnel, router";
1397 break;
1398 case 2:
1399 subtype = "Filter";
1400 break;
1401 case 3:
1402 subtype = "FIFO, buffer";
1403 break;
1404 }
1405 break;
1406 case 3:
1407 major = "Trace Source";
1408 switch (minor) {
1409 case 0:
1410 subtype = "other";
1411 break;
1412 case 1:
1413 subtype = "Processor";
1414 break;
1415 case 2:
1416 subtype = "DSP";
1417 break;
1418 case 3:
1419 subtype = "Engine/Coprocessor";
1420 break;
1421 case 4:
1422 subtype = "Bus";
1423 break;
1424 case 6:
1425 subtype = "Software";
1426 break;
1427 }
1428 break;
1429 case 4:
1430 major = "Debug Control";
1431 switch (minor) {
1432 case 0:
1433 subtype = "other";
1434 break;
1435 case 1:
1436 subtype = "Trigger Matrix";
1437 break;
1438 case 2:
1439 subtype = "Debug Auth";
1440 break;
1441 case 3:
1442 subtype = "Power Requestor";
1443 break;
1444 }
1445 break;
1446 case 5:
1447 major = "Debug Logic";
1448 switch (minor) {
1449 case 0:
1450 subtype = "other";
1451 break;
1452 case 1:
1453 subtype = "Processor";
1454 break;
1455 case 2:
1456 subtype = "DSP";
1457 break;
1458 case 3:
1459 subtype = "Engine/Coprocessor";
1460 break;
1461 case 4:
1462 subtype = "Bus";
1463 break;
1464 case 5:
1465 subtype = "Memory";
1466 break;
1467 }
1468 break;
1469 case 6:
1470 major = "Performance Monitor";
1471 switch (minor) {
1472 case 0:
1473 subtype = "other";
1474 break;
1475 case 1:
1476 subtype = "Processor";
1477 break;
1478 case 2:
1479 subtype = "DSP";
1480 break;
1481 case 3:
1482 subtype = "Engine/Coprocessor";
1483 break;
1484 case 4:
1485 subtype = "Bus";
1486 break;
1487 case 5:
1488 subtype = "Memory";
1489 break;
1490 }
1491 break;
1492 }
1493 command_print(cmd, "\t\tType is 0x%02x, %s, %s",
1494 devtype & ARM_CS_C9_DEVTYPE_MASK,
1495 major, subtype);
1496 return ERROR_OK;
1497 }
1498
1499 /**
1500 * Actions/operations to be executed while parsing ROM tables.
1501 */
1502 struct rtp_ops {
1503 /**
1504 * Executed at the start of a new MEM-AP, typically to print the MEM-AP header.
1505 * @param retval Error encountered while reading AP.
1506 * @param ap Pointer to AP.
1507 * @param dbgbase Value of MEM-AP Debug Base Address register.
1508 * @param apid Value of MEM-AP IDR Identification Register.
1509 * @param priv Pointer to private data.
1510 * @return ERROR_OK on success, else a fault code.
1511 */
1512 int (*mem_ap_header)(int retval, struct adiv5_ap *ap, uint64_t dbgbase,
1513 uint32_t apid, void *priv);
1514 /**
1515 * Executed when a CoreSight component is parsed, typically to print
1516 * information on the component.
1517 * @param retval Error encountered while reading component's registers.
1518 * @param v Pointer to a container of the component's registers.
1519 * @param depth The current depth level of ROM table.
1520 * @param priv Pointer to private data.
1521 * @return ERROR_OK on success, else a fault code.
1522 */
1523 int (*cs_component)(int retval, struct cs_component_vals *v, int depth, void *priv);
1524 /**
1525 * Executed for each entry of a ROM table, typically to print the entry
1526 * and information about validity or end-of-table mark.
1527 * @param retval Error encountered while reading the ROM table entry.
1528 * @param depth The current depth level of ROM table.
1529 * @param offset The offset of the entry in the ROM table.
1530 * @param romentry The value of the ROM table entry.
1531 * @param priv Pointer to private data.
1532 * @return ERROR_OK on success, else a fault code.
1533 */
1534 int (*rom_table_entry)(int retval, int depth, unsigned int offset, uint32_t romentry,
1535 void *priv);
1536 /**
1537 * Private data
1538 */
1539 void *priv;
1540 };
1541
1542 /**
1543 * Wrapper around struct rtp_ops::mem_ap_header.
1544 * Input parameter @a retval is propagated.
1545 */
1546 static int rtp_ops_mem_ap_header(const struct rtp_ops *ops,
1547 int retval, struct adiv5_ap *ap, uint64_t dbgbase, uint32_t apid)
1548 {
1549 if (!ops->mem_ap_header)
1550 return retval;
1551
1552 int retval1 = ops->mem_ap_header(retval, ap, dbgbase, apid, ops->priv);
1553 if (retval != ERROR_OK)
1554 return retval;
1555 return retval1;
1556 }
1557
1558 /**
1559 * Wrapper around struct rtp_ops::cs_component.
1560 * Input parameter @a retval is propagated.
1561 */
1562 static int rtp_ops_cs_component(const struct rtp_ops *ops,
1563 int retval, struct cs_component_vals *v, int depth)
1564 {
1565 if (!ops->cs_component)
1566 return retval;
1567
1568 int retval1 = ops->cs_component(retval, v, depth, ops->priv);
1569 if (retval != ERROR_OK)
1570 return retval;
1571 return retval1;
1572 }
1573
1574 /**
1575 * Wrapper around struct rtp_ops::rom_table_entry.
1576 * Input parameter @a retval is propagated.
1577 */
1578 static int rtp_ops_rom_table_entry(const struct rtp_ops *ops,
1579 int retval, int depth, unsigned int offset, uint32_t romentry)
1580 {
1581 if (!ops->rom_table_entry)
1582 return retval;
1583
1584 int retval1 = ops->rom_table_entry(retval, depth, offset, romentry, ops->priv);
1585 if (retval != ERROR_OK)
1586 return retval;
1587 return retval1;
1588 }
1589
1590 /* Broken ROM tables can have circular references. Stop after a while */
1591 #define ROM_TABLE_MAX_DEPTH (16)
1592
1593 static int rtp_cs_component(const struct rtp_ops *ops,
1594 struct adiv5_ap *ap, target_addr_t dbgbase, int depth);
1595
1596 static int rtp_rom_loop(const struct rtp_ops *ops,
1597 struct adiv5_ap *ap, target_addr_t base_address, int depth,
1598 unsigned int max_entries)
1599 {
1600 assert(IS_ALIGNED(base_address, ARM_CS_ALIGN));
1601
1602 unsigned int offset = 0;
1603 while (max_entries--) {
1604 uint32_t romentry;
1605 unsigned int saved_offset = offset;
1606
1607 int retval = mem_ap_read_atomic_u32(ap, base_address + offset, &romentry);
1608 offset += 4;
1609 if (retval != ERROR_OK)
1610 LOG_DEBUG("Failed read ROM table entry");
1611
1612 retval = rtp_ops_rom_table_entry(ops, retval, depth, saved_offset, romentry);
1613 if (retval != ERROR_OK)
1614 return retval;
1615
1616 if (romentry == 0) {
1617 /* End of ROM table */
1618 break;
1619 }
1620
1621 if (!(romentry & ARM_CS_ROMENTRY_PRESENT))
1622 continue;
1623
1624 /* Recurse. "romentry" is signed */
1625 target_addr_t component_base = base_address + (int32_t)(romentry & ARM_CS_ROMENTRY_OFFSET_MASK);
1626 retval = rtp_cs_component(ops, ap, component_base, depth + 1);
1627 if (retval != ERROR_OK) {
1628 /* TODO: do we need to send an ABORT before continuing? */
1629 LOG_DEBUG("Ignore error parsing CoreSight component");
1630 continue;
1631 }
1632 }
1633
1634 return ERROR_OK;
1635 }
1636
1637 static int rtp_cs_component(const struct rtp_ops *ops,
1638 struct adiv5_ap *ap, target_addr_t base_address, int depth)
1639 {
1640 struct cs_component_vals v;
1641 int retval;
1642
1643 assert(IS_ALIGNED(base_address, ARM_CS_ALIGN));
1644
1645 if (depth > ROM_TABLE_MAX_DEPTH)
1646 retval = ERROR_FAIL;
1647 else
1648 retval = rtp_read_cs_regs(ap, base_address, &v);
1649
1650 retval = rtp_ops_cs_component(ops, retval, &v, depth);
1651 if (retval != ERROR_OK)
1652 return ERROR_OK; /* Don't abort recursion */
1653
1654 if (!is_valid_arm_cs_cidr(v.cid))
1655 return ERROR_OK; /* Don't abort recursion */
1656
1657 const unsigned int class = ARM_CS_CIDR_CLASS(v.cid);
1658
1659 if (class == ARM_CS_CLASS_0X1_ROM_TABLE)
1660 return rtp_rom_loop(ops, ap, base_address, depth, 960);
1661
1662 if (class == ARM_CS_CLASS_0X9_CS_COMPONENT) {
1663 if ((v.devarch & ARM_CS_C9_DEVARCH_PRESENT) == 0)
1664 return ERROR_OK;
1665
1666 /* quit if not ROM table */
1667 if ((v.devarch & DEVARCH_ID_MASK) != DEVARCH_ROM_C_0X9)
1668 return ERROR_OK;
1669
1670 return rtp_rom_loop(ops, ap, base_address, depth, 512);
1671 }
1672
1673 /* Class other than 0x1 and 0x9 */
1674 return ERROR_OK;
1675 }
1676
1677 static int rtp_ap(const struct rtp_ops *ops, struct adiv5_ap *ap)
1678 {
1679 int retval;
1680 uint32_t apid;
1681 target_addr_t dbgbase;
1682 target_addr_t invalid_entry;
1683
1684 /* Now we read ROM table ID registers, ref. ARM IHI 0029B sec */
1685 retval = dap_get_debugbase(ap, &dbgbase, &apid);
1686 retval = rtp_ops_mem_ap_header(ops, retval, ap, dbgbase, apid);
1687 if (retval != ERROR_OK)
1688 return retval;
1689
1690 if (apid == 0)
1691 return ERROR_FAIL;
1692
1693 /* NOTE: a MEM-AP may have a single CoreSight component that's
1694 * not a ROM table ... or have no such components at all.
1695 */
1696 const unsigned int class = (apid & AP_REG_IDR_CLASS_MASK) >> AP_REG_IDR_CLASS_SHIFT;
1697
1698 if (class == AP_REG_IDR_CLASS_MEM_AP) {
1699 if (is_64bit_ap(ap))
1700 invalid_entry = 0xFFFFFFFFFFFFFFFFull;
1701 else
1702 invalid_entry = 0xFFFFFFFFul;
1703
1704 if (dbgbase != invalid_entry && (dbgbase & 0x3) != 0x2)
1705 rtp_cs_component(ops, ap, dbgbase & 0xFFFFFFFFFFFFF000ull, 0);
1706 }
1707
1708 return ERROR_OK;
1709 }
1710
1711 /* Actions for command "dap info" */
1712
1713 static int dap_info_mem_ap_header(int retval, struct adiv5_ap *ap,
1714 target_addr_t dbgbase, uint32_t apid, void *priv)
1715 {
1716 struct command_invocation *cmd = priv;
1717 target_addr_t invalid_entry;
1718
1719 if (retval != ERROR_OK) {
1720 command_print(cmd, "\t\tCan't read MEM-AP, the corresponding core might be turned off");
1721 return retval;
1722 }
1723
1724 command_print(cmd, "AP ID register 0x%8.8" PRIx32, apid);
1725 if (apid == 0) {
1726 command_print(cmd, "No AP found at this ap 0x%x", ap->ap_num);
1727 return ERROR_FAIL;
1728 }
1729
1730 command_print(cmd, "\tType is %s", ap_type_to_description(apid & AP_TYPE_MASK));
1731
1732 /* NOTE: a MEM-AP may have a single CoreSight component that's
1733 * not a ROM table ... or have no such components at all.
1734 */
1735 const unsigned int class = (apid & AP_REG_IDR_CLASS_MASK) >> AP_REG_IDR_CLASS_SHIFT;
1736
1737 if (class == AP_REG_IDR_CLASS_MEM_AP) {
1738 if (is_64bit_ap(ap))
1739 invalid_entry = 0xFFFFFFFFFFFFFFFFull;
1740 else
1741 invalid_entry = 0xFFFFFFFFul;
1742
1743 command_print(cmd, "MEM-AP BASE " TARGET_ADDR_FMT, dbgbase);
1744
1745 if (dbgbase == invalid_entry || (dbgbase & 0x3) == 0x2) {
1746 command_print(cmd, "\tNo ROM table present");
1747 } else {
1748 if (dbgbase & 0x01)
1749 command_print(cmd, "\tValid ROM table present");
1750 else
1751 command_print(cmd, "\tROM table in legacy format");
1752 }
1753 }
1754
1755 return ERROR_OK;
1756 }
1757
1758 static int dap_info_cs_component(int retval, struct cs_component_vals *v, int depth, void *priv)
1759 {
1760 struct command_invocation *cmd = priv;
1761
1762 if (depth > ROM_TABLE_MAX_DEPTH) {
1763 command_print(cmd, "\tTables too deep");
1764 return ERROR_FAIL;
1765 }
1766
1767 command_print(cmd, "\t\tComponent base address " TARGET_ADDR_FMT, v->component_base);
1768
1769 if (retval != ERROR_OK) {
1770 command_print(cmd, "\t\tCan't read component, the corresponding core might be turned off");
1771 return retval;
1772 }
1773
1774 if (!is_valid_arm_cs_cidr(v->cid)) {
1775 command_print(cmd, "\t\tInvalid CID 0x%08" PRIx32, v->cid);
1776 return ERROR_OK; /* Don't abort recursion */
1777 }
1778
1779 /* component may take multiple 4K pages */
1780 uint32_t size = ARM_CS_PIDR_SIZE(v->pid);
1781 if (size > 0)
1782 command_print(cmd, "\t\tStart address " TARGET_ADDR_FMT, v->component_base - 0x1000 * size);
1783
1784 command_print(cmd, "\t\tPeripheral ID 0x%010" PRIx64, v->pid);
1785
1786 const unsigned int part_num = ARM_CS_PIDR_PART(v->pid);
1787 unsigned int designer_id = ARM_CS_PIDR_DESIGNER(v->pid);
1788
1789 if (v->pid & ARM_CS_PIDR_JEDEC) {
1790 /* JEP106 code */
1791 command_print(cmd, "\t\tDesigner is 0x%03x, %s",
1792 designer_id, jep106_manufacturer(designer_id));
1793 } else {
1794 /* Legacy ASCII ID, clear invalid bits */
1795 designer_id &= 0x7f;
1796 command_print(cmd, "\t\tDesigner ASCII code 0x%02x, %s",
1797 designer_id, designer_id == 0x41 ? "ARM" : "<unknown>");
1798 }
1799
1800 const struct dap_part_nums *partnum = pidr_to_part_num(designer_id, part_num);
1801 command_print(cmd, "\t\tPart is 0x%03x, %s %s", part_num, partnum->type, partnum->full);
1802
1803 const unsigned int class = ARM_CS_CIDR_CLASS(v->cid);
1804 command_print(cmd, "\t\tComponent class is 0x%x, %s", class, class_description[class]);
1805
1806 if (class == ARM_CS_CLASS_0X1_ROM_TABLE) {
1807 if (v->devtype_memtype & ARM_CS_C1_MEMTYPE_SYSMEM_MASK)
1808 command_print(cmd, "\t\tMEMTYPE system memory present on bus");
1809 else
1810 command_print(cmd, "\t\tMEMTYPE system memory not present: dedicated debug bus");
1811 return ERROR_OK;
1812 }
1813
1814 if (class == ARM_CS_CLASS_0X9_CS_COMPONENT) {
1815 dap_devtype_display(cmd, v->devtype_memtype);
1816
1817 /* REVISIT also show ARM_CS_C9_DEVID */
1818
1819 if ((v->devarch & ARM_CS_C9_DEVARCH_PRESENT) == 0)
1820 return ERROR_OK;
1821
1822 unsigned int architect_id = ARM_CS_C9_DEVARCH_ARCHITECT(v->devarch);
1823 unsigned int revision = ARM_CS_C9_DEVARCH_REVISION(v->devarch);
1824 command_print(cmd, "\t\tDev Arch is 0x%08" PRIx32 ", %s \"%s\" rev.%u", v->devarch,
1825 jep106_manufacturer(architect_id), class0x9_devarch_description(v->devarch),
1826 revision);
1827
1828 if ((v->devarch & DEVARCH_ID_MASK) == DEVARCH_ROM_C_0X9) {
1829 command_print(cmd, "\t\tType is ROM table");
1830
1831 if (v->devid & ARM_CS_C9_DEVID_SYSMEM_MASK)
1832 command_print(cmd, "\t\tMEMTYPE system memory present on bus");
1833 else
1834 command_print(cmd, "\t\tMEMTYPE system memory not present: dedicated debug bus");
1835 }
1836 return ERROR_OK;
1837 }
1838
1839 /* Class other than 0x1 and 0x9 */
1840 return ERROR_OK;
1841 }
1842
1843 static int dap_info_rom_table_entry(int retval, int depth,
1844 unsigned int offset, uint32_t romentry, void *priv)
1845 {
1846 struct command_invocation *cmd = priv;
1847 char tabs[16] = "";
1848
1849 if (depth)
1850 snprintf(tabs, sizeof(tabs), "[L%02d] ", depth);
1851
1852 if (retval != ERROR_OK) {
1853 command_print(cmd, "\t%sROMTABLE[0x%x] Read error", tabs, offset);
1854 command_print(cmd, "\t\tUnable to continue");
1855 command_print(cmd, "\t%s\tStop parsing of ROM table", tabs);
1856 return retval;
1857 }
1858
1859 command_print(cmd, "\t%sROMTABLE[0x%x] = 0x%08" PRIx32,
1860 tabs, offset, romentry);
1861
1862 if (romentry == 0) {
1863 command_print(cmd, "\t%s\tEnd of ROM table", tabs);
1864 return ERROR_OK;
1865 }
1866
1867 if (!(romentry & ARM_CS_ROMENTRY_PRESENT)) {
1868 command_print(cmd, "\t\tComponent not present");
1869 return ERROR_OK;
1870 }
1871
1872 return ERROR_OK;
1873 }
1874
1875 int dap_info_command(struct command_invocation *cmd, struct adiv5_ap *ap)
1876 {
1877 struct rtp_ops dap_info_ops = {
1878 .mem_ap_header = dap_info_mem_ap_header,
1879 .cs_component = dap_info_cs_component,
1880 .rom_table_entry = dap_info_rom_table_entry,
1881 .priv = cmd,
1882 };
1883
1884 return rtp_ap(&dap_info_ops, ap);
1885 }
1886
1887 enum adiv5_cfg_param {
1888 CFG_DAP,
1889 CFG_AP_NUM,
1890 CFG_BASEADDR,
1891 CFG_CTIBASE, /* DEPRECATED */
1892 };
1893
1894 static const struct jim_nvp nvp_config_opts[] = {
1895 { .name = "-dap", .value = CFG_DAP },
1896 { .name = "-ap-num", .value = CFG_AP_NUM },
1897 { .name = "-baseaddr", .value = CFG_BASEADDR },
1898 { .name = "-ctibase", .value = CFG_CTIBASE }, /* DEPRECATED */
1899 { .name = NULL, .value = -1 }
1900 };
1901
1902 static int adiv5_jim_spot_configure(struct jim_getopt_info *goi,
1903 struct adiv5_dap **dap_p, int *ap_num_p, uint32_t *base_p)
1904 {
1905 if (!goi->argc)
1906 return JIM_OK;
1907
1908 Jim_SetEmptyResult(goi->interp);
1909
1910 struct jim_nvp *n;
1911 int e = jim_nvp_name2value_obj(goi->interp, nvp_config_opts,
1912 goi->argv[0], &n);
1913 if (e != JIM_OK)
1914 return JIM_CONTINUE;
1915
1916 /* base_p can be NULL, then '-baseaddr' option is treated as unknown */
1917 if (!base_p && (n->value == CFG_BASEADDR || n->value == CFG_CTIBASE))
1918 return JIM_CONTINUE;
1919
1920 e = jim_getopt_obj(goi, NULL);
1921 if (e != JIM_OK)
1922 return e;
1923
1924 switch (n->value) {
1925 case CFG_DAP:
1926 if (goi->isconfigure) {
1927 Jim_Obj *o_t;
1928 struct adiv5_dap *dap;
1929 e = jim_getopt_obj(goi, &o_t);
1930 if (e != JIM_OK)
1931 return e;
1932 dap = dap_instance_by_jim_obj(goi->interp, o_t);
1933 if (!dap) {
1934 Jim_SetResultString(goi->interp, "DAP name invalid!", -1);
1935 return JIM_ERR;
1936 }
1937 if (*dap_p && *dap_p != dap) {
1938 Jim_SetResultString(goi->interp,
1939 "DAP assignment cannot be changed!", -1);
1940 return JIM_ERR;
1941 }
1942 *dap_p = dap;
1943 } else {
1944 if (goi->argc)
1945 goto err_no_param;
1946 if (!*dap_p) {
1947 Jim_SetResultString(goi->interp, "DAP not configured", -1);
1948 return JIM_ERR;
1949 }
1950 Jim_SetResultString(goi->interp, adiv5_dap_name(*dap_p), -1);
1951 }
1952 break;
1953
1954 case CFG_AP_NUM:
1955 if (goi->isconfigure) {
1956 jim_wide ap_num;
1957 e = jim_getopt_wide(goi, &ap_num);
1958 if (e != JIM_OK)
1959 return e;
1960 if (ap_num < 0 || ap_num > DP_APSEL_MAX) {
1961 Jim_SetResultString(goi->interp, "Invalid AP number!", -1);
1962 return JIM_ERR;
1963 }
1964 *ap_num_p = ap_num;
1965 } else {
1966 if (goi->argc)
1967 goto err_no_param;
1968 if (*ap_num_p == DP_APSEL_INVALID) {
1969 Jim_SetResultString(goi->interp, "AP number not configured", -1);
1970 return JIM_ERR;
1971 }
1972 Jim_SetResult(goi->interp, Jim_NewIntObj(goi->interp, *ap_num_p));
1973 }
1974 break;
1975
1976 case CFG_CTIBASE:
1977 LOG_WARNING("DEPRECATED! use \'-baseaddr' not \'-ctibase\'");
1978 /* fall through */
1979 case CFG_BASEADDR:
1980 if (goi->isconfigure) {
1981 jim_wide base;
1982 e = jim_getopt_wide(goi, &base);
1983 if (e != JIM_OK)
1984 return e;
1985 *base_p = (uint32_t)base;
1986 } else {
1987 if (goi->argc)
1988 goto err_no_param;
1989 Jim_SetResult(goi->interp, Jim_NewIntObj(goi->interp, *base_p));
1990 }
1991 break;
1992 };
1993
1994 return JIM_OK;
1995
1996 err_no_param:
1997 Jim_WrongNumArgs(goi->interp, goi->argc, goi->argv, "NO PARAMS");
1998 return JIM_ERR;
1999 }
2000
2001 int adiv5_jim_configure(struct target *target, struct jim_getopt_info *goi)
2002 {
2003 struct adiv5_private_config *pc;
2004 int e;
2005
2006 pc = (struct adiv5_private_config *)target->private_config;
2007 if (!pc) {
2008 pc = calloc(1, sizeof(struct adiv5_private_config));
2009 pc->ap_num = DP_APSEL_INVALID;
2010 target->private_config = pc;
2011 }
2012
2013 target->has_dap = true;
2014
2015 e = adiv5_jim_spot_configure(goi, &pc->dap, &pc->ap_num, NULL);
2016 if (e != JIM_OK)
2017 return e;
2018
2019 if (pc->dap && !target->dap_configured) {
2020 if (target->tap_configured) {
2021 pc->dap = NULL;
2022 Jim_SetResultString(goi->interp,
2023 "-chain-position and -dap configparams are mutually exclusive!", -1);
2024 return JIM_ERR;
2025 }
2026 target->tap = pc->dap->tap;
2027 target->dap_configured = true;
2028 }
2029
2030 return JIM_OK;
2031 }
2032
2033 int adiv5_verify_config(struct adiv5_private_config *pc)
2034 {
2035 if (!pc)
2036 return ERROR_FAIL;
2037
2038 if (!pc->dap)
2039 return ERROR_FAIL;
2040
2041 return ERROR_OK;
2042 }
2043
2044 int adiv5_jim_mem_ap_spot_configure(struct adiv5_mem_ap_spot *cfg,
2045 struct jim_getopt_info *goi)
2046 {
2047 return adiv5_jim_spot_configure(goi, &cfg->dap, &cfg->ap_num, &cfg->base);
2048 }
2049
2050 int adiv5_mem_ap_spot_init(struct adiv5_mem_ap_spot *p)
2051 {
2052 p->dap = NULL;
2053 p->ap_num = DP_APSEL_INVALID;
2054 p->base = 0;
2055 return ERROR_OK;
2056 }
2057
2058 COMMAND_HANDLER(handle_dap_info_command)
2059 {
2060 struct adiv5_dap *dap = adiv5_get_dap(CMD_DATA);
2061 uint32_t apsel;
2062
2063 switch (CMD_ARGC) {
2064 case 0:
2065 apsel = dap->apsel;
2066 break;
2067 case 1:
2068 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], apsel);
2069 if (apsel > DP_APSEL_MAX) {
2070 command_print(CMD, "Invalid AP number");
2071 return ERROR_COMMAND_ARGUMENT_INVALID;
2072 }
2073 break;
2074 default:
2075 return ERROR_COMMAND_SYNTAX_ERROR;
2076 }
2077
2078 return dap_info_command(CMD, &dap->ap[apsel]);
2079 }
2080
2081 COMMAND_HANDLER(dap_baseaddr_command)
2082 {
2083 struct adiv5_dap *dap = adiv5_get_dap(CMD_DATA);
2084 uint32_t apsel, baseaddr_lower, baseaddr_upper;
2085 struct adiv5_ap *ap;
2086 target_addr_t baseaddr;
2087 int retval;
2088
2089 baseaddr_upper = 0;
2090
2091 switch (CMD_ARGC) {
2092 case 0:
2093 apsel = dap->apsel;
2094 break;
2095 case 1:
2096 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], apsel);
2097 /* AP address is in bits 31:24 of DP_SELECT */
2098 if (apsel > DP_APSEL_MAX) {
2099 command_print(CMD, "Invalid AP number");
2100 return ERROR_COMMAND_ARGUMENT_INVALID;
2101 }
2102 break;
2103 default:
2104 return ERROR_COMMAND_SYNTAX_ERROR;
2105 }
2106
2107 /* NOTE: assumes we're talking to a MEM-AP, which
2108 * has a base address. There are other kinds of AP,
2109 * though they're not common for now. This should
2110 * use the ID register to verify it's a MEM-AP.
2111 */
2112
2113 ap = dap_ap(dap, apsel);
2114 retval = dap_queue_ap_read(ap, MEM_AP_REG_BASE, &baseaddr_lower);
2115
2116 if (retval == ERROR_OK && ap->cfg_reg == MEM_AP_REG_CFG_INVALID)
2117 retval = dap_queue_ap_read(ap, MEM_AP_REG_CFG, &ap->cfg_reg);
2118
2119 if (retval == ERROR_OK && (ap->cfg_reg == MEM_AP_REG_CFG_INVALID || is_64bit_ap(ap))) {
2120 /* MEM_AP_REG_BASE64 is defined as 'RES0'; can be read and then ignored on 32 bits AP */
2121 retval = dap_queue_ap_read(ap, MEM_AP_REG_BASE64, &baseaddr_upper);
2122 }
2123
2124 if (retval == ERROR_OK)
2125 retval = dap_run(dap);
2126 if (retval != ERROR_OK)
2127 return retval;
2128
2129 if (is_64bit_ap(ap)) {
2130 baseaddr = (((target_addr_t)baseaddr_upper) << 32) | baseaddr_lower;
2131 command_print(CMD, "0x%016" PRIx64, baseaddr);
2132 } else
2133 command_print(CMD, "0x%08" PRIx32, baseaddr_lower);
2134
2135 return ERROR_OK;
2136 }
2137
2138 COMMAND_HANDLER(dap_memaccess_command)
2139 {
2140 struct adiv5_dap *dap = adiv5_get_dap(CMD_DATA);
2141 uint32_t memaccess_tck;
2142
2143 switch (CMD_ARGC) {
2144 case 0:
2145 memaccess_tck = dap->ap[dap->apsel].memaccess_tck;
2146 break;
2147 case 1:
2148 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], memaccess_tck);
2149 break;
2150 default:
2151 return ERROR_COMMAND_SYNTAX_ERROR;
2152 }
2153 dap->ap[dap->apsel].memaccess_tck = memaccess_tck;
2154
2155 command_print(CMD, "memory bus access delay set to %" PRIu32 " tck",
2156 dap->ap[dap->apsel].memaccess_tck);
2157
2158 return ERROR_OK;
2159 }
2160
2161 COMMAND_HANDLER(dap_apsel_command)
2162 {
2163 struct adiv5_dap *dap = adiv5_get_dap(CMD_DATA);
2164 uint32_t apsel;
2165
2166 switch (CMD_ARGC) {
2167 case 0:
2168 command_print(CMD, "%" PRIu32, dap->apsel);
2169 return ERROR_OK;
2170 case 1:
2171 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], apsel);
2172 /* AP address is in bits 31:24 of DP_SELECT */
2173 if (apsel > DP_APSEL_MAX) {
2174 command_print(CMD, "Invalid AP number");
2175 return ERROR_COMMAND_ARGUMENT_INVALID;
2176 }
2177 break;
2178 default:
2179 return ERROR_COMMAND_SYNTAX_ERROR;
2180 }
2181
2182 dap->apsel = apsel;
2183 return ERROR_OK;
2184 }
2185
2186 COMMAND_HANDLER(dap_apcsw_command)
2187 {
2188 struct adiv5_dap *dap = adiv5_get_dap(CMD_DATA);
2189 uint32_t apcsw = dap->ap[dap->apsel].csw_default;
2190 uint32_t csw_val, csw_mask;
2191
2192 switch (CMD_ARGC) {
2193 case 0:
2194 command_print(CMD, "ap %" PRIu32 " selected, csw 0x%8.8" PRIx32,
2195 dap->apsel, apcsw);
2196 return ERROR_OK;
2197 case 1:
2198 if (strcmp(CMD_ARGV[0], "default") == 0)
2199 csw_val = CSW_AHB_DEFAULT;
2200 else
2201 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], csw_val);
2202
2203 if (csw_val & (CSW_SIZE_MASK | CSW_ADDRINC_MASK)) {
2204 LOG_ERROR("CSW value cannot include 'Size' and 'AddrInc' bit-fields");
2205 return ERROR_COMMAND_ARGUMENT_INVALID;
2206 }
2207 apcsw = csw_val;
2208 break;
2209 case 2:
2210 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], csw_val);
2211 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[1], csw_mask);
2212 if (csw_mask & (CSW_SIZE_MASK | CSW_ADDRINC_MASK)) {
2213 LOG_ERROR("CSW mask cannot include 'Size' and 'AddrInc' bit-fields");
2214 return ERROR_COMMAND_ARGUMENT_INVALID;
2215 }
2216 apcsw = (apcsw & ~csw_mask) | (csw_val & csw_mask);
2217 break;
2218 default:
2219 return ERROR_COMMAND_SYNTAX_ERROR;
2220 }
2221 dap->ap[dap->apsel].csw_default = apcsw;
2222
2223 return 0;
2224 }
2225
2226
2227
2228 COMMAND_HANDLER(dap_apid_command)
2229 {
2230 struct adiv5_dap *dap = adiv5_get_dap(CMD_DATA);
2231 uint32_t apsel, apid;
2232 int retval;
2233
2234 switch (CMD_ARGC) {
2235 case 0:
2236 apsel = dap->apsel;
2237 break;
2238 case 1:
2239 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], apsel);
2240 /* AP address is in bits 31:24 of DP_SELECT */
2241 if (apsel > DP_APSEL_MAX) {
2242 command_print(CMD, "Invalid AP number");
2243 return ERROR_COMMAND_ARGUMENT_INVALID;
2244 }
2245 break;
2246 default:
2247 return ERROR_COMMAND_SYNTAX_ERROR;
2248 }
2249
2250 retval = dap_queue_ap_read(dap_ap(dap, apsel), AP_REG_IDR, &apid);
2251 if (retval != ERROR_OK)
2252 return retval;
2253 retval = dap_run(dap);
2254 if (retval != ERROR_OK)
2255 return retval;
2256
2257 command_print(CMD, "0x%8.8" PRIx32, apid);
2258
2259 return retval;
2260 }
2261
2262 COMMAND_HANDLER(dap_apreg_command)
2263 {
2264 struct adiv5_dap *dap = adiv5_get_dap(CMD_DATA);
2265 uint32_t apsel, reg, value;
2266 struct adiv5_ap *ap;
2267 int retval;
2268
2269 if (CMD_ARGC < 2 || CMD_ARGC > 3)
2270 return ERROR_COMMAND_SYNTAX_ERROR;
2271
2272 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], apsel);
2273 /* AP address is in bits 31:24 of DP_SELECT */
2274 if (apsel > DP_APSEL_MAX) {
2275 command_print(CMD, "Invalid AP number");
2276 return ERROR_COMMAND_ARGUMENT_INVALID;
2277 }
2278
2279 ap = dap_ap(dap, apsel);
2280
2281 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[1], reg);
2282 if (reg >= 256 || (reg & 3)) {
2283 command_print(CMD, "Invalid reg value (should be less than 256 and 4 bytes aligned)");
2284 return ERROR_COMMAND_ARGUMENT_INVALID;
2285 }
2286
2287 if (CMD_ARGC == 3) {
2288 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[2], value);
2289 switch (reg) {
2290 case MEM_AP_REG_CSW:
2291 ap->csw_value = 0; /* invalid, in case write fails */
2292 retval = dap_queue_ap_write(ap, reg, value);
2293 if (retval == ERROR_OK)
2294 ap->csw_value = value;
2295 break;
2296 case MEM_AP_REG_TAR:
2297 retval = dap_queue_ap_write(ap, reg, value);
2298 if (retval == ERROR_OK)
2299 ap->tar_value = (ap->tar_value & ~0xFFFFFFFFull) | value;
2300 else {
2301 /* To track independent writes to TAR and TAR64, two tar_valid flags */
2302 /* should be used. To keep it simple, tar_valid is only invalidated on a */
2303 /* write fail. This approach causes a later re-write of the TAR and TAR64 */
2304 /* if tar_valid is false. */
2305 ap->tar_valid = false;
2306 }
2307 break;
2308 case MEM_AP_REG_TAR64:
2309 retval = dap_queue_ap_write(ap, reg, value);
2310 if (retval == ERROR_OK)
2311 ap->tar_value = (ap->tar_value & 0xFFFFFFFFull) | (((target_addr_t)value) << 32);
2312 else {
2313 /* See above comment for the MEM_AP_REG_TAR failed write case */
2314 ap->tar_valid = false;
2315 }
2316 break;
2317 default:
2318 retval = dap_queue_ap_write(ap, reg, value);
2319 break;
2320 }
2321 } else {
2322 retval = dap_queue_ap_read(ap, reg, &value);
2323 }
2324 if (retval == ERROR_OK)
2325 retval = dap_run(dap);
2326
2327 if (retval != ERROR_OK)
2328 return retval;
2329
2330 if (CMD_ARGC == 2)
2331 command_print(CMD, "0x%08" PRIx32, value);
2332
2333 return retval;
2334 }
2335
2336 COMMAND_HANDLER(dap_dpreg_command)
2337 {
2338 struct adiv5_dap *dap = adiv5_get_dap(CMD_DATA);
2339 uint32_t reg, value;
2340 int retval;
2341
2342 if (CMD_ARGC < 1 || CMD_ARGC > 2)
2343 return ERROR_COMMAND_SYNTAX_ERROR;
2344
2345 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[0], reg);
2346 if (reg >= 256 || (reg & 3)) {
2347 command_print(CMD, "Invalid reg value (should be less than 256 and 4 bytes aligned)");
2348 return ERROR_COMMAND_ARGUMENT_INVALID;
2349 }
2350
2351 if (CMD_ARGC == 2) {
2352 COMMAND_PARSE_NUMBER(u32, CMD_ARGV[1], value);
2353 retval = dap_queue_dp_write(dap, reg, value);
2354 } else {
2355 retval = dap_queue_dp_read(dap, reg, &value);
2356 }
2357 if (retval == ERROR_OK)
2358 retval = dap_run(dap);
2359
2360 if (retval != ERROR_OK)
2361 return retval;
2362
2363 if (CMD_ARGC == 1)
2364 command_print(CMD, "0x%08" PRIx32, value);
2365
2366 return retval;
2367 }
2368
2369 COMMAND_HANDLER(dap_ti_be_32_quirks_command)
2370 {
2371 struct adiv5_dap *dap = adiv5_get_dap(CMD_DATA);
2372 return CALL_COMMAND_HANDLER(handle_command_parse_bool, &dap->ti_be_32_quirks,
2373 "TI BE-32 quirks mode");
2374 }
2375
2376 const struct command_registration dap_instance_commands[] = {
2377 {
2378 .name = "info",
2379 .handler = handle_dap_info_command,
2380 .mode = COMMAND_EXEC,
2381 .help = "display ROM table for MEM-AP "
2382 "(default currently selected AP)",
2383 .usage = "[ap_num]",
2384 },
2385 {
2386 .name = "apsel",
2387 .handler = dap_apsel_command,
2388 .mode = COMMAND_ANY,
2389 .help = "Set the currently selected AP (default 0) "
2390 "and display the result",
2391 .usage = "[ap_num]",
2392 },
2393 {
2394 .name = "apcsw",
2395 .handler = dap_apcsw_command,
2396 .mode = COMMAND_ANY,
2397 .help = "Set CSW default bits",
2398 .usage = "[value [mask]]",
2399 },
2400
2401 {
2402 .name = "apid",
2403 .handler = dap_apid_command,
2404 .mode = COMMAND_EXEC,
2405 .help = "return ID register from AP "
2406 "(default currently selected AP)",
2407 .usage = "[ap_num]",
2408 },
2409 {
2410 .name = "apreg",
2411 .handler = dap_apreg_command,
2412 .mode = COMMAND_EXEC,
2413 .help = "read/write a register from AP "
2414 "(reg is byte address of a word register, like 0 4 8...)",
2415 .usage = "ap_num reg [value]",
2416 },
2417 {
2418 .name = "dpreg",
2419 .handler = dap_dpreg_command,
2420 .mode = COMMAND_EXEC,
2421 .help = "read/write a register from DP "
2422 "(reg is byte address (bank << 4 | reg) of a word register, like 0 4 8...)",
2423 .usage = "reg [value]",
2424 },
2425 {
2426 .name = "baseaddr",
2427 .handler = dap_baseaddr_command,
2428 .mode = COMMAND_EXEC,
2429 .help = "return debug base address from MEM-AP "
2430 "(default currently selected AP)",
2431 .usage = "[ap_num]",
2432 },
2433 {
2434 .name = "memaccess",
2435 .handler = dap_memaccess_command,
2436 .mode = COMMAND_EXEC,
2437 .help = "set/get number of extra tck for MEM-AP memory "
2438 "bus access [0-255]",
2439 .usage = "[cycles]",
2440 },
2441 {
2442 .name = "ti_be_32_quirks",
2443 .handler = dap_ti_be_32_quirks_command,
2444 .mode = COMMAND_CONFIG,
2445 .help = "set/get quirks mode for TI TMS450/TMS570 processors",
2446 .usage = "[enable]",
2447 },
2448 COMMAND_REGISTRATION_DONE
2449 };

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)