Simplify jtag_add_tlr:
[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 jtag_set_error(interface_jtag_add_tlr());
603 jtag_call_event_callbacks(JTAG_TRST_ASSERTED);
604 }
605
606 void jtag_add_pathmove(int num_states, const tap_state_t *path)
607 {
608 tap_state_t cur_state = cmd_queue_cur_state;
609 int i;
610 int retval;
611
612 /* the last state has to be a stable state */
613 if (!tap_is_state_stable(path[num_states - 1]))
614 {
615 LOG_ERROR("BUG: TAP path doesn't finish in a stable state");
616 exit(-1);
617 }
618
619 for (i=0; i<num_states; i++)
620 {
621 if (path[i] == TAP_RESET)
622 {
623 LOG_ERROR("BUG: TAP_RESET is not a valid state for pathmove sequences");
624 exit(-1);
625 }
626
627 if ( tap_state_transition(cur_state, true) != path[i]
628 && tap_state_transition(cur_state, false) != path[i])
629 {
630 LOG_ERROR("BUG: %s -> %s isn't a valid TAP transition", tap_state_name(cur_state), tap_state_name(path[i]));
631 exit(-1);
632 }
633 cur_state = path[i];
634 }
635
636 jtag_checks();
637
638 retval = interface_jtag_add_pathmove(num_states, path);
639 cmd_queue_cur_state = path[num_states - 1];
640 if (retval!=ERROR_OK)
641 jtag_error=retval;
642 }
643
644 void jtag_add_runtest(int num_cycles, tap_state_t state)
645 {
646 int retval;
647
648 jtag_prelude(state);
649
650 /* executed by sw or hw fifo */
651 retval=interface_jtag_add_runtest(num_cycles, state);
652 if (retval!=ERROR_OK)
653 jtag_error=retval;
654 }
655
656
657 void jtag_add_clocks( int num_cycles )
658 {
659 int retval;
660
661 if( !tap_is_state_stable(cmd_queue_cur_state) )
662 {
663 LOG_ERROR( "jtag_add_clocks() was called with TAP in non-stable state \"%s\"",
664 tap_state_name(cmd_queue_cur_state) );
665 jtag_error = ERROR_JTAG_NOT_STABLE_STATE;
666 return;
667 }
668
669 if( num_cycles > 0 )
670 {
671 jtag_checks();
672
673 retval = interface_jtag_add_clocks(num_cycles);
674 if (retval != ERROR_OK)
675 jtag_error=retval;
676 }
677 }
678
679 void jtag_add_reset(int req_tlr_or_trst, int req_srst)
680 {
681 int trst_with_tlr = 0;
682 int retval;
683
684 /* FIX!!! there are *many* different cases here. A better
685 * approach is needed for legal combinations of transitions...
686 */
687 if ((jtag_reset_config & RESET_HAS_SRST)&&
688 (jtag_reset_config & RESET_HAS_TRST)&&
689 ((jtag_reset_config & RESET_SRST_PULLS_TRST)==0))
690 {
691 if (((req_tlr_or_trst&&!jtag_trst)||
692 (!req_tlr_or_trst&&jtag_trst))&&
693 ((req_srst&&!jtag_srst)||
694 (!req_srst&&jtag_srst)))
695 {
696 /* FIX!!! srst_pulls_trst allows 1,1 => 0,0 transition.... */
697 //LOG_ERROR("BUG: transition of req_tlr_or_trst and req_srst in the same jtag_add_reset() call is undefined");
698 }
699 }
700
701 /* Make sure that jtag_reset_config allows the requested reset */
702 /* if SRST pulls TRST, we can't fulfill srst == 1 with trst == 0 */
703 if (((jtag_reset_config & RESET_SRST_PULLS_TRST) && (req_srst == 1)) && (!req_tlr_or_trst))
704 {
705 LOG_ERROR("BUG: requested reset would assert trst");
706 jtag_error=ERROR_FAIL;
707 return;
708 }
709
710 /* if TRST pulls SRST, we reset with TAP T-L-R */
711 if (((jtag_reset_config & RESET_TRST_PULLS_SRST) && (req_tlr_or_trst)) && (req_srst == 0))
712 {
713 trst_with_tlr = 1;
714 }
715
716 if (req_srst && !(jtag_reset_config & RESET_HAS_SRST))
717 {
718 LOG_ERROR("BUG: requested SRST assertion, but the current configuration doesn't support this");
719 jtag_error=ERROR_FAIL;
720 return;
721 }
722
723 if (req_tlr_or_trst)
724 {
725 if (!trst_with_tlr && (jtag_reset_config & RESET_HAS_TRST))
726 {
727 jtag_trst = 1;
728 } else
729 {
730 trst_with_tlr = 1;
731 }
732 } else
733 {
734 jtag_trst = 0;
735 }
736
737 jtag_srst = req_srst;
738
739 retval = interface_jtag_add_reset(jtag_trst, jtag_srst);
740 if (retval!=ERROR_OK)
741 {
742 jtag_error=retval;
743 return;
744 }
745 jtag_execute_queue();
746
747 if (jtag_srst)
748 {
749 LOG_DEBUG("SRST line asserted");
750 }
751 else
752 {
753 LOG_DEBUG("SRST line released");
754 if (jtag_nsrst_delay)
755 jtag_add_sleep(jtag_nsrst_delay * 1000);
756 }
757
758 if (trst_with_tlr)
759 {
760 LOG_DEBUG("JTAG reset with RESET instead of TRST");
761 jtag_set_end_state(TAP_RESET);
762 jtag_add_tlr();
763 return;
764 }
765
766 if (jtag_trst)
767 {
768 /* we just asserted nTRST, so we're now in Test-Logic-Reset,
769 * and inform possible listeners about this
770 */
771 LOG_DEBUG("TRST line asserted");
772 tap_set_state(TAP_RESET);
773 jtag_call_event_callbacks(JTAG_TRST_ASSERTED);
774 }
775 else
776 {
777 if (jtag_ntrst_delay)
778 jtag_add_sleep(jtag_ntrst_delay * 1000);
779 }
780 }
781
782 tap_state_t jtag_set_end_state(tap_state_t state)
783 {
784 if ((state == TAP_DRSHIFT)||(state == TAP_IRSHIFT))
785 {
786 LOG_ERROR("BUG: TAP_DRSHIFT/IRSHIFT can't be end state. Calling code should use a larger scan field");
787 }
788
789 if (state!=TAP_INVALID)
790 cmd_queue_end_state = state;
791 return cmd_queue_end_state;
792 }
793
794 tap_state_t jtag_get_end_state(void)
795 {
796 return cmd_queue_end_state;
797 }
798
799 void jtag_add_sleep(u32 us)
800 {
801 keep_alive(); /* we might be running on a very slow JTAG clk */
802 int retval=interface_jtag_add_sleep(us);
803 if (retval!=ERROR_OK)
804 jtag_error=retval;
805 return;
806 }
807
808 int jtag_check_value_inner(u8 *captured, u8 *in_check_value, u8 *in_check_mask, int num_bits)
809 {
810 int retval = ERROR_OK;
811
812 int compare_failed = 0;
813
814 if (in_check_mask)
815 compare_failed = buf_cmp_mask(captured, in_check_value, in_check_mask, num_bits);
816 else
817 compare_failed = buf_cmp(captured, in_check_value, num_bits);
818
819 if (compare_failed){
820 /* An error handler could have caught the failing check
821 * only report a problem when there wasn't a handler, or if the handler
822 * acknowledged the error
823 */
824 /*
825 LOG_WARNING("TAP %s:",
826 jtag_tap_name(field->tap));
827 */
828 if (compare_failed)
829 {
830 char *captured_char = buf_to_str(captured, (num_bits > DEBUG_JTAG_IOZ) ? DEBUG_JTAG_IOZ : num_bits, 16);
831 char *in_check_value_char = buf_to_str(in_check_value, (num_bits > DEBUG_JTAG_IOZ) ? DEBUG_JTAG_IOZ : num_bits, 16);
832
833 if (in_check_mask)
834 {
835 char *in_check_mask_char;
836 in_check_mask_char = buf_to_str(in_check_mask, (num_bits > DEBUG_JTAG_IOZ) ? DEBUG_JTAG_IOZ : num_bits, 16);
837 LOG_WARNING("value captured during scan didn't pass the requested check:");
838 LOG_WARNING("captured: 0x%s check_value: 0x%s check_mask: 0x%s",
839 captured_char, in_check_value_char, in_check_mask_char);
840 free(in_check_mask_char);
841 }
842 else
843 {
844 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);
845 }
846
847 free(captured_char);
848 free(in_check_value_char);
849
850 retval = ERROR_JTAG_QUEUE_FAILED;
851 }
852
853 }
854 return retval;
855 }
856
857 void jtag_check_value_mask(scan_field_t *field, u8 *value, u8 *mask)
858 {
859 assert(field->in_value != NULL);
860
861 if (value==NULL)
862 {
863 /* no checking to do */
864 return;
865 }
866
867 jtag_execute_queue_noclear();
868
869 int retval=jtag_check_value_inner(field->in_value, value, mask, field->num_bits);
870 jtag_set_error(retval);
871 }
872
873
874
875 int default_interface_jtag_execute_queue(void)
876 {
877 if (NULL == jtag)
878 {
879 LOG_ERROR("No JTAG interface configured yet. "
880 "Issue 'init' command in startup scripts "
881 "before communicating with targets.");
882 return ERROR_FAIL;
883 }
884
885 return jtag->execute_queue();
886 }
887
888 void jtag_execute_queue_noclear(void)
889 {
890 jtag_flush_queue_count++;
891 jtag_set_error(interface_jtag_execute_queue());
892 }
893
894 int jtag_get_flush_queue_count(void)
895 {
896 return jtag_flush_queue_count;
897 }
898
899 int jtag_execute_queue(void)
900 {
901 jtag_execute_queue_noclear();
902 return jtag_error_clear();
903 }
904
905 static int jtag_reset_callback(enum jtag_event event, void *priv)
906 {
907 jtag_tap_t *tap = priv;
908
909 LOG_DEBUG("-");
910
911 if (event == JTAG_TRST_ASSERTED)
912 {
913 buf_set_ones(tap->cur_instr, tap->ir_length);
914 tap->bypass = 1;
915 }
916
917 return ERROR_OK;
918 }
919
920 void jtag_sleep(u32 us)
921 {
922 alive_sleep(us/1000);
923 }
924
925 /// maximum number of JTAG devices expected in the chain
926 #define JTAG_MAX_CHAIN_SIZE 20
927
928 #define EXTRACT_MFG(X) (((X) & 0xffe) >> 1)
929 #define EXTRACT_PART(X) (((X) & 0xffff000) >> 12)
930 #define EXTRACT_VER(X) (((X) & 0xf0000000) >> 28)
931
932 static int jtag_examine_chain_execute(u8 *idcode_buffer, unsigned num_idcode)
933 {
934 scan_field_t field = {
935 .tap = NULL,
936 .num_bits = num_idcode * 32,
937 .out_value = idcode_buffer,
938 .in_value = idcode_buffer,
939 };
940
941 // initialize to the end of chain ID value
942 for (unsigned i = 0; i < JTAG_MAX_CHAIN_SIZE; i++)
943 buf_set_u32(idcode_buffer, i * 32, 32, 0x000000FF);
944
945 jtag_add_plain_dr_scan(1, &field, TAP_RESET);
946 return jtag_execute_queue();
947 }
948
949 static bool jtag_examine_chain_check(u8 *idcodes, unsigned count)
950 {
951 u8 zero_check = 0x0;
952 u8 one_check = 0xff;
953
954 for (unsigned i = 0; i < count * 4; i++)
955 {
956 zero_check |= idcodes[i];
957 one_check &= idcodes[i];
958 }
959
960 /* if there wasn't a single non-zero bit or if all bits were one,
961 * the scan is not valid */
962 if (zero_check == 0x00 || one_check == 0xff)
963 {
964 LOG_ERROR("JTAG communication failure: check connection, "
965 "JTAG interface, target power etc.");
966 return false;
967 }
968 return true;
969 }
970
971 static void jtag_examine_chain_display(enum log_levels level, const char *msg,
972 const char *name, u32 idcode)
973 {
974 log_printf_lf(level, __FILE__, __LINE__, __FUNCTION__,
975 "JTAG tap: %s %16.16s: 0x%08x "
976 "(mfg: 0x%3.3x, part: 0x%4.4x, ver: 0x%1.1x)",
977 name, msg, idcode,
978 EXTRACT_MFG(idcode), EXTRACT_PART(idcode), EXTRACT_VER(idcode) );
979 }
980
981 static bool jtag_idcode_is_final(u32 idcode)
982 {
983 return idcode == 0x000000FF || idcode == 0xFFFFFFFF;
984 }
985
986 /**
987 * This helper checks that remaining bits in the examined chain data are
988 * all as expected, but a single JTAG device requires only 64 bits to be
989 * read back correctly. This can help identify and diagnose problems
990 * with the JTAG chain earlier, gives more helpful/explicit error messages.
991 */
992 static void jtag_examine_chain_end(u8 *idcodes, unsigned count, unsigned max)
993 {
994 bool triggered = false;
995 for ( ; count < max - 31; count += 32)
996 {
997 u32 idcode = buf_get_u32(idcodes, count, 32);
998 // do not trigger the warning if the data looks good
999 if (!triggered && jtag_idcode_is_final(idcode))
1000 continue;
1001 LOG_WARNING("Unexpected idcode after end of chain: %d 0x%08x",
1002 count, idcode);
1003 triggered = true;
1004 }
1005 }
1006
1007 static bool jtag_examine_chain_match_tap(const struct jtag_tap_s *tap)
1008 {
1009 if (0 == tap->expected_ids_cnt)
1010 {
1011 /// @todo Enable LOG_INFO to ask for reports about unknown TAP IDs.
1012 #if 0
1013 LOG_INFO("Uknown JTAG TAP ID: 0x%08x", tap->idcode)
1014 LOG_INFO("Please report the chip name and reported ID code to the openocd project");
1015 #endif
1016 return true;
1017 }
1018
1019 /* Loop over the expected identification codes and test for a match */
1020 u8 ii;
1021 for (ii = 0; ii < tap->expected_ids_cnt; ii++)
1022 {
1023 if (tap->idcode == tap->expected_ids[ii])
1024 break;
1025 }
1026
1027 /* If none of the expected ids matched, log an error */
1028 if (ii != tap->expected_ids_cnt)
1029 {
1030 LOG_INFO("JTAG Tap/device matched");
1031 return true;
1032 }
1033 jtag_examine_chain_display(LOG_LVL_ERROR, "got",
1034 tap->dotted_name, tap->idcode);
1035 for (ii = 0; ii < tap->expected_ids_cnt; ii++)
1036 {
1037 char msg[32];
1038 snprintf(msg, sizeof(msg), "expected %hhu of %hhu",
1039 ii + 1, tap->expected_ids_cnt);
1040 jtag_examine_chain_display(LOG_LVL_ERROR, msg,
1041 tap->dotted_name, tap->expected_ids[ii]);
1042 }
1043 return false;
1044 }
1045
1046 /* Try to examine chain layout according to IEEE 1149.1 §12
1047 */
1048 static int jtag_examine_chain(void)
1049 {
1050 u8 idcode_buffer[JTAG_MAX_CHAIN_SIZE * 4];
1051 unsigned device_count = 0;
1052
1053 jtag_examine_chain_execute(idcode_buffer, JTAG_MAX_CHAIN_SIZE);
1054
1055 if (!jtag_examine_chain_check(idcode_buffer, JTAG_MAX_CHAIN_SIZE))
1056 return ERROR_JTAG_INIT_FAILED;
1057
1058 /* point at the 1st tap */
1059 jtag_tap_t *tap = jtag_tap_next_enabled(NULL);
1060 if (tap == NULL)
1061 {
1062 LOG_ERROR("JTAG: No taps enabled?");
1063 return ERROR_JTAG_INIT_FAILED;
1064 }
1065
1066 for (unsigned bit_count = 0; bit_count < (JTAG_MAX_CHAIN_SIZE * 32) - 31;)
1067 {
1068 u32 idcode = buf_get_u32(idcode_buffer, bit_count, 32);
1069 if ((idcode & 1) == 0)
1070 {
1071 /* LSB must not be 0, this indicates a device in bypass */
1072 LOG_WARNING("Tap/Device does not have IDCODE");
1073 idcode = 0;
1074
1075 bit_count += 1;
1076 }
1077 else
1078 {
1079 /*
1080 * End of chain (invalid manufacturer ID) some devices, such
1081 * as AVR will output all 1's instead of TDI input value at
1082 * end of chain.
1083 */
1084 if (jtag_idcode_is_final(idcode))
1085 {
1086 jtag_examine_chain_end(idcode_buffer,
1087 bit_count + 32, JTAG_MAX_CHAIN_SIZE * 32);
1088 break;
1089 }
1090
1091 jtag_examine_chain_display(LOG_LVL_INFO, "tap/device found",
1092 tap ? tap->dotted_name : "(not-named)",
1093 idcode);
1094
1095 bit_count += 32;
1096 }
1097 device_count++;
1098 if (!tap)
1099 continue;
1100
1101 tap->idcode = idcode;
1102
1103 // ensure the TAP ID does matches what was expected
1104 if (!jtag_examine_chain_match_tap(tap))
1105 return ERROR_JTAG_INIT_FAILED;
1106
1107 tap = jtag_tap_next_enabled(tap);
1108 }
1109
1110 /* see if number of discovered devices matches configuration */
1111 if (device_count != jtag_tap_count_enabled())
1112 {
1113 LOG_ERROR("number of discovered devices in JTAG chain (%i) "
1114 "does not match (enabled) configuration (%i), total taps: %d",
1115 device_count, jtag_tap_count_enabled(), jtag_tap_count());
1116 LOG_ERROR("check the config file and ensure proper JTAG communication"
1117 " (connections, speed, ...)");
1118 return ERROR_JTAG_INIT_FAILED;
1119 }
1120
1121 return ERROR_OK;
1122 }
1123
1124 static int jtag_validate_chain(void)
1125 {
1126 jtag_tap_t *tap;
1127 int total_ir_length = 0;
1128 u8 *ir_test = NULL;
1129 scan_field_t field;
1130 int chain_pos = 0;
1131
1132 tap = NULL;
1133 total_ir_length = 0;
1134 for(;;){
1135 tap = jtag_tap_next_enabled(tap);
1136 if( tap == NULL ){
1137 break;
1138 }
1139 total_ir_length += tap->ir_length;
1140 }
1141
1142 total_ir_length += 2;
1143 ir_test = malloc(CEIL(total_ir_length, 8));
1144 buf_set_ones(ir_test, total_ir_length);
1145
1146 field.tap = NULL;
1147 field.num_bits = total_ir_length;
1148 field.out_value = ir_test;
1149 field.in_value = ir_test;
1150
1151
1152 jtag_add_plain_ir_scan(1, &field, TAP_RESET);
1153 jtag_execute_queue();
1154
1155 tap = NULL;
1156 chain_pos = 0;
1157 int val;
1158 for(;;){
1159 tap = jtag_tap_next_enabled(tap);
1160 if( tap == NULL ){
1161 break;
1162 }
1163
1164 val = buf_get_u32(ir_test, chain_pos, 2);
1165 if (val != 0x1)
1166 {
1167 char *cbuf = buf_to_str(ir_test, total_ir_length, 16);
1168 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);
1169 free(cbuf);
1170 free(ir_test);
1171 return ERROR_JTAG_INIT_FAILED;
1172 }
1173 chain_pos += tap->ir_length;
1174 }
1175
1176 val = buf_get_u32(ir_test, chain_pos, 2);
1177 if (val != 0x3)
1178 {
1179 char *cbuf = buf_to_str(ir_test, total_ir_length, 16);
1180 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);
1181 free(cbuf);
1182 free(ir_test);
1183 return ERROR_JTAG_INIT_FAILED;
1184 }
1185
1186 free(ir_test);
1187
1188 return ERROR_OK;
1189 }
1190
1191 enum jtag_tap_cfg_param {
1192 JCFG_EVENT
1193 };
1194
1195 static Jim_Nvp nvp_config_opts[] = {
1196 { .name = "-event", .value = JCFG_EVENT },
1197
1198 { .name = NULL, .value = -1 }
1199 };
1200
1201 static int jtag_tap_configure_cmd( Jim_GetOptInfo *goi, jtag_tap_t * tap)
1202 {
1203 Jim_Nvp *n;
1204 Jim_Obj *o;
1205 int e;
1206
1207 /* parse config or cget options */
1208 while (goi->argc > 0) {
1209 Jim_SetEmptyResult (goi->interp);
1210
1211 e = Jim_GetOpt_Nvp(goi, nvp_config_opts, &n);
1212 if (e != JIM_OK) {
1213 Jim_GetOpt_NvpUnknown(goi, nvp_config_opts, 0);
1214 return e;
1215 }
1216
1217 switch (n->value) {
1218 case JCFG_EVENT:
1219 if (goi->argc == 0) {
1220 Jim_WrongNumArgs( goi->interp, goi->argc, goi->argv, "-event ?event-name? ..." );
1221 return JIM_ERR;
1222 }
1223
1224 e = Jim_GetOpt_Nvp( goi, nvp_jtag_tap_event, &n );
1225 if (e != JIM_OK) {
1226 Jim_GetOpt_NvpUnknown(goi, nvp_jtag_tap_event, 1);
1227 return e;
1228 }
1229
1230 if (goi->isconfigure) {
1231 if (goi->argc != 1) {
1232 Jim_WrongNumArgs(goi->interp, goi->argc, goi->argv, "-event ?event-name? ?EVENT-BODY?");
1233 return JIM_ERR;
1234 }
1235 } else {
1236 if (goi->argc != 0) {
1237 Jim_WrongNumArgs(goi->interp, goi->argc, goi->argv, "-event ?event-name?");
1238 return JIM_ERR;
1239 }
1240 }
1241
1242 {
1243 jtag_tap_event_action_t *jteap;
1244
1245 jteap = tap->event_action;
1246 /* replace existing? */
1247 while (jteap) {
1248 if (jteap->event == (enum jtag_tap_event)n->value) {
1249 break;
1250 }
1251 jteap = jteap->next;
1252 }
1253
1254 if (goi->isconfigure) {
1255 if (jteap == NULL) {
1256 /* create new */
1257 jteap = calloc(1, sizeof (*jteap));
1258 }
1259 jteap->event = n->value;
1260 Jim_GetOpt_Obj( goi, &o);
1261 if (jteap->body) {
1262 Jim_DecrRefCount(interp, jteap->body);
1263 }
1264 jteap->body = Jim_DuplicateObj(goi->interp, o);
1265 Jim_IncrRefCount(jteap->body);
1266
1267 /* add to head of event list */
1268 jteap->next = tap->event_action;
1269 tap->event_action = jteap;
1270 Jim_SetEmptyResult(goi->interp);
1271 } else {
1272 /* get */
1273 if (jteap == NULL) {
1274 Jim_SetEmptyResult(goi->interp);
1275 } else {
1276 Jim_SetResult(goi->interp, Jim_DuplicateObj(goi->interp, jteap->body));
1277 }
1278 }
1279 }
1280 /* loop for more */
1281 break;
1282 }
1283 } /* while (goi->argc) */
1284
1285 return JIM_OK;
1286 }
1287
1288
1289 static void jtag_tap_init(jtag_tap_t *tap)
1290 {
1291 assert(0 != tap->ir_length);
1292
1293 tap->expected = malloc(tap->ir_length);
1294 tap->expected_mask = malloc(tap->ir_length);
1295 tap->cur_instr = malloc(tap->ir_length);
1296
1297 buf_set_u32(tap->expected, 0, tap->ir_length, tap->ir_capture_value);
1298 buf_set_u32(tap->expected_mask, 0, tap->ir_length, tap->ir_capture_mask);
1299 buf_set_ones(tap->cur_instr, tap->ir_length);
1300
1301 // place TAP in bypass mode
1302 tap->bypass = 1;
1303 // register the reset callback for the TAP
1304 jtag_register_event_callback(&jtag_reset_callback, tap);
1305
1306 LOG_DEBUG("Created Tap: %s @ abs position %d, "
1307 "irlen %d, capture: 0x%x mask: 0x%x", tap->dotted_name,
1308 tap->abs_chain_position, tap->ir_length,
1309 tap->ir_capture_value, tap->ir_capture_mask);
1310 jtag_tap_add(tap);
1311 }
1312
1313 static void jtag_tap_free(jtag_tap_t *tap)
1314 {
1315 /// @todo is anything missing? no memory leaks please
1316 free((void *)tap->expected_ids);
1317 free((void *)tap->chip);
1318 free((void *)tap->tapname);
1319 free((void *)tap->dotted_name);
1320 free(tap);
1321 }
1322
1323 static int jim_newtap_cmd( Jim_GetOptInfo *goi )
1324 {
1325 jtag_tap_t *pTap;
1326 jim_wide w;
1327 int x;
1328 int e;
1329 int reqbits;
1330 Jim_Nvp *n;
1331 char *cp;
1332 const Jim_Nvp opts[] = {
1333 #define NTAP_OPT_IRLEN 0
1334 { .name = "-irlen" , .value = NTAP_OPT_IRLEN },
1335 #define NTAP_OPT_IRMASK 1
1336 { .name = "-irmask" , .value = NTAP_OPT_IRMASK },
1337 #define NTAP_OPT_IRCAPTURE 2
1338 { .name = "-ircapture" , .value = NTAP_OPT_IRCAPTURE },
1339 #define NTAP_OPT_ENABLED 3
1340 { .name = "-enable" , .value = NTAP_OPT_ENABLED },
1341 #define NTAP_OPT_DISABLED 4
1342 { .name = "-disable" , .value = NTAP_OPT_DISABLED },
1343 #define NTAP_OPT_EXPECTED_ID 5
1344 { .name = "-expected-id" , .value = NTAP_OPT_EXPECTED_ID },
1345 { .name = NULL , .value = -1 },
1346 };
1347
1348 pTap = malloc( sizeof(jtag_tap_t) );
1349 memset( pTap, 0, sizeof(*pTap) );
1350 if( !pTap ){
1351 Jim_SetResult_sprintf( goi->interp, "no memory");
1352 return JIM_ERR;
1353 }
1354 /*
1355 * we expect CHIP + TAP + OPTIONS
1356 * */
1357 if( goi->argc < 3 ){
1358 Jim_SetResult_sprintf(goi->interp, "Missing CHIP TAP OPTIONS ....");
1359 return JIM_ERR;
1360 }
1361 Jim_GetOpt_String( goi, &cp, NULL );
1362 pTap->chip = strdup(cp);
1363
1364 Jim_GetOpt_String( goi, &cp, NULL );
1365 pTap->tapname = strdup(cp);
1366
1367 /* name + dot + name + null */
1368 x = strlen(pTap->chip) + 1 + strlen(pTap->tapname) + 1;
1369 cp = malloc( x );
1370 sprintf( cp, "%s.%s", pTap->chip, pTap->tapname );
1371 pTap->dotted_name = cp;
1372
1373 LOG_DEBUG("Creating New Tap, Chip: %s, Tap: %s, Dotted: %s, %d params",
1374 pTap->chip, pTap->tapname, pTap->dotted_name, goi->argc);
1375
1376 /* default is enabled */
1377 pTap->enabled = 1;
1378
1379 /* deal with options */
1380 #define NTREQ_IRLEN 1
1381 #define NTREQ_IRCAPTURE 2
1382 #define NTREQ_IRMASK 4
1383
1384 /* clear them as we find them */
1385 reqbits = (NTREQ_IRLEN | NTREQ_IRCAPTURE | NTREQ_IRMASK);
1386
1387 while( goi->argc ){
1388 e = Jim_GetOpt_Nvp( goi, opts, &n );
1389 if( e != JIM_OK ){
1390 Jim_GetOpt_NvpUnknown( goi, opts, 0 );
1391 return e;
1392 }
1393 LOG_DEBUG("Processing option: %s", n->name );
1394 switch( n->value ){
1395 case NTAP_OPT_ENABLED:
1396 pTap->enabled = 1;
1397 break;
1398 case NTAP_OPT_DISABLED:
1399 pTap->enabled = 0;
1400 break;
1401 case NTAP_OPT_EXPECTED_ID:
1402 {
1403 u32 *new_expected_ids;
1404
1405 e = Jim_GetOpt_Wide( goi, &w );
1406 if( e != JIM_OK) {
1407 Jim_SetResult_sprintf(goi->interp, "option: %s bad parameter", n->name);
1408 return e;
1409 }
1410
1411 new_expected_ids = malloc(sizeof(u32) * (pTap->expected_ids_cnt + 1));
1412 if (new_expected_ids == NULL) {
1413 Jim_SetResult_sprintf( goi->interp, "no memory");
1414 return JIM_ERR;
1415 }
1416
1417 memcpy(new_expected_ids, pTap->expected_ids, sizeof(u32) * pTap->expected_ids_cnt);
1418
1419 new_expected_ids[pTap->expected_ids_cnt] = w;
1420
1421 free(pTap->expected_ids);
1422 pTap->expected_ids = new_expected_ids;
1423 pTap->expected_ids_cnt++;
1424 break;
1425 }
1426 case NTAP_OPT_IRLEN:
1427 case NTAP_OPT_IRMASK:
1428 case NTAP_OPT_IRCAPTURE:
1429 e = Jim_GetOpt_Wide( goi, &w );
1430 if( e != JIM_OK ){
1431 Jim_SetResult_sprintf( goi->interp, "option: %s bad parameter", n->name );
1432 return e;
1433 }
1434 if( (w < 0) || (w > 0xffff) ){
1435 /* wacky value */
1436 Jim_SetResult_sprintf( goi->interp, "option: %s - wacky value: %d (0x%x)",
1437 n->name, (int)(w), (int)(w));
1438 return JIM_ERR;
1439 }
1440 switch(n->value){
1441 case NTAP_OPT_IRLEN:
1442 pTap->ir_length = w;
1443 reqbits &= (~(NTREQ_IRLEN));
1444 break;
1445 case NTAP_OPT_IRMASK:
1446 pTap->ir_capture_mask = w;
1447 reqbits &= (~(NTREQ_IRMASK));
1448 break;
1449 case NTAP_OPT_IRCAPTURE:
1450 pTap->ir_capture_value = w;
1451 reqbits &= (~(NTREQ_IRCAPTURE));
1452 break;
1453 }
1454 } /* switch(n->value) */
1455 } /* while( goi->argc ) */
1456
1457 /* Did all the required option bits get cleared? */
1458 if (0 == reqbits)
1459 {
1460 jtag_tap_init(pTap);
1461 return ERROR_OK;
1462 }
1463
1464 Jim_SetResult_sprintf(goi->interp,
1465 "newtap: %s missing required parameters",
1466 pTap->dotted_name);
1467 jtag_tap_free(pTap);
1468 return JIM_ERR;
1469 }
1470
1471 static int jim_jtag_command( Jim_Interp *interp, int argc, Jim_Obj *const *argv )
1472 {
1473 Jim_GetOptInfo goi;
1474 int e;
1475 Jim_Nvp *n;
1476 Jim_Obj *o;
1477 struct command_context_s *context;
1478
1479 enum {
1480 JTAG_CMD_INTERFACE,
1481 JTAG_CMD_INIT_RESET,
1482 JTAG_CMD_NEWTAP,
1483 JTAG_CMD_TAPENABLE,
1484 JTAG_CMD_TAPDISABLE,
1485 JTAG_CMD_TAPISENABLED,
1486 JTAG_CMD_CONFIGURE,
1487 JTAG_CMD_CGET
1488 };
1489
1490 const Jim_Nvp jtag_cmds[] = {
1491 { .name = "interface" , .value = JTAG_CMD_INTERFACE },
1492 { .name = "arp_init-reset", .value = JTAG_CMD_INIT_RESET },
1493 { .name = "newtap" , .value = JTAG_CMD_NEWTAP },
1494 { .name = "tapisenabled" , .value = JTAG_CMD_TAPISENABLED },
1495 { .name = "tapenable" , .value = JTAG_CMD_TAPENABLE },
1496 { .name = "tapdisable" , .value = JTAG_CMD_TAPDISABLE },
1497 { .name = "configure" , .value = JTAG_CMD_CONFIGURE },
1498 { .name = "cget" , .value = JTAG_CMD_CGET },
1499
1500 { .name = NULL, .value = -1 },
1501 };
1502
1503 context = Jim_GetAssocData(interp, "context");
1504 /* go past the command */
1505 Jim_GetOpt_Setup( &goi, interp, argc-1, argv+1 );
1506
1507 e = Jim_GetOpt_Nvp( &goi, jtag_cmds, &n );
1508 if( e != JIM_OK ){
1509 Jim_GetOpt_NvpUnknown( &goi, jtag_cmds, 0 );
1510 return e;
1511 }
1512 Jim_SetEmptyResult( goi.interp );
1513 switch( n->value ){
1514 case JTAG_CMD_INTERFACE:
1515 /* return the name of the interface */
1516 /* TCL code might need to know the exact type... */
1517 /* FUTURE: we allow this as a means to "set" the interface. */
1518 if( goi.argc != 0 ){
1519 Jim_WrongNumArgs( goi.interp, 1, goi.argv-1, "(no params)");
1520 return JIM_ERR;
1521 }
1522 Jim_SetResultString( goi.interp, jtag_interface->name, -1 );
1523 return JIM_OK;
1524 case JTAG_CMD_INIT_RESET:
1525 if( goi.argc != 0 ){
1526 Jim_WrongNumArgs( goi.interp, 1, goi.argv-1, "(no params)");
1527 return JIM_ERR;
1528 }
1529 e = jtag_init_reset(context);
1530 if( e != ERROR_OK ){
1531 Jim_SetResult_sprintf( goi.interp, "error: %d", e);
1532 return JIM_ERR;
1533 }
1534 return JIM_OK;
1535 case JTAG_CMD_NEWTAP:
1536 return jim_newtap_cmd( &goi );
1537 break;
1538 case JTAG_CMD_TAPISENABLED:
1539 case JTAG_CMD_TAPENABLE:
1540 case JTAG_CMD_TAPDISABLE:
1541 if( goi.argc != 1 ){
1542 Jim_SetResultString( goi.interp, "Too many parameters",-1 );
1543 return JIM_ERR;
1544 }
1545
1546 {
1547 jtag_tap_t *t;
1548 t = jtag_tap_by_jim_obj( goi.interp, goi.argv[0] );
1549 if( t == NULL ){
1550 return JIM_ERR;
1551 }
1552 switch( n->value ){
1553 case JTAG_CMD_TAPISENABLED:
1554 e = t->enabled;
1555 break;
1556 case JTAG_CMD_TAPENABLE:
1557 jtag_tap_handle_event( t, JTAG_TAP_EVENT_ENABLE);
1558 e = 1;
1559 t->enabled = e;
1560 break;
1561 case JTAG_CMD_TAPDISABLE:
1562 jtag_tap_handle_event( t, JTAG_TAP_EVENT_DISABLE);
1563 e = 0;
1564 t->enabled = e;
1565 break;
1566 }
1567 Jim_SetResult( goi.interp, Jim_NewIntObj( goi.interp, e ) );
1568 return JIM_OK;
1569 }
1570 break;
1571
1572 case JTAG_CMD_CGET:
1573 if( goi.argc < 2 ){
1574 Jim_WrongNumArgs( goi.interp, 0, NULL, "?tap-name? -option ...");
1575 return JIM_ERR;
1576 }
1577
1578 {
1579 jtag_tap_t *t;
1580
1581 Jim_GetOpt_Obj(&goi, &o);
1582 t = jtag_tap_by_jim_obj( goi.interp, o );
1583 if( t == NULL ){
1584 return JIM_ERR;
1585 }
1586
1587 goi.isconfigure = 0;
1588 return jtag_tap_configure_cmd( &goi, t);
1589 }
1590 break;
1591
1592 case JTAG_CMD_CONFIGURE:
1593 if( goi.argc < 3 ){
1594 Jim_WrongNumArgs( goi.interp, 0, NULL, "?tap-name? -option ?VALUE? ...");
1595 return JIM_ERR;
1596 }
1597
1598 {
1599 jtag_tap_t *t;
1600
1601 Jim_GetOpt_Obj(&goi, &o);
1602 t = jtag_tap_by_jim_obj( goi.interp, o );
1603 if( t == NULL ){
1604 return JIM_ERR;
1605 }
1606
1607 goi.isconfigure = 1;
1608 return jtag_tap_configure_cmd( &goi, t);
1609 }
1610 }
1611
1612 return JIM_ERR;
1613 }
1614
1615 int jtag_register_commands(struct command_context_s *cmd_ctx)
1616 {
1617 register_jim( cmd_ctx, "jtag", jim_jtag_command, "perform jtag tap actions");
1618
1619 register_command(cmd_ctx, NULL, "interface", handle_interface_command,
1620 COMMAND_CONFIG, "try to configure interface");
1621 register_command(cmd_ctx, NULL, "jtag_speed", handle_jtag_speed_command,
1622 COMMAND_ANY, "(DEPRECATED) set jtag speed (if supported)");
1623 register_command(cmd_ctx, NULL, "jtag_khz", handle_jtag_khz_command,
1624 COMMAND_ANY, "set maximum jtag speed (if supported); "
1625 "parameter is maximum khz, or 0 for adaptive clocking (RTCK).");
1626 register_command(cmd_ctx, NULL, "jtag_device", handle_jtag_device_command,
1627 COMMAND_CONFIG, "(DEPRECATED) jtag_device <ir_length> <ir_expected> <ir_mask>");
1628 register_command(cmd_ctx, NULL, "reset_config", handle_reset_config_command,
1629 COMMAND_ANY,
1630 "[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]");
1631 register_command(cmd_ctx, NULL, "jtag_nsrst_delay", handle_jtag_nsrst_delay_command,
1632 COMMAND_ANY, "jtag_nsrst_delay <ms> - delay after deasserting srst in ms");
1633 register_command(cmd_ctx, NULL, "jtag_ntrst_delay", handle_jtag_ntrst_delay_command,
1634 COMMAND_ANY, "jtag_ntrst_delay <ms> - delay after deasserting trst in ms");
1635
1636 register_command(cmd_ctx, NULL, "scan_chain", handle_scan_chain_command,
1637 COMMAND_EXEC, "print current scan chain configuration");
1638
1639 register_command(cmd_ctx, NULL, "jtag_reset", handle_jtag_reset_command,
1640 COMMAND_EXEC, "toggle reset lines <trst> <srst>");
1641 register_command(cmd_ctx, NULL, "runtest", handle_runtest_command,
1642 COMMAND_EXEC, "move to Run-Test/Idle, and execute <num_cycles>");
1643 register_command(cmd_ctx, NULL, "irscan", handle_irscan_command,
1644 COMMAND_EXEC, "execute IR scan <device> <instr> [dev2] [instr2] ...");
1645 register_jim(cmd_ctx, "drscan", Jim_Command_drscan, "execute DR scan <device> <num_bits> <value> <num_bits1> <value2> ...");
1646 register_jim(cmd_ctx, "flush_count", Jim_Command_flush_count, "returns number of times the JTAG queue has been flushed");
1647
1648 register_command(cmd_ctx, NULL, "verify_ircapture", handle_verify_ircapture_command,
1649 COMMAND_ANY, "verify value captured during Capture-IR <enable|disable>");
1650 register_command(cmd_ctx, NULL, "verify_jtag", handle_verify_jtag_command,
1651 COMMAND_ANY, "verify value capture <enable|disable>");
1652 register_command(cmd_ctx, NULL, "tms_sequence", handle_tms_sequence_command,
1653 COMMAND_ANY, "choose short(default) or long tms_sequence <short|long>");
1654 return ERROR_OK;
1655 }
1656
1657 int jtag_interface_init(struct command_context_s *cmd_ctx)
1658 {
1659 if (jtag)
1660 return ERROR_OK;
1661
1662 if (!jtag_interface)
1663 {
1664 /* nothing was previously specified by "interface" command */
1665 LOG_ERROR("JTAG interface has to be specified, see \"interface\" command");
1666 return ERROR_JTAG_INVALID_INTERFACE;
1667 }
1668 if(hasKHz)
1669 {
1670 jtag_interface->khz(jtag_get_speed_khz(), &jtag_speed);
1671 hasKHz = false;
1672 }
1673
1674 if (jtag_interface->init() != ERROR_OK)
1675 return ERROR_JTAG_INIT_FAILED;
1676
1677 jtag = jtag_interface;
1678 return ERROR_OK;
1679 }
1680
1681 static int jtag_init_inner(struct command_context_s *cmd_ctx)
1682 {
1683 jtag_tap_t *tap;
1684 int retval;
1685
1686 LOG_DEBUG("Init JTAG chain");
1687
1688 tap = jtag_tap_next_enabled(NULL);
1689 if( tap == NULL ){
1690 LOG_ERROR("There are no enabled taps?");
1691 return ERROR_JTAG_INIT_FAILED;
1692 }
1693
1694 jtag_add_tlr();
1695 if ((retval=jtag_execute_queue())!=ERROR_OK)
1696 return retval;
1697
1698 /* examine chain first, as this could discover the real chain layout */
1699 if (jtag_examine_chain() != ERROR_OK)
1700 {
1701 LOG_ERROR("trying to validate configured JTAG chain anyway...");
1702 }
1703
1704 if (jtag_validate_chain() != ERROR_OK)
1705 {
1706 LOG_WARNING("Could not validate JTAG chain, continuing anyway...");
1707 }
1708
1709 return ERROR_OK;
1710 }
1711
1712 int jtag_interface_quit(void)
1713 {
1714 if (!jtag || !jtag->quit)
1715 return ERROR_OK;
1716
1717 // close the JTAG interface
1718 int result = jtag->quit();
1719 if (ERROR_OK != result)
1720 LOG_ERROR("failed: %d", result);
1721
1722 return ERROR_OK;
1723 }
1724
1725
1726 int jtag_init_reset(struct command_context_s *cmd_ctx)
1727 {
1728 int retval;
1729
1730 if ((retval=jtag_interface_init(cmd_ctx)) != ERROR_OK)
1731 return retval;
1732
1733 LOG_DEBUG("Trying to bring the JTAG controller to life by asserting TRST / RESET");
1734
1735 /* Reset can happen after a power cycle.
1736 *
1737 * Ideally we would only assert TRST or run RESET before the target reset.
1738 *
1739 * However w/srst_pulls_trst, trst is asserted together with the target
1740 * reset whether we want it or not.
1741 *
1742 * NB! Some targets have JTAG circuitry disabled until a
1743 * trst & srst has been asserted.
1744 *
1745 * NB! here we assume nsrst/ntrst delay are sufficient!
1746 *
1747 * NB! order matters!!!! srst *can* disconnect JTAG circuitry
1748 *
1749 */
1750 jtag_add_reset(1, 0); /* RESET or TRST */
1751 if (jtag_reset_config & RESET_HAS_SRST)
1752 {
1753 jtag_add_reset(1, 1);
1754 if ((jtag_reset_config & RESET_SRST_PULLS_TRST)==0)
1755 jtag_add_reset(0, 1);
1756 }
1757 jtag_add_reset(0, 0);
1758 if ((retval = jtag_execute_queue()) != ERROR_OK)
1759 return retval;
1760
1761 /* Check that we can communication on the JTAG chain + eventually we want to
1762 * be able to perform enumeration only after OpenOCD has started
1763 * telnet and GDB server
1764 *
1765 * That would allow users to more easily perform any magic they need to before
1766 * reset happens.
1767 */
1768 return jtag_init_inner(cmd_ctx);
1769 }
1770
1771 int jtag_init(struct command_context_s *cmd_ctx)
1772 {
1773 int retval;
1774 if ((retval=jtag_interface_init(cmd_ctx)) != ERROR_OK)
1775 return retval;
1776 if (jtag_init_inner(cmd_ctx)==ERROR_OK)
1777 {
1778 return ERROR_OK;
1779 }
1780 return jtag_init_reset(cmd_ctx);
1781 }
1782
1783 void jtag_set_speed_khz(unsigned khz)
1784 {
1785 speed_khz = khz;
1786 }
1787 unsigned jtag_get_speed_khz(void)
1788 {
1789 return speed_khz;
1790 }
1791
1792 static int default_khz(int khz, int *jtag_speed)
1793 {
1794 LOG_ERROR("Translation from khz to jtag_speed not implemented");
1795 return ERROR_FAIL;
1796 }
1797
1798 static int default_speed_div(int speed, int *khz)
1799 {
1800 LOG_ERROR("Translation from jtag_speed to khz not implemented");
1801 return ERROR_FAIL;
1802 }
1803
1804 static int default_power_dropout(int *dropout)
1805 {
1806 *dropout=0; /* by default we can't detect power dropout */
1807 return ERROR_OK;
1808 }
1809
1810 static int default_srst_asserted(int *srst_asserted)
1811 {
1812 *srst_asserted=0; /* by default we can't detect srst asserted */
1813 return ERROR_OK;
1814 }
1815
1816 static int handle_interface_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1817 {
1818 int i;
1819 int retval;
1820
1821 /* check whether the interface is already configured */
1822 if (jtag_interface)
1823 {
1824 LOG_WARNING("Interface already configured, ignoring");
1825 return ERROR_OK;
1826 }
1827
1828 /* interface name is a mandatory argument */
1829 if (argc < 1 || args[0][0] == '\0')
1830 {
1831 return ERROR_COMMAND_SYNTAX_ERROR;
1832 }
1833
1834 for (i=0; jtag_interfaces[i]; i++)
1835 {
1836 if (strcmp(args[0], jtag_interfaces[i]->name) == 0)
1837 {
1838 if ((retval = jtag_interfaces[i]->register_commands(cmd_ctx)) != ERROR_OK)
1839 {
1840 return retval;
1841 }
1842
1843 jtag_interface = jtag_interfaces[i];
1844
1845 if (jtag_interface->khz == NULL)
1846 {
1847 jtag_interface->khz = default_khz;
1848 }
1849 if (jtag_interface->speed_div == NULL)
1850 {
1851 jtag_interface->speed_div = default_speed_div;
1852 }
1853 if (jtag_interface->power_dropout == NULL)
1854 {
1855 jtag_interface->power_dropout = default_power_dropout;
1856 }
1857 if (jtag_interface->srst_asserted == NULL)
1858 {
1859 jtag_interface->srst_asserted = default_srst_asserted;
1860 }
1861
1862 return ERROR_OK;
1863 }
1864 }
1865
1866 /* no valid interface was found (i.e. the configuration option,
1867 * didn't match one of the compiled-in interfaces
1868 */
1869 LOG_ERROR("No valid jtag interface found (%s)", args[0]);
1870 LOG_ERROR("compiled-in jtag interfaces:");
1871 for (i = 0; jtag_interfaces[i]; i++)
1872 {
1873 LOG_ERROR("%i: %s", i, jtag_interfaces[i]->name);
1874 }
1875
1876 return ERROR_JTAG_INVALID_INTERFACE;
1877 }
1878
1879 static int handle_jtag_device_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1880 {
1881 int e;
1882 char buf[1024];
1883 Jim_Obj *newargs[ 10 ];
1884 /*
1885 * CONVERT SYNTAX
1886 * argv[-1] = command
1887 * argv[ 0] = ir length
1888 * argv[ 1] = ir capture
1889 * argv[ 2] = ir mask
1890 * argv[ 3] = not actually used by anything but in the docs
1891 */
1892
1893 if( argc < 4 ){
1894 command_print( cmd_ctx, "OLD DEPRECATED SYNTAX: Please use the NEW syntax");
1895 return ERROR_OK;
1896 }
1897 command_print( cmd_ctx, "OLD SYNTAX: DEPRECATED - translating to new syntax");
1898 command_print( cmd_ctx, "jtag newtap CHIP TAP -irlen %s -ircapture %s -irvalue %s",
1899 args[0],
1900 args[1],
1901 args[2] );
1902 command_print( cmd_ctx, "Example: STM32 has 2 taps, the cortexM3(len4) + boundaryscan(len5)");
1903 command_print( cmd_ctx, "jtag newtap stm32 cortexm3 ....., thus creating the tap: \"stm32.cortexm3\"");
1904 command_print( cmd_ctx, "jtag newtap stm32 boundary ....., and the tap: \"stm32.boundary\"");
1905 command_print( cmd_ctx, "And then refer to the taps by the dotted name.");
1906
1907 newargs[0] = Jim_NewStringObj( interp, "jtag", -1 );
1908 newargs[1] = Jim_NewStringObj( interp, "newtap", -1 );
1909 sprintf( buf, "chip%d", jtag_tap_count() );
1910 newargs[2] = Jim_NewStringObj( interp, buf, -1 );
1911 sprintf( buf, "tap%d", jtag_tap_count() );
1912 newargs[3] = Jim_NewStringObj( interp, buf, -1 );
1913 newargs[4] = Jim_NewStringObj( interp, "-irlen", -1 );
1914 newargs[5] = Jim_NewStringObj( interp, args[0], -1 );
1915 newargs[6] = Jim_NewStringObj( interp, "-ircapture", -1 );
1916 newargs[7] = Jim_NewStringObj( interp, args[1], -1 );
1917 newargs[8] = Jim_NewStringObj( interp, "-irmask", -1 );
1918 newargs[9] = Jim_NewStringObj( interp, args[2], -1 );
1919
1920 command_print( cmd_ctx, "NEW COMMAND:");
1921 sprintf( buf, "%s %s %s %s %s %s %s %s %s %s",
1922 Jim_GetString( newargs[0], NULL ),
1923 Jim_GetString( newargs[1], NULL ),
1924 Jim_GetString( newargs[2], NULL ),
1925 Jim_GetString( newargs[3], NULL ),
1926 Jim_GetString( newargs[4], NULL ),
1927 Jim_GetString( newargs[5], NULL ),
1928 Jim_GetString( newargs[6], NULL ),
1929 Jim_GetString( newargs[7], NULL ),
1930 Jim_GetString( newargs[8], NULL ),
1931 Jim_GetString( newargs[9], NULL ) );
1932
1933 e = jim_jtag_command( interp, 10, newargs );
1934 if( e != JIM_OK ){
1935 command_print( cmd_ctx, "%s", Jim_GetString( Jim_GetResult(interp), NULL ) );
1936 }
1937 return e;
1938 }
1939
1940 static int handle_scan_chain_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1941 {
1942 jtag_tap_t *tap;
1943
1944 tap = jtag_all_taps();
1945 command_print(cmd_ctx, " TapName | Enabled | IdCode Expected IrLen IrCap IrMask Instr ");
1946 command_print(cmd_ctx, "---|--------------------|---------|------------|------------|------|------|------|---------");
1947
1948 while( tap ){
1949 u32 expected, expected_mask, cur_instr, ii;
1950 expected = buf_get_u32(tap->expected, 0, tap->ir_length);
1951 expected_mask = buf_get_u32(tap->expected_mask, 0, tap->ir_length);
1952 cur_instr = buf_get_u32(tap->cur_instr, 0, tap->ir_length);
1953
1954 command_print(cmd_ctx,
1955 "%2d | %-18s | %c | 0x%08x | 0x%08x | 0x%02x | 0x%02x | 0x%02x | 0x%02x",
1956 tap->abs_chain_position,
1957 tap->dotted_name,
1958 tap->enabled ? 'Y' : 'n',
1959 tap->idcode,
1960 (tap->expected_ids_cnt > 0 ? tap->expected_ids[0] : 0),
1961 tap->ir_length,
1962 expected,
1963 expected_mask,
1964 cur_instr);
1965
1966 for (ii = 1; ii < tap->expected_ids_cnt; ii++) {
1967 command_print(cmd_ctx, " | | | | 0x%08x | | | | ",
1968 tap->expected_ids[ii]);
1969 }
1970
1971 tap = tap->next_tap;
1972 }
1973
1974 return ERROR_OK;
1975 }
1976
1977 static int handle_reset_config_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1978 {
1979 int new_cfg = 0;
1980 int mask = 0;
1981
1982 if (argc < 1)
1983 return ERROR_COMMAND_SYNTAX_ERROR;
1984
1985 /* Original versions cared about the order of these tokens:
1986 * reset_config signals [combination [trst_type [srst_type]]]
1987 * They also clobbered the previous configuration even on error.
1988 *
1989 * Here we don't care about the order, and only change values
1990 * which have been explicitly specified.
1991 */
1992 for (; argc; argc--, args++) {
1993 int tmp = 0;
1994 int m;
1995
1996 /* signals */
1997 m = RESET_HAS_TRST | RESET_HAS_SRST;
1998 if (strcmp(*args, "none") == 0)
1999 tmp = RESET_NONE;
2000 else if (strcmp(*args, "trst_only") == 0)
2001 tmp = RESET_HAS_TRST;
2002 else if (strcmp(*args, "srst_only") == 0)
2003 tmp = RESET_HAS_SRST;
2004 else if (strcmp(*args, "trst_and_srst") == 0)
2005 tmp = RESET_HAS_TRST | RESET_HAS_SRST;
2006 else
2007 m = 0;
2008 if (mask & m) {
2009 LOG_ERROR("extra reset_config %s spec (%s)",
2010 "signal", *args);
2011 return ERROR_INVALID_ARGUMENTS;
2012 }
2013 if (m)
2014 goto next;
2015
2016 /* combination (options for broken wiring) */
2017 m = RESET_SRST_PULLS_TRST | RESET_TRST_PULLS_SRST;
2018 if (strcmp(*args, "separate") == 0)
2019 /* separate reset lines - default */;
2020 else if (strcmp(*args, "srst_pulls_trst") == 0)
2021 tmp |= RESET_SRST_PULLS_TRST;
2022 else if (strcmp(*args, "trst_pulls_srst") == 0)
2023 tmp |= RESET_TRST_PULLS_SRST;
2024 else if (strcmp(*args, "combined") == 0)
2025 tmp |= RESET_SRST_PULLS_TRST | RESET_TRST_PULLS_SRST;
2026 else
2027 m = 0;
2028 if (mask & m) {
2029 LOG_ERROR("extra reset_config %s spec (%s)",
2030 "combination", *args);
2031 return ERROR_INVALID_ARGUMENTS;
2032 }
2033 if (m)
2034 goto next;
2035
2036 /* trst_type (NOP without HAS_TRST) */
2037 m = RESET_TRST_OPEN_DRAIN;
2038 if (strcmp(*args, "trst_open_drain") == 0)
2039 tmp |= RESET_TRST_OPEN_DRAIN;
2040 else if (strcmp(*args, "trst_push_pull") == 0)
2041 /* push/pull from adapter - default */;
2042 else
2043 m = 0;
2044 if (mask & m) {
2045 LOG_ERROR("extra reset_config %s spec (%s)",
2046 "trst_type", *args);
2047 return ERROR_INVALID_ARGUMENTS;
2048 }
2049 if (m)
2050 goto next;
2051
2052 /* srst_type (NOP without HAS_SRST) */
2053 m |= RESET_SRST_PUSH_PULL;
2054 if (strcmp(*args, "srst_push_pull") == 0)
2055 tmp |= RESET_SRST_PUSH_PULL;
2056 else if (strcmp(*args, "srst_open_drain") == 0)
2057 /* open drain from adapter - default */;
2058 else
2059 m = 0;
2060 if (mask & m) {
2061 LOG_ERROR("extra reset_config %s spec (%s)",
2062 "srst_type", *args);
2063 return ERROR_INVALID_ARGUMENTS;
2064 }
2065 if (m)
2066 goto next;
2067
2068 /* caller provided nonsense; fail */
2069 LOG_ERROR("unknown reset_config flag (%s)", *args);
2070 return ERROR_INVALID_ARGUMENTS;
2071
2072 next:
2073 /* Remember the bits which were specified (mask)
2074 * and their new values (new_cfg).
2075 */
2076 mask |= m;
2077 new_cfg |= tmp;
2078 }
2079
2080 /* clear previous values of those bits, save new values */
2081 jtag_reset_config &= ~mask;
2082 jtag_reset_config |= new_cfg;
2083
2084 return ERROR_OK;
2085 }
2086
2087 static int handle_jtag_nsrst_delay_command(struct command_context_s *cmd_ctx,
2088 char *cmd, char **args, int argc)
2089 {
2090 if (argc > 1)
2091 return ERROR_COMMAND_SYNTAX_ERROR;
2092 if (argc == 1)
2093 jtag_set_nsrst_delay(strtoul(args[0], NULL, 0));
2094 command_print(cmd_ctx, "jtag_nsrst_delay: %u", jtag_get_nsrst_delay());
2095 return ERROR_OK;
2096 }
2097
2098 static int handle_jtag_ntrst_delay_command(struct command_context_s *cmd_ctx,
2099 char *cmd, char **args, int argc)
2100 {
2101 if (argc > 1)
2102 return ERROR_COMMAND_SYNTAX_ERROR;
2103 if (argc == 1)
2104 jtag_set_ntrst_delay(strtoul(args[0], NULL, 0));
2105 command_print(cmd_ctx, "jtag_ntrst_delay: %u", jtag_get_ntrst_delay());
2106 return ERROR_OK;
2107 }
2108
2109 static int handle_jtag_speed_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2110 {
2111 int retval = ERROR_OK;
2112
2113 if (argc > 1)
2114 return ERROR_COMMAND_SYNTAX_ERROR;
2115 if (argc == 1)
2116 {
2117 LOG_DEBUG("handle jtag speed");
2118
2119 int cur_speed = 0;
2120 cur_speed = jtag_speed = strtoul(args[0], NULL, 0);
2121
2122 /* this command can be called during CONFIG,
2123 * in which case jtag isn't initialized */
2124 if (jtag)
2125 retval = jtag->speed(cur_speed);
2126 }
2127 command_print(cmd_ctx, "jtag_speed: %d", jtag_speed);
2128
2129 return retval;
2130 }
2131
2132 static int handle_jtag_khz_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2133 {
2134 if (argc > 1)
2135 return ERROR_COMMAND_SYNTAX_ERROR;
2136
2137 int retval = ERROR_OK;
2138 int cur_speed = 0;
2139 if (argc == 1)
2140 {
2141 LOG_DEBUG("handle jtag khz");
2142
2143 jtag_set_speed_khz(strtoul(args[0], NULL, 0));
2144 if (jtag != NULL)
2145 {
2146 LOG_DEBUG("have interface set up");
2147 int speed_div1;
2148 retval = jtag->khz(jtag_get_speed_khz(), &speed_div1);
2149 if (ERROR_OK != retval)
2150 {
2151 jtag_set_speed_khz(0);
2152 return retval;
2153 }
2154 cur_speed = jtag_speed = speed_div1;
2155
2156 retval = jtag->speed(cur_speed);
2157 }
2158 else
2159 hasKHz = true;
2160 }
2161
2162 cur_speed = jtag_get_speed_khz();
2163 if (jtag != NULL)
2164 {
2165 retval = jtag->speed_div(jtag_speed, &cur_speed);
2166 if (ERROR_OK != retval)
2167 return retval;
2168 }
2169
2170 if (cur_speed)
2171 command_print(cmd_ctx, "%d kHz", cur_speed);
2172 else
2173 command_print(cmd_ctx, "RCLK - adaptive");
2174 return retval;
2175
2176 }
2177
2178 static int handle_jtag_reset_command(struct command_context_s *cmd_ctx,
2179 char *cmd, char **args, int argc)
2180 {
2181 if (argc != 2)
2182 return ERROR_COMMAND_SYNTAX_ERROR;
2183
2184 int trst = -1;
2185 if (args[0][0] == '1')
2186 trst = 1;
2187 else if (args[0][0] == '0')
2188 trst = 0;
2189 else
2190 return ERROR_COMMAND_SYNTAX_ERROR;
2191
2192 int srst = -1;
2193 if (args[1][0] == '1')
2194 srst = 1;
2195 else if (args[1][0] == '0')
2196 srst = 0;
2197 else
2198 return ERROR_COMMAND_SYNTAX_ERROR;
2199
2200 if (jtag_interface_init(cmd_ctx) != ERROR_OK)
2201 return ERROR_JTAG_INIT_FAILED;
2202
2203 jtag_add_reset(trst, srst);
2204 jtag_execute_queue();
2205
2206 return ERROR_OK;
2207 }
2208
2209 static int handle_runtest_command(struct command_context_s *cmd_ctx,
2210 char *cmd, char **args, int argc)
2211 {
2212 if (argc != 1)
2213 return ERROR_COMMAND_SYNTAX_ERROR;
2214
2215 jtag_add_runtest(strtol(args[0], NULL, 0), jtag_get_end_state());
2216 jtag_execute_queue();
2217
2218 return ERROR_OK;
2219 }
2220
2221 /*
2222 * For "irscan" or "drscan" commands, the "end" (really, "next") state
2223 * should be stable ... and *NOT* a shift state, otherwise free-running
2224 * jtag clocks could change the values latched by the update state.
2225 */
2226 static bool scan_is_safe(tap_state_t state)
2227 {
2228 switch (state)
2229 {
2230 case TAP_RESET:
2231 case TAP_IDLE:
2232 case TAP_DRPAUSE:
2233 case TAP_IRPAUSE:
2234 return true;
2235 default:
2236 return false;
2237 }
2238 }
2239
2240
2241 static int handle_irscan_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2242 {
2243 int i;
2244 scan_field_t *fields;
2245 jtag_tap_t *tap;
2246 tap_state_t endstate;
2247
2248 if ((argc < 2) || (argc % 2))
2249 {
2250 return ERROR_COMMAND_SYNTAX_ERROR;
2251 }
2252
2253 /* optional "-endstate" "statename" at the end of the arguments,
2254 * so that e.g. IRPAUSE can let us load the data register before
2255 * entering RUN/IDLE to execute the instruction we load here.
2256 */
2257 endstate = TAP_IDLE;
2258
2259 if( argc >= 4 ){
2260 /* have at least one pair of numbers. */
2261 /* is last pair the magic text? */
2262 if( 0 == strcmp( "-endstate", args[ argc - 2 ] ) ){
2263 const char *cpA;
2264 const char *cpS;
2265 cpA = args[ argc-1 ];
2266 for( endstate = 0 ; endstate < TAP_NUM_STATES ; endstate++ ){
2267 cpS = tap_state_name( endstate );
2268 if( 0 == strcmp( cpA, cpS ) ){
2269 break;
2270 }
2271 }
2272 if( endstate >= TAP_NUM_STATES ){
2273 return ERROR_COMMAND_SYNTAX_ERROR;
2274 } else {
2275 if (!scan_is_safe(endstate))
2276 LOG_WARNING("irscan with unsafe "
2277 "endstate \"%s\"", cpA);
2278 /* found - remove the last 2 args */
2279 argc -= 2;
2280 }
2281 }
2282 }
2283
2284 int num_fields = argc / 2;
2285
2286 fields = malloc(sizeof(scan_field_t) * num_fields);
2287
2288 for (i = 0; i < num_fields; i++)
2289 {
2290 tap = jtag_tap_by_string( args[i*2] );
2291 if (tap==NULL)
2292 {
2293 command_print( cmd_ctx, "Tap: %s unknown", args[i*2] );
2294 return ERROR_FAIL;
2295 }
2296 int field_size = tap->ir_length;
2297 fields[i].tap = tap;
2298 fields[i].num_bits = field_size;
2299 fields[i].out_value = malloc(CEIL(field_size, 8));
2300 buf_set_u32(fields[i].out_value, 0, field_size, strtoul(args[i*2+1], NULL, 0));
2301 fields[i].in_value = NULL;
2302 }
2303
2304 /* did we have an endstate? */
2305 jtag_add_ir_scan(num_fields, fields, endstate);
2306
2307 int retval=jtag_execute_queue();
2308
2309 for (i = 0; i < num_fields; i++)
2310 free(fields[i].out_value);
2311
2312 free (fields);
2313
2314 return retval;
2315 }
2316
2317 static int Jim_Command_drscan(Jim_Interp *interp, int argc, Jim_Obj *const *args)
2318 {
2319 int retval;
2320 scan_field_t *fields;
2321 int num_fields;
2322 int field_count = 0;
2323 int i, e;
2324 jtag_tap_t *tap;
2325 tap_state_t endstate;
2326
2327 /* args[1] = device
2328 * args[2] = num_bits
2329 * args[3] = hex string
2330 * ... repeat num bits and hex string ...
2331 *
2332 * .. optionally:
2333 * args[N-2] = "-endstate"
2334 * args[N-1] = statename
2335 */
2336 if ((argc < 4) || ((argc % 2)!=0))
2337 {
2338 Jim_WrongNumArgs(interp, 1, args, "wrong arguments");
2339 return JIM_ERR;
2340 }
2341
2342 endstate = TAP_IDLE;
2343
2344 /* validate arguments as numbers */
2345 e = JIM_OK;
2346 for (i = 2; i < argc; i+=2)
2347 {
2348 long bits;
2349 const char *cp;
2350
2351 e = Jim_GetLong(interp, args[i], &bits);
2352 /* If valid - try next arg */
2353 if( e == JIM_OK ){
2354 continue;
2355 }
2356
2357 /* Not valid.. are we at the end? */
2358 if ( ((i+2) != argc) ){
2359 /* nope, then error */
2360 return e;
2361 }
2362
2363 /* it could be: "-endstate FOO"
2364 * e.g. DRPAUSE so we can issue more instructions
2365 * before entering RUN/IDLE and executing them.
2366 */
2367
2368 /* get arg as a string. */
2369 cp = Jim_GetString( args[i], NULL );
2370 /* is it the magic? */
2371 if( 0 == strcmp( "-endstate", cp ) ){
2372 /* is the statename valid? */
2373 cp = Jim_GetString( args[i+1], NULL );
2374
2375 /* see if it is a valid state name */
2376 endstate = tap_state_by_name(cp);
2377 if( endstate < 0 ){
2378 /* update the error message */
2379 Jim_SetResult_sprintf(interp,"endstate: %s invalid", cp );
2380 } else {
2381 if (!scan_is_safe(endstate))
2382 LOG_WARNING("drscan with unsafe "
2383 "endstate \"%s\"", cp);
2384
2385 /* valid - so clear the error */
2386 e = JIM_OK;
2387 /* and remove the last 2 args */
2388 argc -= 2;
2389 }
2390 }
2391
2392 /* Still an error? */
2393 if( e != JIM_OK ){
2394 return e; /* too bad */
2395 }
2396 } /* validate args */
2397
2398 tap = jtag_tap_by_jim_obj( interp, args[1] );
2399 if( tap == NULL ){
2400 return JIM_ERR;
2401 }
2402
2403 num_fields=(argc-2)/2;
2404 fields = malloc(sizeof(scan_field_t) * num_fields);
2405 for (i = 2; i < argc; i+=2)
2406 {
2407 long bits;
2408 int len;
2409 const char *str;
2410
2411 Jim_GetLong(interp, args[i], &bits);
2412 str = Jim_GetString(args[i+1], &len);
2413
2414 fields[field_count].tap = tap;
2415 fields[field_count].num_bits = bits;
2416 fields[field_count].out_value = malloc(CEIL(bits, 8));
2417 str_to_buf(str, len, fields[field_count].out_value, bits, 0);
2418 fields[field_count].in_value = fields[field_count].out_value;
2419 field_count++;
2420 }
2421
2422 jtag_add_dr_scan(num_fields, fields, endstate);
2423
2424 retval = jtag_execute_queue();
2425 if (retval != ERROR_OK)
2426 {
2427 Jim_SetResultString(interp, "drscan: jtag execute failed",-1);
2428 return JIM_ERR;
2429 }
2430
2431 field_count=0;
2432 Jim_Obj *list = Jim_NewListObj(interp, NULL, 0);
2433 for (i = 2; i < argc; i+=2)
2434 {
2435 long bits;
2436 char *str;
2437
2438 Jim_GetLong(interp, args[i], &bits);
2439 str = buf_to_str(fields[field_count].in_value, bits, 16);
2440 free(fields[field_count].out_value);
2441
2442 Jim_ListAppendElement(interp, list, Jim_NewStringObj(interp, str, strlen(str)));
2443 free(str);
2444 field_count++;
2445 }
2446
2447 Jim_SetResult(interp, list);
2448
2449 free(fields);
2450
2451 return JIM_OK;
2452 }
2453
2454
2455 static int Jim_Command_flush_count(Jim_Interp *interp, int argc, Jim_Obj *const *args)
2456 {
2457 Jim_SetResult(interp, Jim_NewIntObj(interp, jtag_get_flush_queue_count()));
2458
2459 return JIM_OK;
2460 }
2461
2462
2463 static int handle_verify_ircapture_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2464 {
2465 if (argc == 1)
2466 {
2467 if (strcmp(args[0], "enable") == 0)
2468 {
2469 jtag_verify_capture_ir = 1;
2470 }
2471 else if (strcmp(args[0], "disable") == 0)
2472 {
2473 jtag_verify_capture_ir = 0;
2474 } else
2475 {
2476 return ERROR_COMMAND_SYNTAX_ERROR;
2477 }
2478 } else if (argc != 0)
2479 {
2480 return ERROR_COMMAND_SYNTAX_ERROR;
2481 }
2482
2483 command_print(cmd_ctx, "verify Capture-IR is %s", (jtag_verify_capture_ir) ? "enabled": "disabled");
2484
2485 return ERROR_OK;
2486 }
2487
2488 void jtag_set_verify(bool enable)
2489 {
2490 jtag_verify = enable;
2491 }
2492
2493 bool jtag_will_verify()
2494 {
2495 return jtag_verify;
2496 }
2497
2498 static int handle_verify_jtag_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2499 {
2500 if (argc > 1)
2501 return ERROR_COMMAND_SYNTAX_ERROR;
2502
2503 if (argc == 1)
2504 {
2505 if (strcmp(args[0], "enable") == 0)
2506 jtag_set_verify(true);
2507 else if (strcmp(args[0], "disable") == 0)
2508 jtag_set_verify(false);
2509 else
2510 return ERROR_COMMAND_SYNTAX_ERROR;
2511 }
2512
2513 const char *status = jtag_will_verify() ? "enabled": "disabled";
2514 command_print(cmd_ctx, "verify jtag capture is %s", status);
2515
2516 return ERROR_OK;
2517 }
2518
2519
2520 int jtag_power_dropout(int *dropout)
2521 {
2522 return jtag->power_dropout(dropout);
2523 }
2524
2525 int jtag_srst_asserted(int *srst_asserted)
2526 {
2527 return jtag->srst_asserted(srst_asserted);
2528 }
2529
2530 void jtag_tap_handle_event( jtag_tap_t * tap, enum jtag_tap_event e)
2531 {
2532 jtag_tap_event_action_t * jteap;
2533 int done;
2534
2535 jteap = tap->event_action;
2536
2537 done = 0;
2538 while (jteap) {
2539 if (jteap->event == e) {
2540 done = 1;
2541 LOG_DEBUG( "JTAG tap: %s event: %d (%s) action: %s\n",
2542 tap->dotted_name,
2543 e,
2544 Jim_Nvp_value2name_simple(nvp_jtag_tap_event, e)->name,
2545 Jim_GetString(jteap->body, NULL) );
2546 if (Jim_EvalObj(interp, jteap->body) != JIM_OK) {
2547 Jim_PrintErrorMessage(interp);
2548 }
2549 }
2550
2551 jteap = jteap->next;
2552 }
2553
2554 if (!done) {
2555 LOG_DEBUG( "event %d %s - no action",
2556 e,
2557 Jim_Nvp_value2name_simple( nvp_jtag_tap_event, e)->name);
2558 }
2559 }
2560
2561 static int handle_tms_sequence_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2562 {
2563 if (argc > 1)
2564 return ERROR_COMMAND_SYNTAX_ERROR;
2565
2566 if (argc == 1)
2567 {
2568 bool use_new_table;
2569 if (strcmp(args[0], "short") == 0)
2570 use_new_table = true;
2571 else if (strcmp(args[0], "long") == 0)
2572 use_new_table = false;
2573 else
2574 return ERROR_COMMAND_SYNTAX_ERROR;
2575
2576 tap_use_new_tms_table(use_new_table);
2577 }
2578
2579 command_print(cmd_ctx, "tms sequence is %s",
2580 tap_uses_new_tms_table() ? "short": "long");
2581
2582 return ERROR_OK;
2583 }
2584
2585 /**
2586 * Function jtag_add_statemove
2587 * moves from the current state to the goal \a state. This needs
2588 * to be handled according to the xsvf spec, see the XSTATE command
2589 * description.
2590 */
2591 int jtag_add_statemove(tap_state_t goal_state)
2592 {
2593 int retval = ERROR_OK;
2594
2595 tap_state_t moves[8];
2596 tap_state_t cur_state = cmd_queue_cur_state;
2597 int i;
2598 int tms_bits;
2599 int tms_count;
2600
2601 LOG_DEBUG( "cur_state=%s goal_state=%s",
2602 tap_state_name(cur_state),
2603 tap_state_name(goal_state) );
2604
2605
2606 /* From the XSVF spec, pertaining to XSTATE:
2607
2608 For special states known as stable states (Test-Logic-Reset,
2609 Run-Test/Idle, Pause-DR, Pause- IR), an XSVF interpreter follows
2610 predefined TAP state paths when the starting state is a stable state and
2611 when the XSTATE specifies a new stable state (see the STATE command in
2612 the [Ref 5] for the TAP state paths between stable states). For
2613 non-stable states, XSTATE should specify a state that is only one TAP
2614 state transition distance from the current TAP state to avoid undefined
2615 TAP state paths. A sequence of multiple XSTATE commands can be issued to
2616 transition the TAP through a specific state path.
2617 */
2618
2619 if (goal_state==cur_state )
2620 ; /* nothing to do */
2621
2622 else if( goal_state==TAP_RESET )
2623 {
2624 jtag_add_tlr();
2625 }
2626
2627 else if( tap_is_state_stable(cur_state) && tap_is_state_stable(goal_state) )
2628 {
2629 /* note: unless tms_bits holds a path that agrees with [Ref 5] in above
2630 spec, then this code is not fully conformant to the xsvf spec. This
2631 puts a burden on tap_get_tms_path() function from the xsvf spec.
2632 If in doubt, you should confirm that that burden is being met.
2633 */
2634
2635 tms_bits = tap_get_tms_path(cur_state, goal_state);
2636 tms_count = tap_get_tms_path_len(cur_state, goal_state);
2637
2638 assert( (unsigned) tms_count < DIM(moves) );
2639
2640 for (i=0; i<tms_count; i++, tms_bits>>=1)
2641 {
2642 bool bit = tms_bits & 1;
2643
2644 cur_state = tap_state_transition(cur_state, bit);
2645 moves[i] = cur_state;
2646 }
2647
2648 jtag_add_pathmove(tms_count, moves);
2649 }
2650
2651 /* else state must be immediately reachable in one clock cycle, and does not
2652 need to be a stable state.
2653 */
2654 else if( tap_state_transition(cur_state, true) == goal_state
2655 || tap_state_transition(cur_state, false) == goal_state )
2656 {
2657 /* move a single state */
2658 moves[0] = goal_state;
2659 jtag_add_pathmove( 1, moves );
2660 }
2661
2662 else
2663 {
2664 retval = ERROR_FAIL;
2665 }
2666
2667 return retval;
2668 }
2669
2670 void jtag_set_nsrst_delay(unsigned delay)
2671 {
2672 jtag_nsrst_delay = delay;
2673 }
2674 unsigned jtag_get_nsrst_delay(void)
2675 {
2676 return jtag_nsrst_delay;
2677 }
2678 void jtag_set_ntrst_delay(unsigned delay)
2679 {
2680 jtag_ntrst_delay = delay;
2681 }
2682 unsigned jtag_get_ntrst_delay(void)
2683 {
2684 return jtag_ntrst_delay;
2685 }

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)