Simplify jtag_add_plain_dr_scan:
[openocd.git] / src / jtag / jtag.c
1 /***************************************************************************
2 * Copyright (C) 2005 by Dominic Rath *
3 * Dominic.Rath@gmx.de *
4 * *
5 * Copyright (C) 2007,2008 Øyvind Harboe *
6 * oyvind.harboe@zylin.com *
7 * *
8 * Copyright (C) 2009 SoftPLC Corporation *
9 * http://softplc.com *
10 * dick@softplc.com *
11 * *
12 * This program is free software; you can redistribute it and/or modify *
13 * it under the terms of the GNU General Public License as published by *
14 * the Free Software Foundation; either version 2 of the License, or *
15 * (at your option) any later version. *
16 * *
17 * This program is distributed in the hope that it will be useful, *
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
20 * GNU General Public License for more details. *
21 * *
22 * You should have received a copy of the GNU General Public License *
23 * along with this program; if not, write to the *
24 * Free Software Foundation, Inc., *
25 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
26 ***************************************************************************/
27 #ifdef HAVE_CONFIG_H
28 #include "config.h"
29 #endif
30
31 #include "jtag.h"
32 #include "minidriver.h"
33 #include "interface.h"
34
35 #ifdef HAVE_STRINGS_H
36 #include <strings.h>
37 #endif
38
39
40 /// The number of JTAG queue flushes (for profiling and debugging purposes).
41 static int jtag_flush_queue_count;
42
43 static void jtag_add_scan_check(void (*jtag_add_scan)(int in_num_fields, const scan_field_t *in_fields, tap_state_t state),
44 int in_num_fields, scan_field_t *in_fields, tap_state_t state);
45
46 /* note that this is not marked as static as it must be available from outside jtag.c for those
47 that implement the jtag_xxx() minidriver layer
48 */
49 int jtag_error=ERROR_OK;
50
51 char* jtag_event_strings[] =
52 {
53 "JTAG controller reset (RESET or TRST)"
54 };
55
56 const Jim_Nvp nvp_jtag_tap_event[] = {
57 { .value = JTAG_TAP_EVENT_ENABLE, .name = "tap-enable" },
58 { .value = JTAG_TAP_EVENT_DISABLE, .name = "tap-disable" },
59
60 { .name = NULL, .value = -1 }
61 };
62
63 int jtag_trst = 0;
64 int jtag_srst = 0;
65
66 /**
67 * List all TAPs that have been created.
68 */
69 static jtag_tap_t *__jtag_all_taps = NULL;
70 /**
71 * The number of TAPs in the __jtag_all_taps list, used to track the
72 * assigned chain position to new TAPs
73 */
74 static int jtag_num_taps = 0;
75
76 enum reset_types jtag_reset_config = RESET_NONE;
77 tap_state_t cmd_queue_end_state = TAP_RESET;
78 tap_state_t cmd_queue_cur_state = TAP_RESET;
79
80 int jtag_verify_capture_ir = 1;
81 int jtag_verify = 1;
82
83 /* how long the OpenOCD should wait before attempting JTAG communication after reset lines deasserted (in ms) */
84 static int jtag_nsrst_delay = 0; /* default to no nSRST delay */
85 static int jtag_ntrst_delay = 0; /* default to no nTRST delay */
86
87 /* callbacks to inform high-level handlers about JTAG state changes */
88 jtag_event_callback_t *jtag_event_callbacks;
89
90 /* speed in kHz*/
91 static int speed_khz = 0;
92 /* flag if the kHz speed was defined */
93 static bool hasKHz = false;
94
95 /* jtag interfaces (parport, FTDI-USB, TI-USB, ...)
96 */
97
98 #if BUILD_ECOSBOARD == 1
99 extern jtag_interface_t zy1000_interface;
100 #elif defined(BUILD_MINIDRIVER_DUMMY)
101 extern jtag_interface_t minidummy_interface;
102 #else // standard drivers
103 #if BUILD_PARPORT == 1
104 extern jtag_interface_t parport_interface;
105 #endif
106
107 #if BUILD_DUMMY == 1
108 extern jtag_interface_t dummy_interface;
109 #endif
110
111 #if BUILD_FT2232_FTD2XX == 1
112 extern jtag_interface_t ft2232_interface;
113 #endif
114
115 #if BUILD_FT2232_LIBFTDI == 1
116 extern jtag_interface_t ft2232_interface;
117 #endif
118
119 #if BUILD_AMTJTAGACCEL == 1
120 extern jtag_interface_t amt_jtagaccel_interface;
121 #endif
122
123 #if BUILD_EP93XX == 1
124 extern jtag_interface_t ep93xx_interface;
125 #endif
126
127 #if BUILD_AT91RM9200 == 1
128 extern jtag_interface_t at91rm9200_interface;
129 #endif
130
131 #if BUILD_GW16012 == 1
132 extern jtag_interface_t gw16012_interface;
133 #endif
134
135 #if BUILD_PRESTO_LIBFTDI == 1 || BUILD_PRESTO_FTD2XX == 1
136 extern jtag_interface_t presto_interface;
137 #endif
138
139 #if BUILD_USBPROG == 1
140 extern jtag_interface_t usbprog_interface;
141 #endif
142
143 #if BUILD_JLINK == 1
144 extern jtag_interface_t jlink_interface;
145 #endif
146
147 #if BUILD_VSLLINK == 1
148 extern jtag_interface_t vsllink_interface;
149 #endif
150
151 #if BUILD_RLINK == 1
152 extern jtag_interface_t rlink_interface;
153 #endif
154
155 #if BUILD_ARMJTAGEW == 1
156 extern jtag_interface_t armjtagew_interface;
157 #endif
158 #endif // standard drivers
159
160 /**
161 * The list of built-in JTAG interfaces, containing entries for those
162 * drivers that were enabled by the @c configure script.
163 *
164 * The list should be defined to contain either one minidriver interface
165 * or some number of standard driver interfaces, never both.
166 */
167 jtag_interface_t *jtag_interfaces[] = {
168 #if BUILD_ECOSBOARD == 1
169 &zy1000_interface,
170 #elif defined(BUILD_MINIDRIVER_DUMMY)
171 &minidummy_interface,
172 #else // standard drivers
173 #if BUILD_PARPORT == 1
174 &parport_interface,
175 #endif
176 #if BUILD_DUMMY == 1
177 &dummy_interface,
178 #endif
179 #if BUILD_FT2232_FTD2XX == 1
180 &ft2232_interface,
181 #endif
182 #if BUILD_FT2232_LIBFTDI == 1
183 &ft2232_interface,
184 #endif
185 #if BUILD_AMTJTAGACCEL == 1
186 &amt_jtagaccel_interface,
187 #endif
188 #if BUILD_EP93XX == 1
189 &ep93xx_interface,
190 #endif
191 #if BUILD_AT91RM9200 == 1
192 &at91rm9200_interface,
193 #endif
194 #if BUILD_GW16012 == 1
195 &gw16012_interface,
196 #endif
197 #if BUILD_PRESTO_LIBFTDI == 1 || BUILD_PRESTO_FTD2XX == 1
198 &presto_interface,
199 #endif
200 #if BUILD_USBPROG == 1
201 &usbprog_interface,
202 #endif
203 #if BUILD_JLINK == 1
204 &jlink_interface,
205 #endif
206 #if BUILD_VSLLINK == 1
207 &vsllink_interface,
208 #endif
209 #if BUILD_RLINK == 1
210 &rlink_interface,
211 #endif
212 #if BUILD_ARMJTAGEW == 1
213 &armjtagew_interface,
214 #endif
215 #endif // standard drivers
216 NULL,
217 };
218
219 struct jtag_interface_s *jtag = NULL;
220
221 /* configuration */
222 static jtag_interface_t *jtag_interface = NULL;
223 int jtag_speed = 0;
224
225 /* jtag commands */
226 static int handle_interface_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
227 static int handle_jtag_speed_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
228 static int handle_jtag_khz_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
229 static int handle_jtag_device_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
230 static int handle_reset_config_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
231 static int handle_jtag_nsrst_delay_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
232 static int handle_jtag_ntrst_delay_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
233
234 static int handle_scan_chain_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
235
236 static int handle_jtag_reset_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
237 static int handle_runtest_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
238 static int handle_irscan_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
239 static int Jim_Command_drscan(Jim_Interp *interp, int argc, Jim_Obj *const *argv);
240 static int Jim_Command_flush_count(Jim_Interp *interp, int argc, Jim_Obj *const *args);
241
242 static int handle_verify_ircapture_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
243 static int handle_verify_jtag_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
244 static int handle_tms_sequence_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
245
246 jtag_tap_t *jtag_all_taps(void)
247 {
248 return __jtag_all_taps;
249 };
250
251 int jtag_tap_count(void)
252 {
253 return jtag_num_taps;
254 }
255
256 unsigned jtag_tap_count_enabled(void)
257 {
258 jtag_tap_t *t;
259 unsigned n;
260
261 n = 0;
262 t = jtag_all_taps();
263 while(t){
264 if( t->enabled ){
265 n++;
266 }
267 t = t->next_tap;
268 }
269 return n;
270 }
271
272 /// Append a new TAP to the chain of all taps.
273 static void jtag_tap_add(struct jtag_tap_s *t)
274 {
275 t->abs_chain_position = jtag_num_taps++;
276
277 jtag_tap_t **tap = &__jtag_all_taps;
278 while(*tap != NULL)
279 tap = &(*tap)->next_tap;
280 *tap = t;
281 }
282
283 jtag_tap_t *jtag_tap_by_string( const char *s )
284 {
285 jtag_tap_t *t;
286 char *cp;
287
288 t = jtag_all_taps();
289 /* try name first */
290 while(t){
291 if( 0 == strcmp( t->dotted_name, s ) ){
292 break;
293 } else {
294 t = t->next_tap;
295 }
296 }
297 /* backup plan is by number */
298 if( t == NULL ){
299 /* ok - is "s" a number? */
300 int n;
301 n = strtol( s, &cp, 0 );
302 if( (s != cp) && (*cp == 0) ){
303 /* Then it is... */
304 t = jtag_tap_by_abs_position(n);
305 }
306 }
307 return t;
308 }
309
310 jtag_tap_t * jtag_tap_by_jim_obj( Jim_Interp *interp, Jim_Obj *o )
311 {
312 jtag_tap_t *t;
313 const char *cp;
314
315 cp = Jim_GetString( o, NULL );
316 if(cp == NULL){
317 cp = "(unknown)";
318 t = NULL;
319 } else {
320 t = jtag_tap_by_string( cp );
321 }
322 if( t == NULL ){
323 Jim_SetResult_sprintf(interp,"Tap: %s is unknown", cp );
324 }
325 return t;
326 }
327
328 /* returns a pointer to the n-th device in the scan chain */
329 jtag_tap_t * jtag_tap_by_abs_position( int n )
330 {
331 int orig_n;
332 jtag_tap_t *t;
333
334 orig_n = n;
335 t = jtag_all_taps();
336
337 while( t && (n > 0)) {
338 n--;
339 t = t->next_tap;
340 }
341 return t;
342 }
343
344 const char *jtag_tap_name(const jtag_tap_t *tap)
345 {
346 return (tap == NULL) ? "(unknown)" : tap->dotted_name;
347 }
348
349
350 int jtag_register_event_callback(int (*callback)(enum jtag_event event, void *priv), void *priv)
351 {
352 jtag_event_callback_t **callbacks_p = &jtag_event_callbacks;
353
354 if (callback == NULL)
355 {
356 return ERROR_INVALID_ARGUMENTS;
357 }
358
359 if (*callbacks_p)
360 {
361 while ((*callbacks_p)->next)
362 callbacks_p = &((*callbacks_p)->next);
363 callbacks_p = &((*callbacks_p)->next);
364 }
365
366 (*callbacks_p) = malloc(sizeof(jtag_event_callback_t));
367 (*callbacks_p)->callback = callback;
368 (*callbacks_p)->priv = priv;
369 (*callbacks_p)->next = NULL;
370
371 return ERROR_OK;
372 }
373
374 int jtag_unregister_event_callback(int (*callback)(enum jtag_event event, void *priv))
375 {
376 jtag_event_callback_t **callbacks_p = &jtag_event_callbacks;
377
378 if (callback == NULL)
379 {
380 return ERROR_INVALID_ARGUMENTS;
381 }
382
383 while (*callbacks_p)
384 {
385 jtag_event_callback_t **next = &((*callbacks_p)->next);
386 if ((*callbacks_p)->callback == callback)
387 {
388 free(*callbacks_p);
389 *callbacks_p = *next;
390 }
391 callbacks_p = next;
392 }
393
394 return ERROR_OK;
395 }
396
397 int jtag_call_event_callbacks(enum jtag_event event)
398 {
399 jtag_event_callback_t *callback = jtag_event_callbacks;
400
401 LOG_DEBUG("jtag event: %s", jtag_event_strings[event]);
402
403 while (callback)
404 {
405 callback->callback(event, callback->priv);
406 callback = callback->next;
407 }
408
409 return ERROR_OK;
410 }
411
412 static void jtag_checks(void)
413 {
414 assert(jtag_trst == 0);
415 }
416
417 static void jtag_prelude(tap_state_t state)
418 {
419 jtag_checks();
420
421 assert(state!=TAP_INVALID);
422
423 cmd_queue_cur_state = state;
424 }
425
426 void jtag_alloc_in_value32(scan_field_t *field)
427 {
428 interface_jtag_alloc_in_value32(field);
429 }
430
431 void jtag_add_ir_scan_noverify(int in_count, const scan_field_t *in_fields,
432 tap_state_t state)
433 {
434 jtag_prelude(state);
435
436 int retval = interface_jtag_add_ir_scan(in_count, in_fields, state);
437 jtag_set_error(retval);
438 }
439
440
441 /**
442 * Generate an IR SCAN with a list of scan fields with one entry for each enabled TAP.
443 *
444 * If the input field list contains an instruction value for a TAP then that is used
445 * otherwise the TAP is set to bypass.
446 *
447 * TAPs for which no fields are passed are marked as bypassed for subsequent DR SCANs.
448 *
449 */
450 void jtag_add_ir_scan(int in_num_fields, scan_field_t *in_fields, tap_state_t state)
451 {
452 if (jtag_verify&&jtag_verify_capture_ir)
453 {
454 /* 8 x 32 bit id's is enough for all invocations */
455
456 for (int j = 0; j < in_num_fields; j++)
457 {
458 /* if we are to run a verification of the ir scan, we need to get the input back.
459 * We may have to allocate space if the caller didn't ask for the input back.
460 */
461 in_fields[j].check_value=in_fields[j].tap->expected;
462 in_fields[j].check_mask=in_fields[j].tap->expected_mask;
463 }
464 jtag_add_scan_check(jtag_add_ir_scan_noverify, in_num_fields, in_fields, state);
465 } else
466 {
467 jtag_add_ir_scan_noverify(in_num_fields, in_fields, state);
468 }
469 }
470
471 /**
472 * Duplicate the scan fields passed into the function into an IR SCAN command
473 *
474 * This function assumes that the caller handles extra fields for bypassed TAPs
475 *
476 */
477 void jtag_add_plain_ir_scan(int in_num_fields, const scan_field_t *in_fields,
478 tap_state_t state)
479 {
480 jtag_prelude(state);
481
482 int retval = interface_jtag_add_plain_ir_scan(
483 in_num_fields, in_fields, state);
484 jtag_set_error(retval);
485 }
486
487 void jtag_add_callback(jtag_callback1_t f, u8 *in)
488 {
489 interface_jtag_add_callback(f, in);
490 }
491
492 void jtag_add_callback4(jtag_callback_t f, u8 *in,
493 jtag_callback_data_t data1, jtag_callback_data_t data2,
494 jtag_callback_data_t data3)
495 {
496 interface_jtag_add_callback4(f, in, data1, data2, data3);
497 }
498
499 int jtag_check_value_inner(u8 *captured, u8 *in_check_value, u8 *in_check_mask, int num_bits);
500
501 static int jtag_check_value_mask_callback(u8 *in, jtag_callback_data_t data1, jtag_callback_data_t data2, jtag_callback_data_t data3)
502 {
503 return jtag_check_value_inner(in, (u8 *)data1, (u8 *)data2, (int)data3);
504 }
505
506 static void jtag_add_scan_check(void (*jtag_add_scan)(int in_num_fields, const scan_field_t *in_fields, tap_state_t state),
507 int in_num_fields, scan_field_t *in_fields, tap_state_t state)
508 {
509 for (int i = 0; i < in_num_fields; i++)
510 {
511 struct scan_field_s *field = &in_fields[i];
512 field->allocated = 0;
513 field->modified = 0;
514 if (field->check_value || field->in_value)
515 continue;
516 interface_jtag_add_scan_check_alloc(field);
517 field->modified = 1;
518 }
519
520 jtag_add_scan(in_num_fields, in_fields, state);
521
522 for (int i = 0; i < in_num_fields; i++)
523 {
524 if ((in_fields[i].check_value != NULL) && (in_fields[i].in_value != NULL))
525 {
526 /* this is synchronous for a minidriver */
527 jtag_add_callback4(jtag_check_value_mask_callback, in_fields[i].in_value,
528 (jtag_callback_data_t)in_fields[i].check_value,
529 (jtag_callback_data_t)in_fields[i].check_mask,
530 (jtag_callback_data_t)in_fields[i].num_bits);
531 }
532 if (in_fields[i].allocated)
533 {
534 free(in_fields[i].in_value);
535 }
536 if (in_fields[i].modified)
537 {
538 in_fields[i].in_value = NULL;
539 }
540 }
541 }
542
543 void jtag_add_dr_scan_check(int in_num_fields, scan_field_t *in_fields, tap_state_t state)
544 {
545 if (jtag_verify)
546 {
547 jtag_add_scan_check(jtag_add_dr_scan, in_num_fields, in_fields, state);
548 } else
549 {
550 jtag_add_dr_scan(in_num_fields, in_fields, state);
551 }
552 }
553
554
555 /**
556 * Generate a DR SCAN using the fields passed to the function.
557 * For connected TAPs, the function checks in_fields and uses fields
558 * specified there. For bypassed TAPs, the function generates a dummy
559 * 1-bit field. The bypass status of TAPs is set by jtag_add_ir_scan().
560 */
561 void jtag_add_dr_scan(int in_num_fields, const scan_field_t *in_fields,
562 tap_state_t state)
563 {
564 jtag_prelude(state);
565
566 int retval;
567 retval = interface_jtag_add_dr_scan(in_num_fields, in_fields, state);
568 jtag_set_error(retval);
569 }
570
571 /**
572 * Duplicate the scan fields passed into the function into a DR SCAN
573 * command. Unlike jtag_add_dr_scan(), this function assumes that the
574 * caller handles extra fields for bypassed TAPs.
575 */
576 void jtag_add_plain_dr_scan(int in_num_fields, const scan_field_t *in_fields,
577 tap_state_t state)
578 {
579 jtag_prelude(state);
580
581 int retval;
582 retval = interface_jtag_add_plain_dr_scan(in_num_fields, in_fields, state);
583 jtag_set_error(retval);
584 }
585
586 void jtag_add_dr_out(jtag_tap_t* tap,
587 int num_fields, const int* num_bits, const u32* value,
588 tap_state_t end_state)
589 {
590 assert(end_state != TAP_INVALID);
591
592 cmd_queue_cur_state = end_state;
593
594 interface_jtag_add_dr_out(tap,
595 num_fields, num_bits, value,
596 end_state);
597 }
598
599 void jtag_add_tlr(void)
600 {
601 jtag_prelude(TAP_RESET);
602
603 int retval;
604 retval=interface_jtag_add_tlr();
605 if (retval!=ERROR_OK)
606 jtag_error=retval;
607
608 jtag_call_event_callbacks(JTAG_TRST_ASSERTED);
609 }
610
611 void jtag_add_pathmove(int num_states, const tap_state_t *path)
612 {
613 tap_state_t cur_state = cmd_queue_cur_state;
614 int i;
615 int retval;
616
617 /* the last state has to be a stable state */
618 if (!tap_is_state_stable(path[num_states - 1]))
619 {
620 LOG_ERROR("BUG: TAP path doesn't finish in a stable state");
621 exit(-1);
622 }
623
624 for (i=0; i<num_states; i++)
625 {
626 if (path[i] == TAP_RESET)
627 {
628 LOG_ERROR("BUG: TAP_RESET is not a valid state for pathmove sequences");
629 exit(-1);
630 }
631
632 if ( tap_state_transition(cur_state, true) != path[i]
633 && tap_state_transition(cur_state, false) != path[i])
634 {
635 LOG_ERROR("BUG: %s -> %s isn't a valid TAP transition", tap_state_name(cur_state), tap_state_name(path[i]));
636 exit(-1);
637 }
638 cur_state = path[i];
639 }
640
641 jtag_checks();
642
643 retval = interface_jtag_add_pathmove(num_states, path);
644 cmd_queue_cur_state = path[num_states - 1];
645 if (retval!=ERROR_OK)
646 jtag_error=retval;
647 }
648
649 void jtag_add_runtest(int num_cycles, tap_state_t state)
650 {
651 int retval;
652
653 jtag_prelude(state);
654
655 /* executed by sw or hw fifo */
656 retval=interface_jtag_add_runtest(num_cycles, state);
657 if (retval!=ERROR_OK)
658 jtag_error=retval;
659 }
660
661
662 void jtag_add_clocks( int num_cycles )
663 {
664 int retval;
665
666 if( !tap_is_state_stable(cmd_queue_cur_state) )
667 {
668 LOG_ERROR( "jtag_add_clocks() was called with TAP in non-stable state \"%s\"",
669 tap_state_name(cmd_queue_cur_state) );
670 jtag_error = ERROR_JTAG_NOT_STABLE_STATE;
671 return;
672 }
673
674 if( num_cycles > 0 )
675 {
676 jtag_checks();
677
678 retval = interface_jtag_add_clocks(num_cycles);
679 if (retval != ERROR_OK)
680 jtag_error=retval;
681 }
682 }
683
684 void jtag_add_reset(int req_tlr_or_trst, int req_srst)
685 {
686 int trst_with_tlr = 0;
687 int retval;
688
689 /* FIX!!! there are *many* different cases here. A better
690 * approach is needed for legal combinations of transitions...
691 */
692 if ((jtag_reset_config & RESET_HAS_SRST)&&
693 (jtag_reset_config & RESET_HAS_TRST)&&
694 ((jtag_reset_config & RESET_SRST_PULLS_TRST)==0))
695 {
696 if (((req_tlr_or_trst&&!jtag_trst)||
697 (!req_tlr_or_trst&&jtag_trst))&&
698 ((req_srst&&!jtag_srst)||
699 (!req_srst&&jtag_srst)))
700 {
701 /* FIX!!! srst_pulls_trst allows 1,1 => 0,0 transition.... */
702 //LOG_ERROR("BUG: transition of req_tlr_or_trst and req_srst in the same jtag_add_reset() call is undefined");
703 }
704 }
705
706 /* Make sure that jtag_reset_config allows the requested reset */
707 /* if SRST pulls TRST, we can't fulfill srst == 1 with trst == 0 */
708 if (((jtag_reset_config & RESET_SRST_PULLS_TRST) && (req_srst == 1)) && (!req_tlr_or_trst))
709 {
710 LOG_ERROR("BUG: requested reset would assert trst");
711 jtag_error=ERROR_FAIL;
712 return;
713 }
714
715 /* if TRST pulls SRST, we reset with TAP T-L-R */
716 if (((jtag_reset_config & RESET_TRST_PULLS_SRST) && (req_tlr_or_trst)) && (req_srst == 0))
717 {
718 trst_with_tlr = 1;
719 }
720
721 if (req_srst && !(jtag_reset_config & RESET_HAS_SRST))
722 {
723 LOG_ERROR("BUG: requested SRST assertion, but the current configuration doesn't support this");
724 jtag_error=ERROR_FAIL;
725 return;
726 }
727
728 if (req_tlr_or_trst)
729 {
730 if (!trst_with_tlr && (jtag_reset_config & RESET_HAS_TRST))
731 {
732 jtag_trst = 1;
733 } else
734 {
735 trst_with_tlr = 1;
736 }
737 } else
738 {
739 jtag_trst = 0;
740 }
741
742 jtag_srst = req_srst;
743
744 retval = interface_jtag_add_reset(jtag_trst, jtag_srst);
745 if (retval!=ERROR_OK)
746 {
747 jtag_error=retval;
748 return;
749 }
750 jtag_execute_queue();
751
752 if (jtag_srst)
753 {
754 LOG_DEBUG("SRST line asserted");
755 }
756 else
757 {
758 LOG_DEBUG("SRST line released");
759 if (jtag_nsrst_delay)
760 jtag_add_sleep(jtag_nsrst_delay * 1000);
761 }
762
763 if (trst_with_tlr)
764 {
765 LOG_DEBUG("JTAG reset with RESET instead of TRST");
766 jtag_set_end_state(TAP_RESET);
767 jtag_add_tlr();
768 return;
769 }
770
771 if (jtag_trst)
772 {
773 /* we just asserted nTRST, so we're now in Test-Logic-Reset,
774 * and inform possible listeners about this
775 */
776 LOG_DEBUG("TRST line asserted");
777 tap_set_state(TAP_RESET);
778 jtag_call_event_callbacks(JTAG_TRST_ASSERTED);
779 }
780 else
781 {
782 if (jtag_ntrst_delay)
783 jtag_add_sleep(jtag_ntrst_delay * 1000);
784 }
785 }
786
787 tap_state_t jtag_set_end_state(tap_state_t state)
788 {
789 if ((state == TAP_DRSHIFT)||(state == TAP_IRSHIFT))
790 {
791 LOG_ERROR("BUG: TAP_DRSHIFT/IRSHIFT can't be end state. Calling code should use a larger scan field");
792 }
793
794 if (state!=TAP_INVALID)
795 cmd_queue_end_state = state;
796 return cmd_queue_end_state;
797 }
798
799 tap_state_t jtag_get_end_state(void)
800 {
801 return cmd_queue_end_state;
802 }
803
804 void jtag_add_sleep(u32 us)
805 {
806 keep_alive(); /* we might be running on a very slow JTAG clk */
807 int retval=interface_jtag_add_sleep(us);
808 if (retval!=ERROR_OK)
809 jtag_error=retval;
810 return;
811 }
812
813 int jtag_check_value_inner(u8 *captured, u8 *in_check_value, u8 *in_check_mask, int num_bits)
814 {
815 int retval = ERROR_OK;
816
817 int compare_failed = 0;
818
819 if (in_check_mask)
820 compare_failed = buf_cmp_mask(captured, in_check_value, in_check_mask, num_bits);
821 else
822 compare_failed = buf_cmp(captured, in_check_value, num_bits);
823
824 if (compare_failed){
825 /* An error handler could have caught the failing check
826 * only report a problem when there wasn't a handler, or if the handler
827 * acknowledged the error
828 */
829 /*
830 LOG_WARNING("TAP %s:",
831 jtag_tap_name(field->tap));
832 */
833 if (compare_failed)
834 {
835 char *captured_char = buf_to_str(captured, (num_bits > DEBUG_JTAG_IOZ) ? DEBUG_JTAG_IOZ : num_bits, 16);
836 char *in_check_value_char = buf_to_str(in_check_value, (num_bits > DEBUG_JTAG_IOZ) ? DEBUG_JTAG_IOZ : num_bits, 16);
837
838 if (in_check_mask)
839 {
840 char *in_check_mask_char;
841 in_check_mask_char = buf_to_str(in_check_mask, (num_bits > DEBUG_JTAG_IOZ) ? DEBUG_JTAG_IOZ : num_bits, 16);
842 LOG_WARNING("value captured during scan didn't pass the requested check:");
843 LOG_WARNING("captured: 0x%s check_value: 0x%s check_mask: 0x%s",
844 captured_char, in_check_value_char, in_check_mask_char);
845 free(in_check_mask_char);
846 }
847 else
848 {
849 LOG_WARNING("value captured during scan didn't pass the requested check: captured: 0x%s check_value: 0x%s", captured_char, in_check_value_char);
850 }
851
852 free(captured_char);
853 free(in_check_value_char);
854
855 retval = ERROR_JTAG_QUEUE_FAILED;
856 }
857
858 }
859 return retval;
860 }
861
862 void jtag_check_value_mask(scan_field_t *field, u8 *value, u8 *mask)
863 {
864 assert(field->in_value != NULL);
865
866 if (value==NULL)
867 {
868 /* no checking to do */
869 return;
870 }
871
872 jtag_execute_queue_noclear();
873
874 int retval=jtag_check_value_inner(field->in_value, value, mask, field->num_bits);
875 jtag_set_error(retval);
876 }
877
878
879
880 int default_interface_jtag_execute_queue(void)
881 {
882 if (NULL == jtag)
883 {
884 LOG_ERROR("No JTAG interface configured yet. "
885 "Issue 'init' command in startup scripts "
886 "before communicating with targets.");
887 return ERROR_FAIL;
888 }
889
890 return jtag->execute_queue();
891 }
892
893 void jtag_execute_queue_noclear(void)
894 {
895 jtag_flush_queue_count++;
896 jtag_set_error(interface_jtag_execute_queue());
897 }
898
899 int jtag_get_flush_queue_count(void)
900 {
901 return jtag_flush_queue_count;
902 }
903
904 int jtag_execute_queue(void)
905 {
906 jtag_execute_queue_noclear();
907 return jtag_error_clear();
908 }
909
910 static int jtag_reset_callback(enum jtag_event event, void *priv)
911 {
912 jtag_tap_t *tap = priv;
913
914 LOG_DEBUG("-");
915
916 if (event == JTAG_TRST_ASSERTED)
917 {
918 buf_set_ones(tap->cur_instr, tap->ir_length);
919 tap->bypass = 1;
920 }
921
922 return ERROR_OK;
923 }
924
925 void jtag_sleep(u32 us)
926 {
927 alive_sleep(us/1000);
928 }
929
930 /// maximum number of JTAG devices expected in the chain
931 #define JTAG_MAX_CHAIN_SIZE 20
932
933 #define EXTRACT_MFG(X) (((X) & 0xffe) >> 1)
934 #define EXTRACT_PART(X) (((X) & 0xffff000) >> 12)
935 #define EXTRACT_VER(X) (((X) & 0xf0000000) >> 28)
936
937 static int jtag_examine_chain_execute(u8 *idcode_buffer, unsigned num_idcode)
938 {
939 scan_field_t field = {
940 .tap = NULL,
941 .num_bits = num_idcode * 32,
942 .out_value = idcode_buffer,
943 .in_value = idcode_buffer,
944 };
945
946 // initialize to the end of chain ID value
947 for (unsigned i = 0; i < JTAG_MAX_CHAIN_SIZE; i++)
948 buf_set_u32(idcode_buffer, i * 32, 32, 0x000000FF);
949
950 jtag_add_plain_dr_scan(1, &field, TAP_RESET);
951 return jtag_execute_queue();
952 }
953
954 static bool jtag_examine_chain_check(u8 *idcodes, unsigned count)
955 {
956 u8 zero_check = 0x0;
957 u8 one_check = 0xff;
958
959 for (unsigned i = 0; i < count * 4; i++)
960 {
961 zero_check |= idcodes[i];
962 one_check &= idcodes[i];
963 }
964
965 /* if there wasn't a single non-zero bit or if all bits were one,
966 * the scan is not valid */
967 if (zero_check == 0x00 || one_check == 0xff)
968 {
969 LOG_ERROR("JTAG communication failure: check connection, "
970 "JTAG interface, target power etc.");
971 return false;
972 }
973 return true;
974 }
975
976 static void jtag_examine_chain_display(enum log_levels level, const char *msg,
977 const char *name, u32 idcode)
978 {
979 log_printf_lf(level, __FILE__, __LINE__, __FUNCTION__,
980 "JTAG tap: %s %16.16s: 0x%08x "
981 "(mfg: 0x%3.3x, part: 0x%4.4x, ver: 0x%1.1x)",
982 name, msg, idcode,
983 EXTRACT_MFG(idcode), EXTRACT_PART(idcode), EXTRACT_VER(idcode) );
984 }
985
986 static bool jtag_idcode_is_final(u32 idcode)
987 {
988 return idcode == 0x000000FF || idcode == 0xFFFFFFFF;
989 }
990
991 /**
992 * This helper checks that remaining bits in the examined chain data are
993 * all as expected, but a single JTAG device requires only 64 bits to be
994 * read back correctly. This can help identify and diagnose problems
995 * with the JTAG chain earlier, gives more helpful/explicit error messages.
996 */
997 static void jtag_examine_chain_end(u8 *idcodes, unsigned count, unsigned max)
998 {
999 bool triggered = false;
1000 for ( ; count < max - 31; count += 32)
1001 {
1002 u32 idcode = buf_get_u32(idcodes, count, 32);
1003 // do not trigger the warning if the data looks good
1004 if (!triggered && jtag_idcode_is_final(idcode))
1005 continue;
1006 LOG_WARNING("Unexpected idcode after end of chain: %d 0x%08x",
1007 count, idcode);
1008 triggered = true;
1009 }
1010 }
1011
1012 static bool jtag_examine_chain_match_tap(const struct jtag_tap_s *tap)
1013 {
1014 if (0 == tap->expected_ids_cnt)
1015 {
1016 /// @todo Enable LOG_INFO to ask for reports about unknown TAP IDs.
1017 #if 0
1018 LOG_INFO("Uknown JTAG TAP ID: 0x%08x", tap->idcode)
1019 LOG_INFO("Please report the chip name and reported ID code to the openocd project");
1020 #endif
1021 return true;
1022 }
1023
1024 /* Loop over the expected identification codes and test for a match */
1025 u8 ii;
1026 for (ii = 0; ii < tap->expected_ids_cnt; ii++)
1027 {
1028 if (tap->idcode == tap->expected_ids[ii])
1029 break;
1030 }
1031
1032 /* If none of the expected ids matched, log an error */
1033 if (ii != tap->expected_ids_cnt)
1034 {
1035 LOG_INFO("JTAG Tap/device matched");
1036 return true;
1037 }
1038 jtag_examine_chain_display(LOG_LVL_ERROR, "got",
1039 tap->dotted_name, tap->idcode);
1040 for (ii = 0; ii < tap->expected_ids_cnt; ii++)
1041 {
1042 char msg[32];
1043 snprintf(msg, sizeof(msg), "expected %hhu of %hhu",
1044 ii + 1, tap->expected_ids_cnt);
1045 jtag_examine_chain_display(LOG_LVL_ERROR, msg,
1046 tap->dotted_name, tap->expected_ids[ii]);
1047 }
1048 return false;
1049 }
1050
1051 /* Try to examine chain layout according to IEEE 1149.1 §12
1052 */
1053 static int jtag_examine_chain(void)
1054 {
1055 u8 idcode_buffer[JTAG_MAX_CHAIN_SIZE * 4];
1056 unsigned device_count = 0;
1057
1058 jtag_examine_chain_execute(idcode_buffer, JTAG_MAX_CHAIN_SIZE);
1059
1060 if (!jtag_examine_chain_check(idcode_buffer, JTAG_MAX_CHAIN_SIZE))
1061 return ERROR_JTAG_INIT_FAILED;
1062
1063 /* point at the 1st tap */
1064 jtag_tap_t *tap = jtag_tap_next_enabled(NULL);
1065 if (tap == NULL)
1066 {
1067 LOG_ERROR("JTAG: No taps enabled?");
1068 return ERROR_JTAG_INIT_FAILED;
1069 }
1070
1071 for (unsigned bit_count = 0; bit_count < (JTAG_MAX_CHAIN_SIZE * 32) - 31;)
1072 {
1073 u32 idcode = buf_get_u32(idcode_buffer, bit_count, 32);
1074 if ((idcode & 1) == 0)
1075 {
1076 /* LSB must not be 0, this indicates a device in bypass */
1077 LOG_WARNING("Tap/Device does not have IDCODE");
1078 idcode = 0;
1079
1080 bit_count += 1;
1081 }
1082 else
1083 {
1084 /*
1085 * End of chain (invalid manufacturer ID) some devices, such
1086 * as AVR will output all 1's instead of TDI input value at
1087 * end of chain.
1088 */
1089 if (jtag_idcode_is_final(idcode))
1090 {
1091 jtag_examine_chain_end(idcode_buffer,
1092 bit_count + 32, JTAG_MAX_CHAIN_SIZE * 32);
1093 break;
1094 }
1095
1096 jtag_examine_chain_display(LOG_LVL_INFO, "tap/device found",
1097 tap ? tap->dotted_name : "(not-named)",
1098 idcode);
1099
1100 bit_count += 32;
1101 }
1102 device_count++;
1103 if (!tap)
1104 continue;
1105
1106 tap->idcode = idcode;
1107
1108 // ensure the TAP ID does matches what was expected
1109 if (!jtag_examine_chain_match_tap(tap))
1110 return ERROR_JTAG_INIT_FAILED;
1111
1112 tap = jtag_tap_next_enabled(tap);
1113 }
1114
1115 /* see if number of discovered devices matches configuration */
1116 if (device_count != jtag_tap_count_enabled())
1117 {
1118 LOG_ERROR("number of discovered devices in JTAG chain (%i) "
1119 "does not match (enabled) configuration (%i), total taps: %d",
1120 device_count, jtag_tap_count_enabled(), jtag_tap_count());
1121 LOG_ERROR("check the config file and ensure proper JTAG communication"
1122 " (connections, speed, ...)");
1123 return ERROR_JTAG_INIT_FAILED;
1124 }
1125
1126 return ERROR_OK;
1127 }
1128
1129 static int jtag_validate_chain(void)
1130 {
1131 jtag_tap_t *tap;
1132 int total_ir_length = 0;
1133 u8 *ir_test = NULL;
1134 scan_field_t field;
1135 int chain_pos = 0;
1136
1137 tap = NULL;
1138 total_ir_length = 0;
1139 for(;;){
1140 tap = jtag_tap_next_enabled(tap);
1141 if( tap == NULL ){
1142 break;
1143 }
1144 total_ir_length += tap->ir_length;
1145 }
1146
1147 total_ir_length += 2;
1148 ir_test = malloc(CEIL(total_ir_length, 8));
1149 buf_set_ones(ir_test, total_ir_length);
1150
1151 field.tap = NULL;
1152 field.num_bits = total_ir_length;
1153 field.out_value = ir_test;
1154 field.in_value = ir_test;
1155
1156
1157 jtag_add_plain_ir_scan(1, &field, TAP_RESET);
1158 jtag_execute_queue();
1159
1160 tap = NULL;
1161 chain_pos = 0;
1162 int val;
1163 for(;;){
1164 tap = jtag_tap_next_enabled(tap);
1165 if( tap == NULL ){
1166 break;
1167 }
1168
1169 val = buf_get_u32(ir_test, chain_pos, 2);
1170 if (val != 0x1)
1171 {
1172 char *cbuf = buf_to_str(ir_test, total_ir_length, 16);
1173 LOG_ERROR("Could not validate JTAG scan chain, IR mismatch, scan returned 0x%s. tap=%s pos=%d expected 0x1 got %0x", cbuf, jtag_tap_name(tap), chain_pos, val);
1174 free(cbuf);
1175 free(ir_test);
1176 return ERROR_JTAG_INIT_FAILED;
1177 }
1178 chain_pos += tap->ir_length;
1179 }
1180
1181 val = buf_get_u32(ir_test, chain_pos, 2);
1182 if (val != 0x3)
1183 {
1184 char *cbuf = buf_to_str(ir_test, total_ir_length, 16);
1185 LOG_ERROR("Could not validate end of JTAG scan chain, IR mismatch, scan returned 0x%s. pos=%d expected 0x3 got %0x", cbuf, chain_pos, val);
1186 free(cbuf);
1187 free(ir_test);
1188 return ERROR_JTAG_INIT_FAILED;
1189 }
1190
1191 free(ir_test);
1192
1193 return ERROR_OK;
1194 }
1195
1196 enum jtag_tap_cfg_param {
1197 JCFG_EVENT
1198 };
1199
1200 static Jim_Nvp nvp_config_opts[] = {
1201 { .name = "-event", .value = JCFG_EVENT },
1202
1203 { .name = NULL, .value = -1 }
1204 };
1205
1206 static int jtag_tap_configure_cmd( Jim_GetOptInfo *goi, jtag_tap_t * tap)
1207 {
1208 Jim_Nvp *n;
1209 Jim_Obj *o;
1210 int e;
1211
1212 /* parse config or cget options */
1213 while (goi->argc > 0) {
1214 Jim_SetEmptyResult (goi->interp);
1215
1216 e = Jim_GetOpt_Nvp(goi, nvp_config_opts, &n);
1217 if (e != JIM_OK) {
1218 Jim_GetOpt_NvpUnknown(goi, nvp_config_opts, 0);
1219 return e;
1220 }
1221
1222 switch (n->value) {
1223 case JCFG_EVENT:
1224 if (goi->argc == 0) {
1225 Jim_WrongNumArgs( goi->interp, goi->argc, goi->argv, "-event ?event-name? ..." );
1226 return JIM_ERR;
1227 }
1228
1229 e = Jim_GetOpt_Nvp( goi, nvp_jtag_tap_event, &n );
1230 if (e != JIM_OK) {
1231 Jim_GetOpt_NvpUnknown(goi, nvp_jtag_tap_event, 1);
1232 return e;
1233 }
1234
1235 if (goi->isconfigure) {
1236 if (goi->argc != 1) {
1237 Jim_WrongNumArgs(goi->interp, goi->argc, goi->argv, "-event ?event-name? ?EVENT-BODY?");
1238 return JIM_ERR;
1239 }
1240 } else {
1241 if (goi->argc != 0) {
1242 Jim_WrongNumArgs(goi->interp, goi->argc, goi->argv, "-event ?event-name?");
1243 return JIM_ERR;
1244 }
1245 }
1246
1247 {
1248 jtag_tap_event_action_t *jteap;
1249
1250 jteap = tap->event_action;
1251 /* replace existing? */
1252 while (jteap) {
1253 if (jteap->event == (enum jtag_tap_event)n->value) {
1254 break;
1255 }
1256 jteap = jteap->next;
1257 }
1258
1259 if (goi->isconfigure) {
1260 if (jteap == NULL) {
1261 /* create new */
1262 jteap = calloc(1, sizeof (*jteap));
1263 }
1264 jteap->event = n->value;
1265 Jim_GetOpt_Obj( goi, &o);
1266 if (jteap->body) {
1267 Jim_DecrRefCount(interp, jteap->body);
1268 }
1269 jteap->body = Jim_DuplicateObj(goi->interp, o);
1270 Jim_IncrRefCount(jteap->body);
1271
1272 /* add to head of event list */
1273 jteap->next = tap->event_action;
1274 tap->event_action = jteap;
1275 Jim_SetEmptyResult(goi->interp);
1276 } else {
1277 /* get */
1278 if (jteap == NULL) {
1279 Jim_SetEmptyResult(goi->interp);
1280 } else {
1281 Jim_SetResult(goi->interp, Jim_DuplicateObj(goi->interp, jteap->body));
1282 }
1283 }
1284 }
1285 /* loop for more */
1286 break;
1287 }
1288 } /* while (goi->argc) */
1289
1290 return JIM_OK;
1291 }
1292
1293
1294 static void jtag_tap_init(jtag_tap_t *tap)
1295 {
1296 assert(0 != tap->ir_length);
1297
1298 tap->expected = malloc(tap->ir_length);
1299 tap->expected_mask = malloc(tap->ir_length);
1300 tap->cur_instr = malloc(tap->ir_length);
1301
1302 buf_set_u32(tap->expected, 0, tap->ir_length, tap->ir_capture_value);
1303 buf_set_u32(tap->expected_mask, 0, tap->ir_length, tap->ir_capture_mask);
1304 buf_set_ones(tap->cur_instr, tap->ir_length);
1305
1306 // place TAP in bypass mode
1307 tap->bypass = 1;
1308 // register the reset callback for the TAP
1309 jtag_register_event_callback(&jtag_reset_callback, tap);
1310
1311 LOG_DEBUG("Created Tap: %s @ abs position %d, "
1312 "irlen %d, capture: 0x%x mask: 0x%x", tap->dotted_name,
1313 tap->abs_chain_position, tap->ir_length,
1314 tap->ir_capture_value, tap->ir_capture_mask);
1315 jtag_tap_add(tap);
1316 }
1317
1318 static void jtag_tap_free(jtag_tap_t *tap)
1319 {
1320 /// @todo is anything missing? no memory leaks please
1321 free((void *)tap->expected_ids);
1322 free((void *)tap->chip);
1323 free((void *)tap->tapname);
1324 free((void *)tap->dotted_name);
1325 free(tap);
1326 }
1327
1328 static int jim_newtap_cmd( Jim_GetOptInfo *goi )
1329 {
1330 jtag_tap_t *pTap;
1331 jim_wide w;
1332 int x;
1333 int e;
1334 int reqbits;
1335 Jim_Nvp *n;
1336 char *cp;
1337 const Jim_Nvp opts[] = {
1338 #define NTAP_OPT_IRLEN 0
1339 { .name = "-irlen" , .value = NTAP_OPT_IRLEN },
1340 #define NTAP_OPT_IRMASK 1
1341 { .name = "-irmask" , .value = NTAP_OPT_IRMASK },
1342 #define NTAP_OPT_IRCAPTURE 2
1343 { .name = "-ircapture" , .value = NTAP_OPT_IRCAPTURE },
1344 #define NTAP_OPT_ENABLED 3
1345 { .name = "-enable" , .value = NTAP_OPT_ENABLED },
1346 #define NTAP_OPT_DISABLED 4
1347 { .name = "-disable" , .value = NTAP_OPT_DISABLED },
1348 #define NTAP_OPT_EXPECTED_ID 5
1349 { .name = "-expected-id" , .value = NTAP_OPT_EXPECTED_ID },
1350 { .name = NULL , .value = -1 },
1351 };
1352
1353 pTap = malloc( sizeof(jtag_tap_t) );
1354 memset( pTap, 0, sizeof(*pTap) );
1355 if( !pTap ){
1356 Jim_SetResult_sprintf( goi->interp, "no memory");
1357 return JIM_ERR;
1358 }
1359 /*
1360 * we expect CHIP + TAP + OPTIONS
1361 * */
1362 if( goi->argc < 3 ){
1363 Jim_SetResult_sprintf(goi->interp, "Missing CHIP TAP OPTIONS ....");
1364 return JIM_ERR;
1365 }
1366 Jim_GetOpt_String( goi, &cp, NULL );
1367 pTap->chip = strdup(cp);
1368
1369 Jim_GetOpt_String( goi, &cp, NULL );
1370 pTap->tapname = strdup(cp);
1371
1372 /* name + dot + name + null */
1373 x = strlen(pTap->chip) + 1 + strlen(pTap->tapname) + 1;
1374 cp = malloc( x );
1375 sprintf( cp, "%s.%s", pTap->chip, pTap->tapname );
1376 pTap->dotted_name = cp;
1377
1378 LOG_DEBUG("Creating New Tap, Chip: %s, Tap: %s, Dotted: %s, %d params",
1379 pTap->chip, pTap->tapname, pTap->dotted_name, goi->argc);
1380
1381 /* default is enabled */
1382 pTap->enabled = 1;
1383
1384 /* deal with options */
1385 #define NTREQ_IRLEN 1
1386 #define NTREQ_IRCAPTURE 2
1387 #define NTREQ_IRMASK 4
1388
1389 /* clear them as we find them */
1390 reqbits = (NTREQ_IRLEN | NTREQ_IRCAPTURE | NTREQ_IRMASK);
1391
1392 while( goi->argc ){
1393 e = Jim_GetOpt_Nvp( goi, opts, &n );
1394 if( e != JIM_OK ){
1395 Jim_GetOpt_NvpUnknown( goi, opts, 0 );
1396 return e;
1397 }
1398 LOG_DEBUG("Processing option: %s", n->name );
1399 switch( n->value ){
1400 case NTAP_OPT_ENABLED:
1401 pTap->enabled = 1;
1402 break;
1403 case NTAP_OPT_DISABLED:
1404 pTap->enabled = 0;
1405 break;
1406 case NTAP_OPT_EXPECTED_ID:
1407 {
1408 u32 *new_expected_ids;
1409
1410 e = Jim_GetOpt_Wide( goi, &w );
1411 if( e != JIM_OK) {
1412 Jim_SetResult_sprintf(goi->interp, "option: %s bad parameter", n->name);
1413 return e;
1414 }
1415
1416 new_expected_ids = malloc(sizeof(u32) * (pTap->expected_ids_cnt + 1));
1417 if (new_expected_ids == NULL) {
1418 Jim_SetResult_sprintf( goi->interp, "no memory");
1419 return JIM_ERR;
1420 }
1421
1422 memcpy(new_expected_ids, pTap->expected_ids, sizeof(u32) * pTap->expected_ids_cnt);
1423
1424 new_expected_ids[pTap->expected_ids_cnt] = w;
1425
1426 free(pTap->expected_ids);
1427 pTap->expected_ids = new_expected_ids;
1428 pTap->expected_ids_cnt++;
1429 break;
1430 }
1431 case NTAP_OPT_IRLEN:
1432 case NTAP_OPT_IRMASK:
1433 case NTAP_OPT_IRCAPTURE:
1434 e = Jim_GetOpt_Wide( goi, &w );
1435 if( e != JIM_OK ){
1436 Jim_SetResult_sprintf( goi->interp, "option: %s bad parameter", n->name );
1437 return e;
1438 }
1439 if( (w < 0) || (w > 0xffff) ){
1440 /* wacky value */
1441 Jim_SetResult_sprintf( goi->interp, "option: %s - wacky value: %d (0x%x)",
1442 n->name, (int)(w), (int)(w));
1443 return JIM_ERR;
1444 }
1445 switch(n->value){
1446 case NTAP_OPT_IRLEN:
1447 pTap->ir_length = w;
1448 reqbits &= (~(NTREQ_IRLEN));
1449 break;
1450 case NTAP_OPT_IRMASK:
1451 pTap->ir_capture_mask = w;
1452 reqbits &= (~(NTREQ_IRMASK));
1453 break;
1454 case NTAP_OPT_IRCAPTURE:
1455 pTap->ir_capture_value = w;
1456 reqbits &= (~(NTREQ_IRCAPTURE));
1457 break;
1458 }
1459 } /* switch(n->value) */
1460 } /* while( goi->argc ) */
1461
1462 /* Did all the required option bits get cleared? */
1463 if (0 == reqbits)
1464 {
1465 jtag_tap_init(pTap);
1466 return ERROR_OK;
1467 }
1468
1469 Jim_SetResult_sprintf(goi->interp,
1470 "newtap: %s missing required parameters",
1471 pTap->dotted_name);
1472 jtag_tap_free(pTap);
1473 return JIM_ERR;
1474 }
1475
1476 static int jim_jtag_command( Jim_Interp *interp, int argc, Jim_Obj *const *argv )
1477 {
1478 Jim_GetOptInfo goi;
1479 int e;
1480 Jim_Nvp *n;
1481 Jim_Obj *o;
1482 struct command_context_s *context;
1483
1484 enum {
1485 JTAG_CMD_INTERFACE,
1486 JTAG_CMD_INIT_RESET,
1487 JTAG_CMD_NEWTAP,
1488 JTAG_CMD_TAPENABLE,
1489 JTAG_CMD_TAPDISABLE,
1490 JTAG_CMD_TAPISENABLED,
1491 JTAG_CMD_CONFIGURE,
1492 JTAG_CMD_CGET
1493 };
1494
1495 const Jim_Nvp jtag_cmds[] = {
1496 { .name = "interface" , .value = JTAG_CMD_INTERFACE },
1497 { .name = "arp_init-reset", .value = JTAG_CMD_INIT_RESET },
1498 { .name = "newtap" , .value = JTAG_CMD_NEWTAP },
1499 { .name = "tapisenabled" , .value = JTAG_CMD_TAPISENABLED },
1500 { .name = "tapenable" , .value = JTAG_CMD_TAPENABLE },
1501 { .name = "tapdisable" , .value = JTAG_CMD_TAPDISABLE },
1502 { .name = "configure" , .value = JTAG_CMD_CONFIGURE },
1503 { .name = "cget" , .value = JTAG_CMD_CGET },
1504
1505 { .name = NULL, .value = -1 },
1506 };
1507
1508 context = Jim_GetAssocData(interp, "context");
1509 /* go past the command */
1510 Jim_GetOpt_Setup( &goi, interp, argc-1, argv+1 );
1511
1512 e = Jim_GetOpt_Nvp( &goi, jtag_cmds, &n );
1513 if( e != JIM_OK ){
1514 Jim_GetOpt_NvpUnknown( &goi, jtag_cmds, 0 );
1515 return e;
1516 }
1517 Jim_SetEmptyResult( goi.interp );
1518 switch( n->value ){
1519 case JTAG_CMD_INTERFACE:
1520 /* return the name of the interface */
1521 /* TCL code might need to know the exact type... */
1522 /* FUTURE: we allow this as a means to "set" the interface. */
1523 if( goi.argc != 0 ){
1524 Jim_WrongNumArgs( goi.interp, 1, goi.argv-1, "(no params)");
1525 return JIM_ERR;
1526 }
1527 Jim_SetResultString( goi.interp, jtag_interface->name, -1 );
1528 return JIM_OK;
1529 case JTAG_CMD_INIT_RESET:
1530 if( goi.argc != 0 ){
1531 Jim_WrongNumArgs( goi.interp, 1, goi.argv-1, "(no params)");
1532 return JIM_ERR;
1533 }
1534 e = jtag_init_reset(context);
1535 if( e != ERROR_OK ){
1536 Jim_SetResult_sprintf( goi.interp, "error: %d", e);
1537 return JIM_ERR;
1538 }
1539 return JIM_OK;
1540 case JTAG_CMD_NEWTAP:
1541 return jim_newtap_cmd( &goi );
1542 break;
1543 case JTAG_CMD_TAPISENABLED:
1544 case JTAG_CMD_TAPENABLE:
1545 case JTAG_CMD_TAPDISABLE:
1546 if( goi.argc != 1 ){
1547 Jim_SetResultString( goi.interp, "Too many parameters",-1 );
1548 return JIM_ERR;
1549 }
1550
1551 {
1552 jtag_tap_t *t;
1553 t = jtag_tap_by_jim_obj( goi.interp, goi.argv[0] );
1554 if( t == NULL ){
1555 return JIM_ERR;
1556 }
1557 switch( n->value ){
1558 case JTAG_CMD_TAPISENABLED:
1559 e = t->enabled;
1560 break;
1561 case JTAG_CMD_TAPENABLE:
1562 jtag_tap_handle_event( t, JTAG_TAP_EVENT_ENABLE);
1563 e = 1;
1564 t->enabled = e;
1565 break;
1566 case JTAG_CMD_TAPDISABLE:
1567 jtag_tap_handle_event( t, JTAG_TAP_EVENT_DISABLE);
1568 e = 0;
1569 t->enabled = e;
1570 break;
1571 }
1572 Jim_SetResult( goi.interp, Jim_NewIntObj( goi.interp, e ) );
1573 return JIM_OK;
1574 }
1575 break;
1576
1577 case JTAG_CMD_CGET:
1578 if( goi.argc < 2 ){
1579 Jim_WrongNumArgs( goi.interp, 0, NULL, "?tap-name? -option ...");
1580 return JIM_ERR;
1581 }
1582
1583 {
1584 jtag_tap_t *t;
1585
1586 Jim_GetOpt_Obj(&goi, &o);
1587 t = jtag_tap_by_jim_obj( goi.interp, o );
1588 if( t == NULL ){
1589 return JIM_ERR;
1590 }
1591
1592 goi.isconfigure = 0;
1593 return jtag_tap_configure_cmd( &goi, t);
1594 }
1595 break;
1596
1597 case JTAG_CMD_CONFIGURE:
1598 if( goi.argc < 3 ){
1599 Jim_WrongNumArgs( goi.interp, 0, NULL, "?tap-name? -option ?VALUE? ...");
1600 return JIM_ERR;
1601 }
1602
1603 {
1604 jtag_tap_t *t;
1605
1606 Jim_GetOpt_Obj(&goi, &o);
1607 t = jtag_tap_by_jim_obj( goi.interp, o );
1608 if( t == NULL ){
1609 return JIM_ERR;
1610 }
1611
1612 goi.isconfigure = 1;
1613 return jtag_tap_configure_cmd( &goi, t);
1614 }
1615 }
1616
1617 return JIM_ERR;
1618 }
1619
1620 int jtag_register_commands(struct command_context_s *cmd_ctx)
1621 {
1622 register_jim( cmd_ctx, "jtag", jim_jtag_command, "perform jtag tap actions");
1623
1624 register_command(cmd_ctx, NULL, "interface", handle_interface_command,
1625 COMMAND_CONFIG, "try to configure interface");
1626 register_command(cmd_ctx, NULL, "jtag_speed", handle_jtag_speed_command,
1627 COMMAND_ANY, "(DEPRECATED) set jtag speed (if supported)");
1628 register_command(cmd_ctx, NULL, "jtag_khz", handle_jtag_khz_command,
1629 COMMAND_ANY, "set maximum jtag speed (if supported); "
1630 "parameter is maximum khz, or 0 for adaptive clocking (RTCK).");
1631 register_command(cmd_ctx, NULL, "jtag_device", handle_jtag_device_command,
1632 COMMAND_CONFIG, "(DEPRECATED) jtag_device <ir_length> <ir_expected> <ir_mask>");
1633 register_command(cmd_ctx, NULL, "reset_config", handle_reset_config_command,
1634 COMMAND_ANY,
1635 "[none/trst_only/srst_only/trst_and_srst] [srst_pulls_trst/trst_pulls_srst] [combined/separate] [trst_push_pull/trst_open_drain] [srst_push_pull/srst_open_drain]");
1636 register_command(cmd_ctx, NULL, "jtag_nsrst_delay", handle_jtag_nsrst_delay_command,
1637 COMMAND_ANY, "jtag_nsrst_delay <ms> - delay after deasserting srst in ms");
1638 register_command(cmd_ctx, NULL, "jtag_ntrst_delay", handle_jtag_ntrst_delay_command,
1639 COMMAND_ANY, "jtag_ntrst_delay <ms> - delay after deasserting trst in ms");
1640
1641 register_command(cmd_ctx, NULL, "scan_chain", handle_scan_chain_command,
1642 COMMAND_EXEC, "print current scan chain configuration");
1643
1644 register_command(cmd_ctx, NULL, "jtag_reset", handle_jtag_reset_command,
1645 COMMAND_EXEC, "toggle reset lines <trst> <srst>");
1646 register_command(cmd_ctx, NULL, "runtest", handle_runtest_command,
1647 COMMAND_EXEC, "move to Run-Test/Idle, and execute <num_cycles>");
1648 register_command(cmd_ctx, NULL, "irscan", handle_irscan_command,
1649 COMMAND_EXEC, "execute IR scan <device> <instr> [dev2] [instr2] ...");
1650 register_jim(cmd_ctx, "drscan", Jim_Command_drscan, "execute DR scan <device> <num_bits> <value> <num_bits1> <value2> ...");
1651 register_jim(cmd_ctx, "flush_count", Jim_Command_flush_count, "returns number of times the JTAG queue has been flushed");
1652
1653 register_command(cmd_ctx, NULL, "verify_ircapture", handle_verify_ircapture_command,
1654 COMMAND_ANY, "verify value captured during Capture-IR <enable|disable>");
1655 register_command(cmd_ctx, NULL, "verify_jtag", handle_verify_jtag_command,
1656 COMMAND_ANY, "verify value capture <enable|disable>");
1657 register_command(cmd_ctx, NULL, "tms_sequence", handle_tms_sequence_command,
1658 COMMAND_ANY, "choose short(default) or long tms_sequence <short|long>");
1659 return ERROR_OK;
1660 }
1661
1662 int jtag_interface_init(struct command_context_s *cmd_ctx)
1663 {
1664 if (jtag)
1665 return ERROR_OK;
1666
1667 if (!jtag_interface)
1668 {
1669 /* nothing was previously specified by "interface" command */
1670 LOG_ERROR("JTAG interface has to be specified, see \"interface\" command");
1671 return ERROR_JTAG_INVALID_INTERFACE;
1672 }
1673 if(hasKHz)
1674 {
1675 jtag_interface->khz(jtag_get_speed_khz(), &jtag_speed);
1676 hasKHz = false;
1677 }
1678
1679 if (jtag_interface->init() != ERROR_OK)
1680 return ERROR_JTAG_INIT_FAILED;
1681
1682 jtag = jtag_interface;
1683 return ERROR_OK;
1684 }
1685
1686 static int jtag_init_inner(struct command_context_s *cmd_ctx)
1687 {
1688 jtag_tap_t *tap;
1689 int retval;
1690
1691 LOG_DEBUG("Init JTAG chain");
1692
1693 tap = jtag_tap_next_enabled(NULL);
1694 if( tap == NULL ){
1695 LOG_ERROR("There are no enabled taps?");
1696 return ERROR_JTAG_INIT_FAILED;
1697 }
1698
1699 jtag_add_tlr();
1700 if ((retval=jtag_execute_queue())!=ERROR_OK)
1701 return retval;
1702
1703 /* examine chain first, as this could discover the real chain layout */
1704 if (jtag_examine_chain() != ERROR_OK)
1705 {
1706 LOG_ERROR("trying to validate configured JTAG chain anyway...");
1707 }
1708
1709 if (jtag_validate_chain() != ERROR_OK)
1710 {
1711 LOG_WARNING("Could not validate JTAG chain, continuing anyway...");
1712 }
1713
1714 return ERROR_OK;
1715 }
1716
1717 int jtag_interface_quit(void)
1718 {
1719 if (!jtag || !jtag->quit)
1720 return ERROR_OK;
1721
1722 // close the JTAG interface
1723 int result = jtag->quit();
1724 if (ERROR_OK != result)
1725 LOG_ERROR("failed: %d", result);
1726
1727 return ERROR_OK;
1728 }
1729
1730
1731 int jtag_init_reset(struct command_context_s *cmd_ctx)
1732 {
1733 int retval;
1734
1735 if ((retval=jtag_interface_init(cmd_ctx)) != ERROR_OK)
1736 return retval;
1737
1738 LOG_DEBUG("Trying to bring the JTAG controller to life by asserting TRST / RESET");
1739
1740 /* Reset can happen after a power cycle.
1741 *
1742 * Ideally we would only assert TRST or run RESET before the target reset.
1743 *
1744 * However w/srst_pulls_trst, trst is asserted together with the target
1745 * reset whether we want it or not.
1746 *
1747 * NB! Some targets have JTAG circuitry disabled until a
1748 * trst & srst has been asserted.
1749 *
1750 * NB! here we assume nsrst/ntrst delay are sufficient!
1751 *
1752 * NB! order matters!!!! srst *can* disconnect JTAG circuitry
1753 *
1754 */
1755 jtag_add_reset(1, 0); /* RESET or TRST */
1756 if (jtag_reset_config & RESET_HAS_SRST)
1757 {
1758 jtag_add_reset(1, 1);
1759 if ((jtag_reset_config & RESET_SRST_PULLS_TRST)==0)
1760 jtag_add_reset(0, 1);
1761 }
1762 jtag_add_reset(0, 0);
1763 if ((retval = jtag_execute_queue()) != ERROR_OK)
1764 return retval;
1765
1766 /* Check that we can communication on the JTAG chain + eventually we want to
1767 * be able to perform enumeration only after OpenOCD has started
1768 * telnet and GDB server
1769 *
1770 * That would allow users to more easily perform any magic they need to before
1771 * reset happens.
1772 */
1773 return jtag_init_inner(cmd_ctx);
1774 }
1775
1776 int jtag_init(struct command_context_s *cmd_ctx)
1777 {
1778 int retval;
1779 if ((retval=jtag_interface_init(cmd_ctx)) != ERROR_OK)
1780 return retval;
1781 if (jtag_init_inner(cmd_ctx)==ERROR_OK)
1782 {
1783 return ERROR_OK;
1784 }
1785 return jtag_init_reset(cmd_ctx);
1786 }
1787
1788 void jtag_set_speed_khz(unsigned khz)
1789 {
1790 speed_khz = khz;
1791 }
1792 unsigned jtag_get_speed_khz(void)
1793 {
1794 return speed_khz;
1795 }
1796
1797 static int default_khz(int khz, int *jtag_speed)
1798 {
1799 LOG_ERROR("Translation from khz to jtag_speed not implemented");
1800 return ERROR_FAIL;
1801 }
1802
1803 static int default_speed_div(int speed, int *khz)
1804 {
1805 LOG_ERROR("Translation from jtag_speed to khz not implemented");
1806 return ERROR_FAIL;
1807 }
1808
1809 static int default_power_dropout(int *dropout)
1810 {
1811 *dropout=0; /* by default we can't detect power dropout */
1812 return ERROR_OK;
1813 }
1814
1815 static int default_srst_asserted(int *srst_asserted)
1816 {
1817 *srst_asserted=0; /* by default we can't detect srst asserted */
1818 return ERROR_OK;
1819 }
1820
1821 static int handle_interface_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1822 {
1823 int i;
1824 int retval;
1825
1826 /* check whether the interface is already configured */
1827 if (jtag_interface)
1828 {
1829 LOG_WARNING("Interface already configured, ignoring");
1830 return ERROR_OK;
1831 }
1832
1833 /* interface name is a mandatory argument */
1834 if (argc < 1 || args[0][0] == '\0')
1835 {
1836 return ERROR_COMMAND_SYNTAX_ERROR;
1837 }
1838
1839 for (i=0; jtag_interfaces[i]; i++)
1840 {
1841 if (strcmp(args[0], jtag_interfaces[i]->name) == 0)
1842 {
1843 if ((retval = jtag_interfaces[i]->register_commands(cmd_ctx)) != ERROR_OK)
1844 {
1845 return retval;
1846 }
1847
1848 jtag_interface = jtag_interfaces[i];
1849
1850 if (jtag_interface->khz == NULL)
1851 {
1852 jtag_interface->khz = default_khz;
1853 }
1854 if (jtag_interface->speed_div == NULL)
1855 {
1856 jtag_interface->speed_div = default_speed_div;
1857 }
1858 if (jtag_interface->power_dropout == NULL)
1859 {
1860 jtag_interface->power_dropout = default_power_dropout;
1861 }
1862 if (jtag_interface->srst_asserted == NULL)
1863 {
1864 jtag_interface->srst_asserted = default_srst_asserted;
1865 }
1866
1867 return ERROR_OK;
1868 }
1869 }
1870
1871 /* no valid interface was found (i.e. the configuration option,
1872 * didn't match one of the compiled-in interfaces
1873 */
1874 LOG_ERROR("No valid jtag interface found (%s)", args[0]);
1875 LOG_ERROR("compiled-in jtag interfaces:");
1876 for (i = 0; jtag_interfaces[i]; i++)
1877 {
1878 LOG_ERROR("%i: %s", i, jtag_interfaces[i]->name);
1879 }
1880
1881 return ERROR_JTAG_INVALID_INTERFACE;
1882 }
1883
1884 static int handle_jtag_device_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1885 {
1886 int e;
1887 char buf[1024];
1888 Jim_Obj *newargs[ 10 ];
1889 /*
1890 * CONVERT SYNTAX
1891 * argv[-1] = command
1892 * argv[ 0] = ir length
1893 * argv[ 1] = ir capture
1894 * argv[ 2] = ir mask
1895 * argv[ 3] = not actually used by anything but in the docs
1896 */
1897
1898 if( argc < 4 ){
1899 command_print( cmd_ctx, "OLD DEPRECATED SYNTAX: Please use the NEW syntax");
1900 return ERROR_OK;
1901 }
1902 command_print( cmd_ctx, "OLD SYNTAX: DEPRECATED - translating to new syntax");
1903 command_print( cmd_ctx, "jtag newtap CHIP TAP -irlen %s -ircapture %s -irvalue %s",
1904 args[0],
1905 args[1],
1906 args[2] );
1907 command_print( cmd_ctx, "Example: STM32 has 2 taps, the cortexM3(len4) + boundaryscan(len5)");
1908 command_print( cmd_ctx, "jtag newtap stm32 cortexm3 ....., thus creating the tap: \"stm32.cortexm3\"");
1909 command_print( cmd_ctx, "jtag newtap stm32 boundary ....., and the tap: \"stm32.boundary\"");
1910 command_print( cmd_ctx, "And then refer to the taps by the dotted name.");
1911
1912 newargs[0] = Jim_NewStringObj( interp, "jtag", -1 );
1913 newargs[1] = Jim_NewStringObj( interp, "newtap", -1 );
1914 sprintf( buf, "chip%d", jtag_tap_count() );
1915 newargs[2] = Jim_NewStringObj( interp, buf, -1 );
1916 sprintf( buf, "tap%d", jtag_tap_count() );
1917 newargs[3] = Jim_NewStringObj( interp, buf, -1 );
1918 newargs[4] = Jim_NewStringObj( interp, "-irlen", -1 );
1919 newargs[5] = Jim_NewStringObj( interp, args[0], -1 );
1920 newargs[6] = Jim_NewStringObj( interp, "-ircapture", -1 );
1921 newargs[7] = Jim_NewStringObj( interp, args[1], -1 );
1922 newargs[8] = Jim_NewStringObj( interp, "-irmask", -1 );
1923 newargs[9] = Jim_NewStringObj( interp, args[2], -1 );
1924
1925 command_print( cmd_ctx, "NEW COMMAND:");
1926 sprintf( buf, "%s %s %s %s %s %s %s %s %s %s",
1927 Jim_GetString( newargs[0], NULL ),
1928 Jim_GetString( newargs[1], NULL ),
1929 Jim_GetString( newargs[2], NULL ),
1930 Jim_GetString( newargs[3], NULL ),
1931 Jim_GetString( newargs[4], NULL ),
1932 Jim_GetString( newargs[5], NULL ),
1933 Jim_GetString( newargs[6], NULL ),
1934 Jim_GetString( newargs[7], NULL ),
1935 Jim_GetString( newargs[8], NULL ),
1936 Jim_GetString( newargs[9], NULL ) );
1937
1938 e = jim_jtag_command( interp, 10, newargs );
1939 if( e != JIM_OK ){
1940 command_print( cmd_ctx, "%s", Jim_GetString( Jim_GetResult(interp), NULL ) );
1941 }
1942 return e;
1943 }
1944
1945 static int handle_scan_chain_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1946 {
1947 jtag_tap_t *tap;
1948
1949 tap = jtag_all_taps();
1950 command_print(cmd_ctx, " TapName | Enabled | IdCode Expected IrLen IrCap IrMask Instr ");
1951 command_print(cmd_ctx, "---|--------------------|---------|------------|------------|------|------|------|---------");
1952
1953 while( tap ){
1954 u32 expected, expected_mask, cur_instr, ii;
1955 expected = buf_get_u32(tap->expected, 0, tap->ir_length);
1956 expected_mask = buf_get_u32(tap->expected_mask, 0, tap->ir_length);
1957 cur_instr = buf_get_u32(tap->cur_instr, 0, tap->ir_length);
1958
1959 command_print(cmd_ctx,
1960 "%2d | %-18s | %c | 0x%08x | 0x%08x | 0x%02x | 0x%02x | 0x%02x | 0x%02x",
1961 tap->abs_chain_position,
1962 tap->dotted_name,
1963 tap->enabled ? 'Y' : 'n',
1964 tap->idcode,
1965 (tap->expected_ids_cnt > 0 ? tap->expected_ids[0] : 0),
1966 tap->ir_length,
1967 expected,
1968 expected_mask,
1969 cur_instr);
1970
1971 for (ii = 1; ii < tap->expected_ids_cnt; ii++) {
1972 command_print(cmd_ctx, " | | | | 0x%08x | | | | ",
1973 tap->expected_ids[ii]);
1974 }
1975
1976 tap = tap->next_tap;
1977 }
1978
1979 return ERROR_OK;
1980 }
1981
1982 static int handle_reset_config_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1983 {
1984 int new_cfg = 0;
1985 int mask = 0;
1986
1987 if (argc < 1)
1988 return ERROR_COMMAND_SYNTAX_ERROR;
1989
1990 /* Original versions cared about the order of these tokens:
1991 * reset_config signals [combination [trst_type [srst_type]]]
1992 * They also clobbered the previous configuration even on error.
1993 *
1994 * Here we don't care about the order, and only change values
1995 * which have been explicitly specified.
1996 */
1997 for (; argc; argc--, args++) {
1998 int tmp = 0;
1999 int m;
2000
2001 /* signals */
2002 m = RESET_HAS_TRST | RESET_HAS_SRST;
2003 if (strcmp(*args, "none") == 0)
2004 tmp = RESET_NONE;
2005 else if (strcmp(*args, "trst_only") == 0)
2006 tmp = RESET_HAS_TRST;
2007 else if (strcmp(*args, "srst_only") == 0)
2008 tmp = RESET_HAS_SRST;
2009 else if (strcmp(*args, "trst_and_srst") == 0)
2010 tmp = RESET_HAS_TRST | RESET_HAS_SRST;
2011 else
2012 m = 0;
2013 if (mask & m) {
2014 LOG_ERROR("extra reset_config %s spec (%s)",
2015 "signal", *args);
2016 return ERROR_INVALID_ARGUMENTS;
2017 }
2018 if (m)
2019 goto next;
2020
2021 /* combination (options for broken wiring) */
2022 m = RESET_SRST_PULLS_TRST | RESET_TRST_PULLS_SRST;
2023 if (strcmp(*args, "separate") == 0)
2024 /* separate reset lines - default */;
2025 else if (strcmp(*args, "srst_pulls_trst") == 0)
2026 tmp |= RESET_SRST_PULLS_TRST;
2027 else if (strcmp(*args, "trst_pulls_srst") == 0)
2028 tmp |= RESET_TRST_PULLS_SRST;
2029 else if (strcmp(*args, "combined") == 0)
2030 tmp |= RESET_SRST_PULLS_TRST | RESET_TRST_PULLS_SRST;
2031 else
2032 m = 0;
2033 if (mask & m) {
2034 LOG_ERROR("extra reset_config %s spec (%s)",
2035 "combination", *args);
2036 return ERROR_INVALID_ARGUMENTS;
2037 }
2038 if (m)
2039 goto next;
2040
2041 /* trst_type (NOP without HAS_TRST) */
2042 m = RESET_TRST_OPEN_DRAIN;
2043 if (strcmp(*args, "trst_open_drain") == 0)
2044 tmp |= RESET_TRST_OPEN_DRAIN;
2045 else if (strcmp(*args, "trst_push_pull") == 0)
2046 /* push/pull from adapter - default */;
2047 else
2048 m = 0;
2049 if (mask & m) {
2050 LOG_ERROR("extra reset_config %s spec (%s)",
2051 "trst_type", *args);
2052 return ERROR_INVALID_ARGUMENTS;
2053 }
2054 if (m)
2055 goto next;
2056
2057 /* srst_type (NOP without HAS_SRST) */
2058 m |= RESET_SRST_PUSH_PULL;
2059 if (strcmp(*args, "srst_push_pull") == 0)
2060 tmp |= RESET_SRST_PUSH_PULL;
2061 else if (strcmp(*args, "srst_open_drain") == 0)
2062 /* open drain from adapter - default */;
2063 else
2064 m = 0;
2065 if (mask & m) {
2066 LOG_ERROR("extra reset_config %s spec (%s)",
2067 "srst_type", *args);
2068 return ERROR_INVALID_ARGUMENTS;
2069 }
2070 if (m)
2071 goto next;
2072
2073 /* caller provided nonsense; fail */
2074 LOG_ERROR("unknown reset_config flag (%s)", *args);
2075 return ERROR_INVALID_ARGUMENTS;
2076
2077 next:
2078 /* Remember the bits which were specified (mask)
2079 * and their new values (new_cfg).
2080 */
2081 mask |= m;
2082 new_cfg |= tmp;
2083 }
2084
2085 /* clear previous values of those bits, save new values */
2086 jtag_reset_config &= ~mask;
2087 jtag_reset_config |= new_cfg;
2088
2089 return ERROR_OK;
2090 }
2091
2092 static int handle_jtag_nsrst_delay_command(struct command_context_s *cmd_ctx,
2093 char *cmd, char **args, int argc)
2094 {
2095 if (argc > 1)
2096 return ERROR_COMMAND_SYNTAX_ERROR;
2097 if (argc == 1)
2098 jtag_set_nsrst_delay(strtoul(args[0], NULL, 0));
2099 command_print(cmd_ctx, "jtag_nsrst_delay: %u", jtag_get_nsrst_delay());
2100 return ERROR_OK;
2101 }
2102
2103 static int handle_jtag_ntrst_delay_command(struct command_context_s *cmd_ctx,
2104 char *cmd, char **args, int argc)
2105 {
2106 if (argc > 1)
2107 return ERROR_COMMAND_SYNTAX_ERROR;
2108 if (argc == 1)
2109 jtag_set_ntrst_delay(strtoul(args[0], NULL, 0));
2110 command_print(cmd_ctx, "jtag_ntrst_delay: %u", jtag_get_ntrst_delay());
2111 return ERROR_OK;
2112 }
2113
2114 static int handle_jtag_speed_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2115 {
2116 int retval = ERROR_OK;
2117
2118 if (argc > 1)
2119 return ERROR_COMMAND_SYNTAX_ERROR;
2120 if (argc == 1)
2121 {
2122 LOG_DEBUG("handle jtag speed");
2123
2124 int cur_speed = 0;
2125 cur_speed = jtag_speed = strtoul(args[0], NULL, 0);
2126
2127 /* this command can be called during CONFIG,
2128 * in which case jtag isn't initialized */
2129 if (jtag)
2130 retval = jtag->speed(cur_speed);
2131 }
2132 command_print(cmd_ctx, "jtag_speed: %d", jtag_speed);
2133
2134 return retval;
2135 }
2136
2137 static int handle_jtag_khz_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2138 {
2139 if (argc > 1)
2140 return ERROR_COMMAND_SYNTAX_ERROR;
2141
2142 int retval = ERROR_OK;
2143 int cur_speed = 0;
2144 if (argc == 1)
2145 {
2146 LOG_DEBUG("handle jtag khz");
2147
2148 jtag_set_speed_khz(strtoul(args[0], NULL, 0));
2149 if (jtag != NULL)
2150 {
2151 LOG_DEBUG("have interface set up");
2152 int speed_div1;
2153 retval = jtag->khz(jtag_get_speed_khz(), &speed_div1);
2154 if (ERROR_OK != retval)
2155 {
2156 jtag_set_speed_khz(0);
2157 return retval;
2158 }
2159 cur_speed = jtag_speed = speed_div1;
2160
2161 retval = jtag->speed(cur_speed);
2162 }
2163 else
2164 hasKHz = true;
2165 }
2166
2167 cur_speed = jtag_get_speed_khz();
2168 if (jtag != NULL)
2169 {
2170 retval = jtag->speed_div(jtag_speed, &cur_speed);
2171 if (ERROR_OK != retval)
2172 return retval;
2173 }
2174
2175 if (cur_speed)
2176 command_print(cmd_ctx, "%d kHz", cur_speed);
2177 else
2178 command_print(cmd_ctx, "RCLK - adaptive");
2179 return retval;
2180
2181 }
2182
2183 static int handle_jtag_reset_command(struct command_context_s *cmd_ctx,
2184 char *cmd, char **args, int argc)
2185 {
2186 if (argc != 2)
2187 return ERROR_COMMAND_SYNTAX_ERROR;
2188
2189 int trst = -1;
2190 if (args[0][0] == '1')
2191 trst = 1;
2192 else if (args[0][0] == '0')
2193 trst = 0;
2194 else
2195 return ERROR_COMMAND_SYNTAX_ERROR;
2196
2197 int srst = -1;
2198 if (args[1][0] == '1')
2199 srst = 1;
2200 else if (args[1][0] == '0')
2201 srst = 0;
2202 else
2203 return ERROR_COMMAND_SYNTAX_ERROR;
2204
2205 if (jtag_interface_init(cmd_ctx) != ERROR_OK)
2206 return ERROR_JTAG_INIT_FAILED;
2207
2208 jtag_add_reset(trst, srst);
2209 jtag_execute_queue();
2210
2211 return ERROR_OK;
2212 }
2213
2214 static int handle_runtest_command(struct command_context_s *cmd_ctx,
2215 char *cmd, char **args, int argc)
2216 {
2217 if (argc != 1)
2218 return ERROR_COMMAND_SYNTAX_ERROR;
2219
2220 jtag_add_runtest(strtol(args[0], NULL, 0), jtag_get_end_state());
2221 jtag_execute_queue();
2222
2223 return ERROR_OK;
2224 }
2225
2226 /*
2227 * For "irscan" or "drscan" commands, the "end" (really, "next") state
2228 * should be stable ... and *NOT* a shift state, otherwise free-running
2229 * jtag clocks could change the values latched by the update state.
2230 */
2231 static bool scan_is_safe(tap_state_t state)
2232 {
2233 switch (state)
2234 {
2235 case TAP_RESET:
2236 case TAP_IDLE:
2237 case TAP_DRPAUSE:
2238 case TAP_IRPAUSE:
2239 return true;
2240 default:
2241 return false;
2242 }
2243 }
2244
2245
2246 static int handle_irscan_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2247 {
2248 int i;
2249 scan_field_t *fields;
2250 jtag_tap_t *tap;
2251 tap_state_t endstate;
2252
2253 if ((argc < 2) || (argc % 2))
2254 {
2255 return ERROR_COMMAND_SYNTAX_ERROR;
2256 }
2257
2258 /* optional "-endstate" "statename" at the end of the arguments,
2259 * so that e.g. IRPAUSE can let us load the data register before
2260 * entering RUN/IDLE to execute the instruction we load here.
2261 */
2262 endstate = TAP_IDLE;
2263
2264 if( argc >= 4 ){
2265 /* have at least one pair of numbers. */
2266 /* is last pair the magic text? */
2267 if( 0 == strcmp( "-endstate", args[ argc - 2 ] ) ){
2268 const char *cpA;
2269 const char *cpS;
2270 cpA = args[ argc-1 ];
2271 for( endstate = 0 ; endstate < TAP_NUM_STATES ; endstate++ ){
2272 cpS = tap_state_name( endstate );
2273 if( 0 == strcmp( cpA, cpS ) ){
2274 break;
2275 }
2276 }
2277 if( endstate >= TAP_NUM_STATES ){
2278 return ERROR_COMMAND_SYNTAX_ERROR;
2279 } else {
2280 if (!scan_is_safe(endstate))
2281 LOG_WARNING("irscan with unsafe "
2282 "endstate \"%s\"", cpA);
2283 /* found - remove the last 2 args */
2284 argc -= 2;
2285 }
2286 }
2287 }
2288
2289 int num_fields = argc / 2;
2290
2291 fields = malloc(sizeof(scan_field_t) * num_fields);
2292
2293 for (i = 0; i < num_fields; i++)
2294 {
2295 tap = jtag_tap_by_string( args[i*2] );
2296 if (tap==NULL)
2297 {
2298 command_print( cmd_ctx, "Tap: %s unknown", args[i*2] );
2299 return ERROR_FAIL;
2300 }
2301 int field_size = tap->ir_length;
2302 fields[i].tap = tap;
2303 fields[i].num_bits = field_size;
2304 fields[i].out_value = malloc(CEIL(field_size, 8));
2305 buf_set_u32(fields[i].out_value, 0, field_size, strtoul(args[i*2+1], NULL, 0));
2306 fields[i].in_value = NULL;
2307 }
2308
2309 /* did we have an endstate? */
2310 jtag_add_ir_scan(num_fields, fields, endstate);
2311
2312 int retval=jtag_execute_queue();
2313
2314 for (i = 0; i < num_fields; i++)
2315 free(fields[i].out_value);
2316
2317 free (fields);
2318
2319 return retval;
2320 }
2321
2322 static int Jim_Command_drscan(Jim_Interp *interp, int argc, Jim_Obj *const *args)
2323 {
2324 int retval;
2325 scan_field_t *fields;
2326 int num_fields;
2327 int field_count = 0;
2328 int i, e;
2329 jtag_tap_t *tap;
2330 tap_state_t endstate;
2331
2332 /* args[1] = device
2333 * args[2] = num_bits
2334 * args[3] = hex string
2335 * ... repeat num bits and hex string ...
2336 *
2337 * .. optionally:
2338 * args[N-2] = "-endstate"
2339 * args[N-1] = statename
2340 */
2341 if ((argc < 4) || ((argc % 2)!=0))
2342 {
2343 Jim_WrongNumArgs(interp, 1, args, "wrong arguments");
2344 return JIM_ERR;
2345 }
2346
2347 endstate = TAP_IDLE;
2348
2349 /* validate arguments as numbers */
2350 e = JIM_OK;
2351 for (i = 2; i < argc; i+=2)
2352 {
2353 long bits;
2354 const char *cp;
2355
2356 e = Jim_GetLong(interp, args[i], &bits);
2357 /* If valid - try next arg */
2358 if( e == JIM_OK ){
2359 continue;
2360 }
2361
2362 /* Not valid.. are we at the end? */
2363 if ( ((i+2) != argc) ){
2364 /* nope, then error */
2365 return e;
2366 }
2367
2368 /* it could be: "-endstate FOO"
2369 * e.g. DRPAUSE so we can issue more instructions
2370 * before entering RUN/IDLE and executing them.
2371 */
2372
2373 /* get arg as a string. */
2374 cp = Jim_GetString( args[i], NULL );
2375 /* is it the magic? */
2376 if( 0 == strcmp( "-endstate", cp ) ){
2377 /* is the statename valid? */
2378 cp = Jim_GetString( args[i+1], NULL );
2379
2380 /* see if it is a valid state name */
2381 endstate = tap_state_by_name(cp);
2382 if( endstate < 0 ){
2383 /* update the error message */
2384 Jim_SetResult_sprintf(interp,"endstate: %s invalid", cp );
2385 } else {
2386 if (!scan_is_safe(endstate))
2387 LOG_WARNING("drscan with unsafe "
2388 "endstate \"%s\"", cp);
2389
2390 /* valid - so clear the error */
2391 e = JIM_OK;
2392 /* and remove the last 2 args */
2393 argc -= 2;
2394 }
2395 }
2396
2397 /* Still an error? */
2398 if( e != JIM_OK ){
2399 return e; /* too bad */
2400 }
2401 } /* validate args */
2402
2403 tap = jtag_tap_by_jim_obj( interp, args[1] );
2404 if( tap == NULL ){
2405 return JIM_ERR;
2406 }
2407
2408 num_fields=(argc-2)/2;
2409 fields = malloc(sizeof(scan_field_t) * num_fields);
2410 for (i = 2; i < argc; i+=2)
2411 {
2412 long bits;
2413 int len;
2414 const char *str;
2415
2416 Jim_GetLong(interp, args[i], &bits);
2417 str = Jim_GetString(args[i+1], &len);
2418
2419 fields[field_count].tap = tap;
2420 fields[field_count].num_bits = bits;
2421 fields[field_count].out_value = malloc(CEIL(bits, 8));
2422 str_to_buf(str, len, fields[field_count].out_value, bits, 0);
2423 fields[field_count].in_value = fields[field_count].out_value;
2424 field_count++;
2425 }
2426
2427 jtag_add_dr_scan(num_fields, fields, endstate);
2428
2429 retval = jtag_execute_queue();
2430 if (retval != ERROR_OK)
2431 {
2432 Jim_SetResultString(interp, "drscan: jtag execute failed",-1);
2433 return JIM_ERR;
2434 }
2435
2436 field_count=0;
2437 Jim_Obj *list = Jim_NewListObj(interp, NULL, 0);
2438 for (i = 2; i < argc; i+=2)
2439 {
2440 long bits;
2441 char *str;
2442
2443 Jim_GetLong(interp, args[i], &bits);
2444 str = buf_to_str(fields[field_count].in_value, bits, 16);
2445 free(fields[field_count].out_value);
2446
2447 Jim_ListAppendElement(interp, list, Jim_NewStringObj(interp, str, strlen(str)));
2448 free(str);
2449 field_count++;
2450 }
2451
2452 Jim_SetResult(interp, list);
2453
2454 free(fields);
2455
2456 return JIM_OK;
2457 }
2458
2459
2460 static int Jim_Command_flush_count(Jim_Interp *interp, int argc, Jim_Obj *const *args)
2461 {
2462 Jim_SetResult(interp, Jim_NewIntObj(interp, jtag_get_flush_queue_count()));
2463
2464 return JIM_OK;
2465 }
2466
2467
2468 static int handle_verify_ircapture_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2469 {
2470 if (argc == 1)
2471 {
2472 if (strcmp(args[0], "enable") == 0)
2473 {
2474 jtag_verify_capture_ir = 1;
2475 }
2476 else if (strcmp(args[0], "disable") == 0)
2477 {
2478 jtag_verify_capture_ir = 0;
2479 } else
2480 {
2481 return ERROR_COMMAND_SYNTAX_ERROR;
2482 }
2483 } else if (argc != 0)
2484 {
2485 return ERROR_COMMAND_SYNTAX_ERROR;
2486 }
2487
2488 command_print(cmd_ctx, "verify Capture-IR is %s", (jtag_verify_capture_ir) ? "enabled": "disabled");
2489
2490 return ERROR_OK;
2491 }
2492
2493 void jtag_set_verify(bool enable)
2494 {
2495 jtag_verify = enable;
2496 }
2497
2498 bool jtag_will_verify()
2499 {
2500 return jtag_verify;
2501 }
2502
2503 static int handle_verify_jtag_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2504 {
2505 if (argc > 1)
2506 return ERROR_COMMAND_SYNTAX_ERROR;
2507
2508 if (argc == 1)
2509 {
2510 if (strcmp(args[0], "enable") == 0)
2511 jtag_set_verify(true);
2512 else if (strcmp(args[0], "disable") == 0)
2513 jtag_set_verify(false);
2514 else
2515 return ERROR_COMMAND_SYNTAX_ERROR;
2516 }
2517
2518 const char *status = jtag_will_verify() ? "enabled": "disabled";
2519 command_print(cmd_ctx, "verify jtag capture is %s", status);
2520
2521 return ERROR_OK;
2522 }
2523
2524
2525 int jtag_power_dropout(int *dropout)
2526 {
2527 return jtag->power_dropout(dropout);
2528 }
2529
2530 int jtag_srst_asserted(int *srst_asserted)
2531 {
2532 return jtag->srst_asserted(srst_asserted);
2533 }
2534
2535 void jtag_tap_handle_event( jtag_tap_t * tap, enum jtag_tap_event e)
2536 {
2537 jtag_tap_event_action_t * jteap;
2538 int done;
2539
2540 jteap = tap->event_action;
2541
2542 done = 0;
2543 while (jteap) {
2544 if (jteap->event == e) {
2545 done = 1;
2546 LOG_DEBUG( "JTAG tap: %s event: %d (%s) action: %s\n",
2547 tap->dotted_name,
2548 e,
2549 Jim_Nvp_value2name_simple(nvp_jtag_tap_event, e)->name,
2550 Jim_GetString(jteap->body, NULL) );
2551 if (Jim_EvalObj(interp, jteap->body) != JIM_OK) {
2552 Jim_PrintErrorMessage(interp);
2553 }
2554 }
2555
2556 jteap = jteap->next;
2557 }
2558
2559 if (!done) {
2560 LOG_DEBUG( "event %d %s - no action",
2561 e,
2562 Jim_Nvp_value2name_simple( nvp_jtag_tap_event, e)->name);
2563 }
2564 }
2565
2566 static int handle_tms_sequence_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2567 {
2568 if (argc > 1)
2569 return ERROR_COMMAND_SYNTAX_ERROR;
2570
2571 if (argc == 1)
2572 {
2573 bool use_new_table;
2574 if (strcmp(args[0], "short") == 0)
2575 use_new_table = true;
2576 else if (strcmp(args[0], "long") == 0)
2577 use_new_table = false;
2578 else
2579 return ERROR_COMMAND_SYNTAX_ERROR;
2580
2581 tap_use_new_tms_table(use_new_table);
2582 }
2583
2584 command_print(cmd_ctx, "tms sequence is %s",
2585 tap_uses_new_tms_table() ? "short": "long");
2586
2587 return ERROR_OK;
2588 }
2589
2590 /**
2591 * Function jtag_add_statemove
2592 * moves from the current state to the goal \a state. This needs
2593 * to be handled according to the xsvf spec, see the XSTATE command
2594 * description.
2595 */
2596 int jtag_add_statemove(tap_state_t goal_state)
2597 {
2598 int retval = ERROR_OK;
2599
2600 tap_state_t moves[8];
2601 tap_state_t cur_state = cmd_queue_cur_state;
2602 int i;
2603 int tms_bits;
2604 int tms_count;
2605
2606 LOG_DEBUG( "cur_state=%s goal_state=%s",
2607 tap_state_name(cur_state),
2608 tap_state_name(goal_state) );
2609
2610
2611 /* From the XSVF spec, pertaining to XSTATE:
2612
2613 For special states known as stable states (Test-Logic-Reset,
2614 Run-Test/Idle, Pause-DR, Pause- IR), an XSVF interpreter follows
2615 predefined TAP state paths when the starting state is a stable state and
2616 when the XSTATE specifies a new stable state (see the STATE command in
2617 the [Ref 5] for the TAP state paths between stable states). For
2618 non-stable states, XSTATE should specify a state that is only one TAP
2619 state transition distance from the current TAP state to avoid undefined
2620 TAP state paths. A sequence of multiple XSTATE commands can be issued to
2621 transition the TAP through a specific state path.
2622 */
2623
2624 if (goal_state==cur_state )
2625 ; /* nothing to do */
2626
2627 else if( goal_state==TAP_RESET )
2628 {
2629 jtag_add_tlr();
2630 }
2631
2632 else if( tap_is_state_stable(cur_state) && tap_is_state_stable(goal_state) )
2633 {
2634 /* note: unless tms_bits holds a path that agrees with [Ref 5] in above
2635 spec, then this code is not fully conformant to the xsvf spec. This
2636 puts a burden on tap_get_tms_path() function from the xsvf spec.
2637 If in doubt, you should confirm that that burden is being met.
2638 */
2639
2640 tms_bits = tap_get_tms_path(cur_state, goal_state);
2641 tms_count = tap_get_tms_path_len(cur_state, goal_state);
2642
2643 assert( (unsigned) tms_count < DIM(moves) );
2644
2645 for (i=0; i<tms_count; i++, tms_bits>>=1)
2646 {
2647 bool bit = tms_bits & 1;
2648
2649 cur_state = tap_state_transition(cur_state, bit);
2650 moves[i] = cur_state;
2651 }
2652
2653 jtag_add_pathmove(tms_count, moves);
2654 }
2655
2656 /* else state must be immediately reachable in one clock cycle, and does not
2657 need to be a stable state.
2658 */
2659 else if( tap_state_transition(cur_state, true) == goal_state
2660 || tap_state_transition(cur_state, false) == goal_state )
2661 {
2662 /* move a single state */
2663 moves[0] = goal_state;
2664 jtag_add_pathmove( 1, moves );
2665 }
2666
2667 else
2668 {
2669 retval = ERROR_FAIL;
2670 }
2671
2672 return retval;
2673 }
2674
2675 void jtag_set_nsrst_delay(unsigned delay)
2676 {
2677 jtag_nsrst_delay = delay;
2678 }
2679 unsigned jtag_get_nsrst_delay(void)
2680 {
2681 return jtag_nsrst_delay;
2682 }
2683 void jtag_set_ntrst_delay(unsigned delay)
2684 {
2685 jtag_ntrst_delay = delay;
2686 }
2687 unsigned jtag_get_ntrst_delay(void)
2688 {
2689 return jtag_ntrst_delay;
2690 }

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)