Code Review / openocd.git / blob
? search:
summary | shortlog | log | commit | commitdiff | review | tree
history | raw | HEAD
Add header file for JTAG minidriver:
[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 #define INCLUDE_JTAG_INTERFACE_H
32 #include "jtag.h"
33 #include "minidriver.h"
34
35 #ifdef HAVE_STRINGS_H
36 #include <strings.h>
37 #endif
38
39
40 int jtag_flush_queue_count; /* count # of flushes for profiling / debugging purposes */
41
42 static void jtag_add_scan_check(void (*jtag_add_scan)(int in_num_fields, const scan_field_t *in_fields, tap_state_t state),
43 int in_num_fields, scan_field_t *in_fields, tap_state_t state);
44
45 /* note that this is not marked as static as it must be available from outside jtag.c for those
46 that implement the jtag_xxx() minidriver layer
47 */
48 int jtag_error=ERROR_OK;
49
50 typedef struct cmd_queue_page_s
51 {
52 void *address;
53 size_t used;
54 struct cmd_queue_page_s *next;
55 } cmd_queue_page_t;
56
57 #define CMD_QUEUE_PAGE_SIZE (1024 * 1024)
58 static cmd_queue_page_t *cmd_queue_pages = NULL;
59
60 char* jtag_event_strings[] =
61 {
62 "JTAG controller reset (RESET or TRST)"
63 };
64
65 const Jim_Nvp nvp_jtag_tap_event[] = {
66 { .value = JTAG_TAP_EVENT_ENABLE, .name = "tap-enable" },
67 { .value = JTAG_TAP_EVENT_DISABLE, .name = "tap-disable" },
68
69 { .name = NULL, .value = -1 }
70 };
71
72 int jtag_trst = 0;
73 int jtag_srst = 0;
74
75 jtag_command_t *jtag_command_queue = NULL;
76 static jtag_command_t **next_command_pointer = &jtag_command_queue;
77 static jtag_tap_t *jtag_all_taps = NULL;
78
79 enum reset_types jtag_reset_config = RESET_NONE;
80 tap_state_t cmd_queue_end_state = TAP_RESET;
81 tap_state_t cmd_queue_cur_state = TAP_RESET;
82
83 int jtag_verify_capture_ir = 1;
84 int jtag_verify = 1;
85
86 /* how long the OpenOCD should wait before attempting JTAG communication after reset lines deasserted (in ms) */
87 static int jtag_nsrst_delay = 0; /* default to no nSRST delay */
88 static int jtag_ntrst_delay = 0; /* default to no nTRST delay */
89
90 /* maximum number of JTAG devices expected in the chain
91 */
92 #define JTAG_MAX_CHAIN_SIZE 20
93
94 /* callbacks to inform high-level handlers about JTAG state changes */
95 jtag_event_callback_t *jtag_event_callbacks;
96
97 /* speed in kHz*/
98 static int speed_khz = 0;
99 /* flag if the kHz speed was defined */
100 static int hasKHz = 0;
101
102 /* jtag interfaces (parport, FTDI-USB, TI-USB, ...)
103 */
104
105 #if BUILD_ECOSBOARD == 1
106 extern jtag_interface_t zy1000_interface;
107 #endif
108
109 #if BUILD_PARPORT == 1
110 extern jtag_interface_t parport_interface;
111 #endif
112
113 #if BUILD_DUMMY == 1
114 extern jtag_interface_t dummy_interface;
115 #endif
116
117 #if BUILD_FT2232_FTD2XX == 1
118 extern jtag_interface_t ft2232_interface;
119 #endif
120
121 #if BUILD_FT2232_LIBFTDI == 1
122 extern jtag_interface_t ft2232_interface;
123 #endif
124
125 #if BUILD_AMTJTAGACCEL == 1
126 extern jtag_interface_t amt_jtagaccel_interface;
127 #endif
128
129 #if BUILD_EP93XX == 1
130 extern jtag_interface_t ep93xx_interface;
131 #endif
132
133 #if BUILD_AT91RM9200 == 1
134 extern jtag_interface_t at91rm9200_interface;
135 #endif
136
137 #if BUILD_GW16012 == 1
138 extern jtag_interface_t gw16012_interface;
139 #endif
140
141 #if BUILD_PRESTO_LIBFTDI == 1 || BUILD_PRESTO_FTD2XX == 1
142 extern jtag_interface_t presto_interface;
143 #endif
144
145 #if BUILD_USBPROG == 1
146 extern jtag_interface_t usbprog_interface;
147 #endif
148
149 #if BUILD_JLINK == 1
150 extern jtag_interface_t jlink_interface;
151 #endif
152
153 #if BUILD_VSLLINK == 1
154 extern jtag_interface_t vsllink_interface;
155 #endif
156
157 #if BUILD_RLINK == 1
158 extern jtag_interface_t rlink_interface;
159 #endif
160
161 #if BUILD_ARMJTAGEW == 1
162 extern jtag_interface_t armjtagew_interface;
163 #endif
164
165 jtag_interface_t *jtag_interfaces[] = {
166 #if BUILD_ECOSBOARD == 1
167 &zy1000_interface,
168 #endif
169 #if BUILD_PARPORT == 1
170 &parport_interface,
171 #endif
172 #if BUILD_DUMMY == 1
173 &dummy_interface,
174 #endif
175 #if BUILD_FT2232_FTD2XX == 1
176 &ft2232_interface,
177 #endif
178 #if BUILD_FT2232_LIBFTDI == 1
179 &ft2232_interface,
180 #endif
181 #if BUILD_AMTJTAGACCEL == 1
182 &amt_jtagaccel_interface,
183 #endif
184 #if BUILD_EP93XX == 1
185 &ep93xx_interface,
186 #endif
187 #if BUILD_AT91RM9200 == 1
188 &at91rm9200_interface,
189 #endif
190 #if BUILD_GW16012 == 1
191 &gw16012_interface,
192 #endif
193 #if BUILD_PRESTO_LIBFTDI == 1 || BUILD_PRESTO_FTD2XX == 1
194 &presto_interface,
195 #endif
196 #if BUILD_USBPROG == 1
197 &usbprog_interface,
198 #endif
199 #if BUILD_JLINK == 1
200 &jlink_interface,
201 #endif
202 #if BUILD_VSLLINK == 1
203 &vsllink_interface,
204 #endif
205 #if BUILD_RLINK == 1
206 &rlink_interface,
207 #endif
208 #if BUILD_ARMJTAGEW == 1
209 &armjtagew_interface,
210 #endif
211 NULL,
212 };
213
214 struct jtag_interface_s *jtag = NULL;
215
216 /* configuration */
217 static jtag_interface_t *jtag_interface = NULL;
218 int jtag_speed = 0;
219
220 /* forward declarations */
221 //void jtag_add_pathmove(int num_states, tap_state_t *path);
222 //void jtag_add_runtest(int num_cycles, tap_state_t endstate);
223 //void jtag_add_end_state(tap_state_t endstate);
224 //void jtag_add_sleep(u32 us);
225 //int jtag_execute_queue(void);
226 static tap_state_t tap_state_by_name(const char *name);
227
228 /* jtag commands */
229 static int handle_interface_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
230 static int handle_jtag_speed_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
231 static int handle_jtag_khz_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
232 static int handle_jtag_device_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
233 static int handle_reset_config_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
234 static int handle_jtag_nsrst_delay_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
235 static int handle_jtag_ntrst_delay_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
236
237 static int handle_scan_chain_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
238
239 static int handle_endstate_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
240 static int handle_jtag_reset_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
241 static int handle_runtest_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
242 static int handle_irscan_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
243 static int Jim_Command_drscan(Jim_Interp *interp, int argc, Jim_Obj *const *argv);
244 static int Jim_Command_flush_count(Jim_Interp *interp, int argc, Jim_Obj *const *args);
245
246 static int handle_verify_ircapture_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
247 static int handle_verify_jtag_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
248 static int handle_tms_sequence_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
249
250 jtag_tap_t *jtag_AllTaps(void)
251 {
252 return jtag_all_taps;
253 };
254
255 int jtag_NumTotalTaps(void)
256 {
257 jtag_tap_t *t;
258 int n;
259
260 n = 0;
261 t = jtag_AllTaps();
262 while(t){
263 n++;
264 t = t->next_tap;
265 }
266 return n;
267 }
268
269 int jtag_NumEnabledTaps(void)
270 {
271 jtag_tap_t *t;
272 int n;
273
274 n = 0;
275 t = jtag_AllTaps();
276 while(t){
277 if( t->enabled ){
278 n++;
279 }
280 t = t->next_tap;
281 }
282 return n;
283 }
284
285 jtag_tap_t *jtag_TapByString( const char *s )
286 {
287 jtag_tap_t *t;
288 char *cp;
289
290 t = jtag_AllTaps();
291 /* try name first */
292 while(t){
293 if( 0 == strcmp( t->dotted_name, s ) ){
294 break;
295 } else {
296 t = t->next_tap;
297 }
298 }
299 /* backup plan is by number */
300 if( t == NULL ){
301 /* ok - is "s" a number? */
302 int n;
303 n = strtol( s, &cp, 0 );
304 if( (s != cp) && (*cp == 0) ){
305 /* Then it is... */
306 t = jtag_TapByAbsPosition(n);
307 }
308 }
309 return t;
310 }
311
312 jtag_tap_t * jtag_TapByJimObj( Jim_Interp *interp, Jim_Obj *o )
313 {
314 jtag_tap_t *t;
315 const char *cp;
316
317 cp = Jim_GetString( o, NULL );
318 if(cp == NULL){
319 cp = "(unknown)";
320 t = NULL;
321 } else {
322 t = jtag_TapByString( cp );
323 }
324 if( t == NULL ){
325 Jim_SetResult_sprintf(interp,"Tap: %s is unknown", cp );
326 }
327 return t;
328 }
329
330 /* returns a pointer to the n-th device in the scan chain */
331 jtag_tap_t * jtag_TapByAbsPosition( int n )
332 {
333 int orig_n;
334 jtag_tap_t *t;
335
336 orig_n = n;
337 t = jtag_AllTaps();
338
339 while( t && (n > 0)) {
340 n--;
341 t = t->next_tap;
342 }
343 return t;
344 }
345
346 int jtag_register_event_callback(int (*callback)(enum jtag_event event, void *priv), void *priv)
347 {
348 jtag_event_callback_t **callbacks_p = &jtag_event_callbacks;
349
350 if (callback == NULL)
351 {
352 return ERROR_INVALID_ARGUMENTS;
353 }
354
355 if (*callbacks_p)
356 {
357 while ((*callbacks_p)->next)
358 callbacks_p = &((*callbacks_p)->next);
359 callbacks_p = &((*callbacks_p)->next);
360 }
361
362 (*callbacks_p) = malloc(sizeof(jtag_event_callback_t));
363 (*callbacks_p)->callback = callback;
364 (*callbacks_p)->priv = priv;
365 (*callbacks_p)->next = NULL;
366
367 return ERROR_OK;
368 }
369
370 int jtag_unregister_event_callback(int (*callback)(enum jtag_event event, void *priv))
371 {
372 jtag_event_callback_t **callbacks_p = &jtag_event_callbacks;
373
374 if (callback == NULL)
375 {
376 return ERROR_INVALID_ARGUMENTS;
377 }
378
379 while (*callbacks_p)
380 {
381 jtag_event_callback_t **next = &((*callbacks_p)->next);
382 if ((*callbacks_p)->callback == callback)
383 {
384 free(*callbacks_p);
385 *callbacks_p = *next;
386 }
387 callbacks_p = next;
388 }
389
390 return ERROR_OK;
391 }
392
393 int jtag_call_event_callbacks(enum jtag_event event)
394 {
395 jtag_event_callback_t *callback = jtag_event_callbacks;
396
397 LOG_DEBUG("jtag event: %s", jtag_event_strings[event]);
398
399 while (callback)
400 {
401 callback->callback(event, callback->priv);
402 callback = callback->next;
403 }
404
405 return ERROR_OK;
406 }
407
408 void jtag_queue_command(jtag_command_t * cmd)
409 {
410 // this command goes on the end, so ensure the queue terminates
411 cmd->next = NULL;
412
413 jtag_command_t **last_cmd = next_command_pointer;
414 assert(NULL != last_cmd);
415 assert(NULL == *last_cmd);
416 *last_cmd = cmd;
417
418 // store location where the next command pointer will be stored
419 next_command_pointer = &cmd->next;
420 }
421
422 void* cmd_queue_alloc(size_t size)
423 {
424 cmd_queue_page_t **p_page = &cmd_queue_pages;
425 int offset;
426 u8 *t;
427
428 /*
429 * WARNING:
430 * We align/round the *SIZE* per below
431 * so that all pointers returned by
432 * this function are reasonably well
433 * aligned.
434 *
435 * If we did not, then an "odd-length" request would cause the
436 * *next* allocation to be at an *odd* address, and because
437 * this function has the same type of api as malloc() - we
438 * must also return pointers that have the same type of
439 * alignment.
440 *
441 * What I do not/have is a reasonable portable means
442 * to align by...
443 *
444 * The solution here, is based on these suggestions.
445 * http://gcc.gnu.org/ml/gcc-help/2008-12/msg00041.html
446 *
447 */
448 union worse_case_align {
449 int i;
450 long l;
451 float f;
452 void *v;
453 };
454 #define ALIGN_SIZE (sizeof(union worse_case_align))
455
456 /* The alignment process. */
457 size = (size + ALIGN_SIZE -1) & (~(ALIGN_SIZE-1));
458 /* Done... */
459
460 if (*p_page)
461 {
462 while ((*p_page)->next)
463 p_page = &((*p_page)->next);
464 if (CMD_QUEUE_PAGE_SIZE - (*p_page)->used < size)
465 p_page = &((*p_page)->next);
466 }
467
468 if (!*p_page)
469 {
470 *p_page = malloc(sizeof(cmd_queue_page_t));
471 (*p_page)->used = 0;
472 (*p_page)->address = malloc(CMD_QUEUE_PAGE_SIZE);
473 (*p_page)->next = NULL;
474 }
475
476 offset = (*p_page)->used;
477 (*p_page)->used += size;
478
479 t=(u8 *)((*p_page)->address);
480 return t + offset;
481 }
482
483 void cmd_queue_free(void)
484 {
485 cmd_queue_page_t *page = cmd_queue_pages;
486
487 while (page)
488 {
489 cmd_queue_page_t *last = page;
490 free(page->address);
491 page = page->next;
492 free(last);
493 }
494
495 cmd_queue_pages = NULL;
496 }
497
498 void jtag_command_queue_reset(void)
499 {
500 cmd_queue_free();
501
502 jtag_command_queue = NULL;
503 next_command_pointer = &jtag_command_queue;
504 }
505
506 static void jtag_prelude1(void)
507 {
508 if (jtag_trst == 1)
509 {
510 LOG_WARNING("JTAG command queued, while TRST is low (TAP in reset)");
511 jtag_error=ERROR_JTAG_TRST_ASSERTED;
512 return;
513 }
514
515 if (cmd_queue_end_state == TAP_RESET)
516 jtag_call_event_callbacks(JTAG_TRST_ASSERTED);
517 }
518
519 static void jtag_prelude(tap_state_t state)
520 {
521 jtag_prelude1();
522
523 if (state != TAP_INVALID)
524 jtag_add_end_state(state);
525
526 cmd_queue_cur_state = cmd_queue_end_state;
527 }
528
529 void jtag_alloc_in_value32(scan_field_t *field)
530 {
531 interface_jtag_alloc_in_value32(field);
532 }
533
534 void jtag_add_ir_scan_noverify(int in_num_fields, const scan_field_t *in_fields, tap_state_t state)
535 {
536 int retval;
537 jtag_prelude(state);
538
539 retval=interface_jtag_add_ir_scan(in_num_fields, in_fields, cmd_queue_end_state);
540 if (retval!=ERROR_OK)
541 jtag_error=retval;
542
543 }
544
545
546 /**
547 * Generate an IR SCAN with a list of scan fields with one entry for each enabled TAP.
548 *
549 * If the input field list contains an instruction value for a TAP then that is used
550 * otherwise the TAP is set to bypass.
551 *
552 * TAPs for which no fields are passed are marked as bypassed for subsequent DR SCANs.
553 *
554 */
555 void jtag_add_ir_scan(int in_num_fields, scan_field_t *in_fields, tap_state_t state)
556 {
557 if (jtag_verify&&jtag_verify_capture_ir)
558 {
559 /* 8 x 32 bit id's is enough for all invocations */
560
561 for (int j = 0; j < in_num_fields; j++)
562 {
563 /* if we are to run a verification of the ir scan, we need to get the input back.
564 * We may have to allocate space if the caller didn't ask for the input back.
565 */
566 in_fields[j].check_value=in_fields[j].tap->expected;
567 in_fields[j].check_mask=in_fields[j].tap->expected_mask;
568 }
569 jtag_add_scan_check(jtag_add_ir_scan_noverify, in_num_fields, in_fields, state);
570 } else
571 {
572 jtag_add_ir_scan_noverify(in_num_fields, in_fields, state);
573 }
574 }
575
576 /**
577 * Duplicate the scan fields passed into the function into an IR SCAN command
578 *
579 * This function assumes that the caller handles extra fields for bypassed TAPs
580 *
581 */
582 void jtag_add_plain_ir_scan(int in_num_fields, const scan_field_t *in_fields, tap_state_t state)
583 {
584 int retval;
585
586 jtag_prelude(state);
587
588 retval=interface_jtag_add_plain_ir_scan(in_num_fields, in_fields, cmd_queue_end_state);
589 if (retval!=ERROR_OK)
590 jtag_error=retval;
591 }
592
593
594
595 int jtag_check_value_inner(u8 *captured, u8 *in_check_value, u8 *in_check_mask, int num_bits);
596
597 static int jtag_check_value_mask_callback(u8 *in, jtag_callback_data_t data1, jtag_callback_data_t data2, jtag_callback_data_t data3)
598 {
599 return jtag_check_value_inner(in, (u8 *)data1, (u8 *)data2, (int)data3);
600 }
601
602 static void jtag_add_scan_check(void (*jtag_add_scan)(int in_num_fields, const scan_field_t *in_fields, tap_state_t state),
603 int in_num_fields, scan_field_t *in_fields, tap_state_t state)
604 {
605 for (int i = 0; i < in_num_fields; i++)
606 {
607 struct scan_field_s *field = &in_fields[i];
608 field->allocated = 0;
609 field->modified = 0;
610 if (field->check_value || field->in_value)
611 continue;
612 interface_jtag_add_scan_check_alloc(field);
613 field->modified = 1;
614 }
615
616 jtag_add_scan(in_num_fields, in_fields, state);
617
618 for (int i = 0; i < in_num_fields; i++)
619 {
620 if ((in_fields[i].check_value != NULL) && (in_fields[i].in_value != NULL))
621 {
622 /* this is synchronous for a minidriver */
623 jtag_add_callback4(jtag_check_value_mask_callback, in_fields[i].in_value,
624 (jtag_callback_data_t)in_fields[i].check_value,
625 (jtag_callback_data_t)in_fields[i].check_mask,
626 (jtag_callback_data_t)in_fields[i].num_bits);
627 }
628 if (in_fields[i].allocated)
629 {
630 free(in_fields[i].in_value);
631 }
632 if (in_fields[i].modified)
633 {
634 in_fields[i].in_value = NULL;
635 }
636 }
637 }
638
639 void jtag_add_dr_scan_check(int in_num_fields, scan_field_t *in_fields, tap_state_t state)
640 {
641 if (jtag_verify)
642 {
643 jtag_add_scan_check(jtag_add_dr_scan, in_num_fields, in_fields, state);
644 } else
645 {
646 jtag_add_dr_scan(in_num_fields, in_fields, state);
647 }
648 }
649
650
651 /**
652 * Generate a DR SCAN using the fields passed to the function
653 *
654 * For not bypassed TAPs the function checks in_fields and uses fields specified there.
655 * For bypassed TAPs the function generates a dummy 1bit field.
656 *
657 * The bypass status of TAPs is set by jtag_add_ir_scan().
658 *
659 */
660 void jtag_add_dr_scan(int in_num_fields, const scan_field_t *in_fields, tap_state_t state)
661 {
662 int retval;
663
664 jtag_prelude(state);
665
666 retval=interface_jtag_add_dr_scan(in_num_fields, in_fields, cmd_queue_end_state);
667 if (retval!=ERROR_OK)
668 jtag_error=retval;
669 }
670
671
672
673 /**
674 * Duplicate the scan fields passed into the function into a DR SCAN command
675 *
676 * This function assumes that the caller handles extra fields for bypassed TAPs
677 *
678 */
679 void jtag_add_plain_dr_scan(int in_num_fields, const scan_field_t *in_fields, tap_state_t state)
680 {
681 int retval;
682
683 jtag_prelude(state);
684
685 retval=interface_jtag_add_plain_dr_scan(in_num_fields, in_fields, cmd_queue_end_state);
686 if (retval!=ERROR_OK)
687 jtag_error=retval;
688 }
689
690 void jtag_add_dr_out(jtag_tap_t* tap,
691 int num_fields, const int* num_bits, const u32* value,
692 tap_state_t end_state)
693 {
694 if (end_state != TAP_INVALID)
695 cmd_queue_end_state = end_state;
696
697 cmd_queue_cur_state = cmd_queue_end_state;
698
699 interface_jtag_add_dr_out(tap,
700 num_fields, num_bits, value,
701 cmd_queue_end_state);
702 }
703
704 void jtag_add_tlr(void)
705 {
706 jtag_prelude(TAP_RESET);
707
708 int retval;
709 retval=interface_jtag_add_tlr();
710 if (retval!=ERROR_OK)
711 jtag_error=retval;
712 }
713
714 void jtag_add_pathmove(int num_states, const tap_state_t *path)
715 {
716 tap_state_t cur_state = cmd_queue_cur_state;
717 int i;
718 int retval;
719
720 /* the last state has to be a stable state */
721 if (!tap_is_state_stable(path[num_states - 1]))
722 {
723 LOG_ERROR("BUG: TAP path doesn't finish in a stable state");
724 exit(-1);
725 }
726
727 for (i=0; i<num_states; i++)
728 {
729 if (path[i] == TAP_RESET)
730 {
731 LOG_ERROR("BUG: TAP_RESET is not a valid state for pathmove sequences");
732 exit(-1);
733 }
734
735 if ( tap_state_transition(cur_state, true) != path[i]
736 && tap_state_transition(cur_state, false) != path[i])
737 {
738 LOG_ERROR("BUG: %s -> %s isn't a valid TAP transition", tap_state_name(cur_state), tap_state_name(path[i]));
739 exit(-1);
740 }
741 cur_state = path[i];
742 }
743
744 jtag_prelude1();
745
746 retval = interface_jtag_add_pathmove(num_states, path);
747 cmd_queue_cur_state = path[num_states - 1];
748 if (retval!=ERROR_OK)
749 jtag_error=retval;
750 }
751
752 void jtag_add_runtest(int num_cycles, tap_state_t state)
753 {
754 int retval;
755
756 jtag_prelude(state);
757
758 /* executed by sw or hw fifo */
759 retval=interface_jtag_add_runtest(num_cycles, cmd_queue_end_state);
760 if (retval!=ERROR_OK)
761 jtag_error=retval;
762 }
763
764
765 void jtag_add_clocks( int num_cycles )
766 {
767 int retval;
768
769 if( !tap_is_state_stable(cmd_queue_cur_state) )
770 {
771 LOG_ERROR( "jtag_add_clocks() was called with TAP in non-stable state \"%s\"",
772 tap_state_name(cmd_queue_cur_state) );
773 jtag_error = ERROR_JTAG_NOT_STABLE_STATE;
774 return;
775 }
776
777 if( num_cycles > 0 )
778 {
779 jtag_prelude1();
780
781 retval = interface_jtag_add_clocks(num_cycles);
782 if (retval != ERROR_OK)
783 jtag_error=retval;
784 }
785 }
786
787 void jtag_add_reset(int req_tlr_or_trst, int req_srst)
788 {
789 int trst_with_tlr = 0;
790 int retval;
791
792 /* FIX!!! there are *many* different cases here. A better
793 * approach is needed for legal combinations of transitions...
794 */
795 if ((jtag_reset_config & RESET_HAS_SRST)&&
796 (jtag_reset_config & RESET_HAS_TRST)&&
797 ((jtag_reset_config & RESET_SRST_PULLS_TRST)==0))
798 {
799 if (((req_tlr_or_trst&&!jtag_trst)||
800 (!req_tlr_or_trst&&jtag_trst))&&
801 ((req_srst&&!jtag_srst)||
802 (!req_srst&&jtag_srst)))
803 {
804 /* FIX!!! srst_pulls_trst allows 1,1 => 0,0 transition.... */
805 //LOG_ERROR("BUG: transition of req_tlr_or_trst and req_srst in the same jtag_add_reset() call is undefined");
806 }
807 }
808
809 /* Make sure that jtag_reset_config allows the requested reset */
810 /* if SRST pulls TRST, we can't fulfill srst == 1 with trst == 0 */
811 if (((jtag_reset_config & RESET_SRST_PULLS_TRST) && (req_srst == 1)) && (!req_tlr_or_trst))
812 {
813 LOG_ERROR("BUG: requested reset would assert trst");
814 jtag_error=ERROR_FAIL;
815 return;
816 }
817
818 /* if TRST pulls SRST, we reset with TAP T-L-R */
819 if (((jtag_reset_config & RESET_TRST_PULLS_SRST) && (req_tlr_or_trst)) && (req_srst == 0))
820 {
821 trst_with_tlr = 1;
822 }
823
824 if (req_srst && !(jtag_reset_config & RESET_HAS_SRST))
825 {
826 LOG_ERROR("BUG: requested SRST assertion, but the current configuration doesn't support this");
827 jtag_error=ERROR_FAIL;
828 return;
829 }
830
831 if (req_tlr_or_trst)
832 {
833 if (!trst_with_tlr && (jtag_reset_config & RESET_HAS_TRST))
834 {
835 jtag_trst = 1;
836 } else
837 {
838 trst_with_tlr = 1;
839 }
840 } else
841 {
842 jtag_trst = 0;
843 }
844
845 jtag_srst = req_srst;
846
847 retval = interface_jtag_add_reset(jtag_trst, jtag_srst);
848 if (retval!=ERROR_OK)
849 {
850 jtag_error=retval;
851 return;
852 }
853 jtag_execute_queue();
854
855 if (jtag_srst)
856 {
857 LOG_DEBUG("SRST line asserted");
858 }
859 else
860 {
861 LOG_DEBUG("SRST line released");
862 if (jtag_nsrst_delay)
863 jtag_add_sleep(jtag_nsrst_delay * 1000);
864 }
865
866 if (trst_with_tlr)
867 {
868 LOG_DEBUG("JTAG reset with RESET instead of TRST");
869 jtag_add_end_state(TAP_RESET);
870 jtag_add_tlr();
871 jtag_call_event_callbacks(JTAG_TRST_ASSERTED);
872 return;
873 }
874
875 if (jtag_trst)
876 {
877 /* we just asserted nTRST, so we're now in Test-Logic-Reset,
878 * and inform possible listeners about this
879 */
880 LOG_DEBUG("TRST line asserted");
881 tap_set_state(TAP_RESET);
882 jtag_call_event_callbacks(JTAG_TRST_ASSERTED);
883 }
884 else
885 {
886 if (jtag_ntrst_delay)
887 jtag_add_sleep(jtag_ntrst_delay * 1000);
888 }
889 }
890
891 void jtag_add_end_state(tap_state_t state)
892 {
893 cmd_queue_end_state = state;
894 if ((cmd_queue_end_state == TAP_DRSHIFT)||(cmd_queue_end_state == TAP_IRSHIFT))
895 {
896 LOG_ERROR("BUG: TAP_DRSHIFT/IRSHIFT can't be end state. Calling code should use a larger scan field");
897 }
898 }
899
900 void jtag_add_sleep(u32 us)
901 {
902 keep_alive(); /* we might be running on a very slow JTAG clk */
903 int retval=interface_jtag_add_sleep(us);
904 if (retval!=ERROR_OK)
905 jtag_error=retval;
906 return;
907 }
908
909 int jtag_scan_size(const scan_command_t *cmd)
910 {
911 int bit_count = 0;
912 int i;
913
914 /* count bits in scan command */
915 for (i = 0; i < cmd->num_fields; i++)
916 {
917 bit_count += cmd->fields[i].num_bits;
918 }
919
920 return bit_count;
921 }
922
923 int jtag_build_buffer(const scan_command_t *cmd, u8 **buffer)
924 {
925 int bit_count = 0;
926 int i;
927
928 bit_count = jtag_scan_size(cmd);
929 *buffer = calloc(1,CEIL(bit_count, 8));
930
931 bit_count = 0;
932
933 #ifdef _DEBUG_JTAG_IO_
934 LOG_DEBUG("%s num_fields: %i", cmd->ir_scan ? "IRSCAN" : "DRSCAN", cmd->num_fields);
935 #endif
936
937 for (i = 0; i < cmd->num_fields; i++)
938 {
939 if (cmd->fields[i].out_value)
940 {
941 #ifdef _DEBUG_JTAG_IO_
942 char* char_buf = buf_to_str(cmd->fields[i].out_value, (cmd->fields[i].num_bits > DEBUG_JTAG_IOZ) ? DEBUG_JTAG_IOZ : cmd->fields[i].num_bits, 16);
943 #endif
944 buf_set_buf(cmd->fields[i].out_value, 0, *buffer, bit_count, cmd->fields[i].num_bits);
945 #ifdef _DEBUG_JTAG_IO_
946 LOG_DEBUG("fields[%i].out_value[%i]: 0x%s", i, cmd->fields[i].num_bits, char_buf);
947 free(char_buf);
948 #endif
949 }
950 else
951 {
952 #ifdef _DEBUG_JTAG_IO_
953 LOG_DEBUG("fields[%i].out_value[%i]: NULL", i, cmd->fields[i].num_bits);
954 #endif
955 }
956
957 bit_count += cmd->fields[i].num_bits;
958 }
959
960 #ifdef _DEBUG_JTAG_IO_
961 //LOG_DEBUG("bit_count totalling: %i", bit_count );
962 #endif
963
964 return bit_count;
965 }
966
967 int jtag_read_buffer(u8 *buffer, const scan_command_t *cmd)
968 {
969 int i;
970 int bit_count = 0;
971 int retval;
972
973 /* we return ERROR_OK, unless a check fails, or a handler reports a problem */
974 retval = ERROR_OK;
975
976 for (i = 0; i < cmd->num_fields; i++)
977 {
978 /* if neither in_value nor in_handler
979 * are specified we don't have to examine this field
980 */
981 if (cmd->fields[i].in_value)
982 {
983 int num_bits = cmd->fields[i].num_bits;
984 u8 *captured = buf_set_buf(buffer, bit_count, malloc(CEIL(num_bits, 8)), 0, num_bits);
985
986 #ifdef _DEBUG_JTAG_IO_
987 char *char_buf = buf_to_str(captured, (num_bits > DEBUG_JTAG_IOZ) ? DEBUG_JTAG_IOZ : num_bits, 16);
988 LOG_DEBUG("fields[%i].in_value[%i]: 0x%s", i, num_bits, char_buf);
989 free(char_buf);
990 #endif
991
992 if (cmd->fields[i].in_value)
993 {
994 buf_cpy(captured, cmd->fields[i].in_value, num_bits);
995 }
996
997 free(captured);
998 }
999 bit_count += cmd->fields[i].num_bits;
1000 }
1001
1002 return retval;
1003 }
1004
1005 static const char *jtag_tap_name(const jtag_tap_t *tap)
1006 {
1007 return (tap == NULL) ? "(unknown)" : tap->dotted_name;
1008 }
1009
1010 int jtag_check_value_inner(u8 *captured, u8 *in_check_value, u8 *in_check_mask, int num_bits)
1011 {
1012 int retval = ERROR_OK;
1013
1014 int compare_failed = 0;
1015
1016 if (in_check_mask)
1017 compare_failed = buf_cmp_mask(captured, in_check_value, in_check_mask, num_bits);
1018 else
1019 compare_failed = buf_cmp(captured, in_check_value, num_bits);
1020
1021 if (compare_failed){
1022 /* An error handler could have caught the failing check
1023 * only report a problem when there wasn't a handler, or if the handler
1024 * acknowledged the error
1025 */
1026 /*
1027 LOG_WARNING("TAP %s:",
1028 jtag_tap_name(field->tap));
1029 */
1030 if (compare_failed)
1031 {
1032 char *captured_char = buf_to_str(captured, (num_bits > DEBUG_JTAG_IOZ) ? DEBUG_JTAG_IOZ : num_bits, 16);
1033 char *in_check_value_char = buf_to_str(in_check_value, (num_bits > DEBUG_JTAG_IOZ) ? DEBUG_JTAG_IOZ : num_bits, 16);
1034
1035 if (in_check_mask)
1036 {
1037 char *in_check_mask_char;
1038 in_check_mask_char = buf_to_str(in_check_mask, (num_bits > DEBUG_JTAG_IOZ) ? DEBUG_JTAG_IOZ : num_bits, 16);
1039 LOG_WARNING("value captured during scan didn't pass the requested check:");
1040 LOG_WARNING("captured: 0x%s check_value: 0x%s check_mask: 0x%s",
1041 captured_char, in_check_value_char, in_check_mask_char);
1042 free(in_check_mask_char);
1043 }
1044 else
1045 {
1046 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);
1047 }
1048
1049 free(captured_char);
1050 free(in_check_value_char);
1051
1052 retval = ERROR_JTAG_QUEUE_FAILED;
1053 }
1054
1055 }
1056 return retval;
1057 }
1058
1059 void jtag_check_value_mask(scan_field_t *field, u8 *value, u8 *mask)
1060 {
1061 assert(field->in_value != NULL);
1062
1063 if (value==NULL)
1064 {
1065 /* no checking to do */
1066 return;
1067 }
1068
1069 jtag_execute_queue_noclear();
1070
1071 int retval=jtag_check_value_inner(field->in_value, value, mask, field->num_bits);
1072 jtag_set_error(retval);
1073 }
1074
1075
1076
1077 enum scan_type jtag_scan_type(const scan_command_t *cmd)
1078 {
1079 int i;
1080 int type = 0;
1081
1082 for (i = 0; i < cmd->num_fields; i++)
1083 {
1084 if (cmd->fields[i].in_value)
1085 type |= SCAN_IN;
1086 if (cmd->fields[i].out_value)
1087 type |= SCAN_OUT;
1088 }
1089
1090 return type;
1091 }
1092
1093 int default_interface_jtag_execute_queue(void)
1094 {
1095 if (NULL == jtag)
1096 {
1097 LOG_ERROR("No JTAG interface configured yet. "
1098 "Issue 'init' command in startup scripts "
1099 "before communicating with targets.");
1100 return ERROR_FAIL;
1101 }
1102
1103 return jtag->execute_queue();
1104 }
1105
1106 void jtag_execute_queue_noclear(void)
1107 {
1108 /* each flush can take as much as 1-2ms on high bandwidth low latency interfaces.
1109 * E.g. a JTAG over TCP/IP or USB....
1110 */
1111 jtag_flush_queue_count++;
1112
1113 int retval=interface_jtag_execute_queue();
1114 /* we keep the first error */
1115 if ((jtag_error==ERROR_OK)&&(retval!=ERROR_OK))
1116 {
1117 jtag_error=retval;
1118 }
1119 }
1120
1121 int jtag_execute_queue(void)
1122 {
1123 int retval;
1124 jtag_execute_queue_noclear();
1125 retval=jtag_error;
1126 jtag_error=ERROR_OK;
1127 return retval;
1128 }
1129
1130 int jtag_reset_callback(enum jtag_event event, void *priv)
1131 {
1132 jtag_tap_t *tap = priv;
1133
1134 LOG_DEBUG("-");
1135
1136 if (event == JTAG_TRST_ASSERTED)
1137 {
1138 buf_set_ones(tap->cur_instr, tap->ir_length);
1139 tap->bypass = 1;
1140 }
1141
1142 return ERROR_OK;
1143 }
1144
1145 void jtag_sleep(u32 us)
1146 {
1147 alive_sleep(us/1000);
1148 }
1149
1150 /* Try to examine chain layout according to IEEE 1149.1 §12
1151 */
1152 int jtag_examine_chain(void)
1153 {
1154 jtag_tap_t *tap;
1155 scan_field_t field;
1156 u8 idcode_buffer[JTAG_MAX_CHAIN_SIZE * 4];
1157 int i;
1158 int bit_count;
1159 int device_count = 0;
1160 u8 zero_check = 0x0;
1161 u8 one_check = 0xff;
1162
1163 field.tap = NULL;
1164 field.num_bits = sizeof(idcode_buffer) * 8;
1165 field.out_value = idcode_buffer;
1166
1167 field.in_value = idcode_buffer;
1168
1169
1170
1171
1172 for (i = 0; i < JTAG_MAX_CHAIN_SIZE; i++)
1173 {
1174 buf_set_u32(idcode_buffer, i * 32, 32, 0x000000FF);
1175 }
1176
1177 jtag_add_plain_dr_scan(1, &field, TAP_RESET);
1178 jtag_execute_queue();
1179
1180 for (i = 0; i < JTAG_MAX_CHAIN_SIZE * 4; i++)
1181 {
1182 zero_check |= idcode_buffer[i];
1183 one_check &= idcode_buffer[i];
1184 }
1185
1186 /* if there wasn't a single non-zero bit or if all bits were one, the scan isn't valid */
1187 if ((zero_check == 0x00) || (one_check == 0xff))
1188 {
1189 LOG_ERROR("JTAG communication failure, check connection, JTAG interface, target power etc.");
1190 return ERROR_JTAG_INIT_FAILED;
1191 }
1192
1193 /* point at the 1st tap */
1194 tap = jtag_NextEnabledTap(NULL);
1195 if( tap == NULL ){
1196 LOG_ERROR("JTAG: No taps enabled?");
1197 return ERROR_JTAG_INIT_FAILED;
1198 }
1199
1200 for (bit_count = 0; bit_count < (JTAG_MAX_CHAIN_SIZE * 32) - 31;)
1201 {
1202 u32 idcode = buf_get_u32(idcode_buffer, bit_count, 32);
1203 if ((idcode & 1) == 0)
1204 {
1205 /* LSB must not be 0, this indicates a device in bypass */
1206 LOG_WARNING("Tap/Device does not have IDCODE");
1207 idcode=0;
1208
1209 bit_count += 1;
1210 }
1211 else
1212 {
1213 u32 manufacturer;
1214 u32 part;
1215 u32 version;
1216
1217 /* some devices, such as AVR will output all 1's instead of TDI
1218 input value at end of chain. */
1219 if ((idcode == 0x000000FF)||(idcode == 0xFFFFFFFF))
1220 {
1221 int unexpected=0;
1222 /* End of chain (invalid manufacturer ID)
1223 *
1224 * The JTAG examine is the very first thing that happens
1225 *
1226 * A single JTAG device requires only 64 bits to be read back correctly.
1227 *
1228 * The code below adds a check that the rest of the data scanned (640 bits)
1229 * are all as expected. This helps diagnose/catch problems with the JTAG chain
1230 *
1231 * earlier and gives more helpful/explicit error messages.
1232 */
1233 for (bit_count += 32; bit_count < (JTAG_MAX_CHAIN_SIZE * 32) - 31;bit_count += 32)
1234 {
1235 idcode = buf_get_u32(idcode_buffer, bit_count, 32);
1236 if (unexpected||((idcode != 0x000000FF)&&(idcode != 0xFFFFFFFF)))
1237 {
1238 LOG_WARNING("Unexpected idcode after end of chain! %d 0x%08x", bit_count, idcode);
1239 unexpected = 1;
1240 }
1241 }
1242
1243 break;
1244 }
1245
1246 #define EXTRACT_MFG(X) (((X) & 0xffe) >> 1)
1247 manufacturer = EXTRACT_MFG(idcode);
1248 #define EXTRACT_PART(X) (((X) & 0xffff000) >> 12)
1249 part = EXTRACT_PART(idcode);
1250 #define EXTRACT_VER(X) (((X) & 0xf0000000) >> 28)
1251 version = EXTRACT_VER(idcode);
1252
1253 LOG_INFO("JTAG tap: %s tap/device found: 0x%8.8x (Manufacturer: 0x%3.3x, Part: 0x%4.4x, Version: 0x%1.1x)",
1254 ((tap != NULL) ? (tap->dotted_name) : "(not-named)"),
1255 idcode, manufacturer, part, version);
1256
1257 bit_count += 32;
1258 }
1259 if (tap)
1260 {
1261 tap->idcode = idcode;
1262
1263 if (tap->expected_ids_cnt > 0) {
1264 /* Loop over the expected identification codes and test for a match */
1265 u8 ii;
1266 for (ii = 0; ii < tap->expected_ids_cnt; ii++) {
1267 if( tap->idcode == tap->expected_ids[ii] ){
1268 break;
1269 }
1270 }
1271
1272 /* If none of the expected ids matched, log an error */
1273 if (ii == tap->expected_ids_cnt) {
1274 LOG_ERROR("JTAG tap: %s got: 0x%08x (mfg: 0x%3.3x, part: 0x%4.4x, ver: 0x%1.1x)",
1275 tap->dotted_name,
1276 idcode,
1277 EXTRACT_MFG( tap->idcode ),
1278 EXTRACT_PART( tap->idcode ),
1279 EXTRACT_VER( tap->idcode ) );
1280 for (ii = 0; ii < tap->expected_ids_cnt; ii++) {
1281 LOG_ERROR("JTAG tap: %s expected %hhu of %hhu: 0x%08x (mfg: 0x%3.3x, part: 0x%4.4x, ver: 0x%1.1x)",
1282 tap->dotted_name,
1283 ii + 1,
1284 tap->expected_ids_cnt,
1285 tap->expected_ids[ii],
1286 EXTRACT_MFG( tap->expected_ids[ii] ),
1287 EXTRACT_PART( tap->expected_ids[ii] ),
1288 EXTRACT_VER( tap->expected_ids[ii] ) );
1289 }
1290
1291 return ERROR_JTAG_INIT_FAILED;
1292 } else {
1293 LOG_INFO("JTAG Tap/device matched");
1294 }
1295 } else {
1296 #if 0
1297 LOG_INFO("JTAG TAP ID: 0x%08x - Unknown - please report (A) chipname and (B) idcode to the openocd project",
1298 tap->idcode);
1299 #endif
1300 }
1301 tap = jtag_NextEnabledTap(tap);
1302 }
1303 device_count++;
1304 }
1305
1306 /* see if number of discovered devices matches configuration */
1307 if (device_count != jtag_NumEnabledTaps())
1308 {
1309 LOG_ERROR("number of discovered devices in JTAG chain (%i) doesn't match (enabled) configuration (%i), total taps: %d",
1310 device_count, jtag_NumEnabledTaps(), jtag_NumTotalTaps());
1311 LOG_ERROR("check the config file and ensure proper JTAG communication (connections, speed, ...)");
1312 return ERROR_JTAG_INIT_FAILED;
1313 }
1314
1315 return ERROR_OK;
1316 }
1317
1318 int jtag_validate_chain(void)
1319 {
1320 jtag_tap_t *tap;
1321 int total_ir_length = 0;
1322 u8 *ir_test = NULL;
1323 scan_field_t field;
1324 int chain_pos = 0;
1325
1326 tap = NULL;
1327 total_ir_length = 0;
1328 for(;;){
1329 tap = jtag_NextEnabledTap(tap);
1330 if( tap == NULL ){
1331 break;
1332 }
1333 total_ir_length += tap->ir_length;
1334 }
1335
1336 total_ir_length += 2;
1337 ir_test = malloc(CEIL(total_ir_length, 8));
1338 buf_set_ones(ir_test, total_ir_length);
1339
1340 field.tap = NULL;
1341 field.num_bits = total_ir_length;
1342 field.out_value = ir_test;
1343 field.in_value = ir_test;
1344
1345
1346 jtag_add_plain_ir_scan(1, &field, TAP_RESET);
1347 jtag_execute_queue();
1348
1349 tap = NULL;
1350 chain_pos = 0;
1351 int val;
1352 for(;;){
1353 tap = jtag_NextEnabledTap(tap);
1354 if( tap == NULL ){
1355 break;
1356 }
1357
1358 val = buf_get_u32(ir_test, chain_pos, 2);
1359 if (val != 0x1)
1360 {
1361 char *cbuf = buf_to_str(ir_test, total_ir_length, 16);
1362 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);
1363 free(cbuf);
1364 free(ir_test);
1365 return ERROR_JTAG_INIT_FAILED;
1366 }
1367 chain_pos += tap->ir_length;
1368 }
1369
1370 val = buf_get_u32(ir_test, chain_pos, 2);
1371 if (val != 0x3)
1372 {
1373 char *cbuf = buf_to_str(ir_test, total_ir_length, 16);
1374 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);
1375 free(cbuf);
1376 free(ir_test);
1377 return ERROR_JTAG_INIT_FAILED;
1378 }
1379
1380 free(ir_test);
1381
1382 return ERROR_OK;
1383 }
1384
1385 enum jtag_tap_cfg_param {
1386 JCFG_EVENT
1387 };
1388
1389 static Jim_Nvp nvp_config_opts[] = {
1390 { .name = "-event", .value = JCFG_EVENT },
1391
1392 { .name = NULL, .value = -1 }
1393 };
1394
1395 static int jtag_tap_configure_cmd( Jim_GetOptInfo *goi, jtag_tap_t * tap)
1396 {
1397 Jim_Nvp *n;
1398 Jim_Obj *o;
1399 int e;
1400
1401 /* parse config or cget options */
1402 while (goi->argc > 0) {
1403 Jim_SetEmptyResult (goi->interp);
1404
1405 e = Jim_GetOpt_Nvp(goi, nvp_config_opts, &n);
1406 if (e != JIM_OK) {
1407 Jim_GetOpt_NvpUnknown(goi, nvp_config_opts, 0);
1408 return e;
1409 }
1410
1411 switch (n->value) {
1412 case JCFG_EVENT:
1413 if (goi->argc == 0) {
1414 Jim_WrongNumArgs( goi->interp, goi->argc, goi->argv, "-event ?event-name? ..." );
1415 return JIM_ERR;
1416 }
1417
1418 e = Jim_GetOpt_Nvp( goi, nvp_jtag_tap_event, &n );
1419 if (e != JIM_OK) {
1420 Jim_GetOpt_NvpUnknown(goi, nvp_jtag_tap_event, 1);
1421 return e;
1422 }
1423
1424 if (goi->isconfigure) {
1425 if (goi->argc != 1) {
1426 Jim_WrongNumArgs(goi->interp, goi->argc, goi->argv, "-event ?event-name? ?EVENT-BODY?");
1427 return JIM_ERR;
1428 }
1429 } else {
1430 if (goi->argc != 0) {
1431 Jim_WrongNumArgs(goi->interp, goi->argc, goi->argv, "-event ?event-name?");
1432 return JIM_ERR;
1433 }
1434 }
1435
1436 {
1437 jtag_tap_event_action_t *jteap;
1438
1439 jteap = tap->event_action;
1440 /* replace existing? */
1441 while (jteap) {
1442 if (jteap->event == (enum jtag_tap_event)n->value) {
1443 break;
1444 }
1445 jteap = jteap->next;
1446 }
1447
1448 if (goi->isconfigure) {
1449 if (jteap == NULL) {
1450 /* create new */
1451 jteap = calloc(1, sizeof (*jteap));
1452 }
1453 jteap->event = n->value;
1454 Jim_GetOpt_Obj( goi, &o);
1455 if (jteap->body) {
1456 Jim_DecrRefCount(interp, jteap->body);
1457 }
1458 jteap->body = Jim_DuplicateObj(goi->interp, o);
1459 Jim_IncrRefCount(jteap->body);
1460
1461 /* add to head of event list */
1462 jteap->next = tap->event_action;
1463 tap->event_action = jteap;
1464 Jim_SetEmptyResult(goi->interp);
1465 } else {
1466 /* get */
1467 if (jteap == NULL) {
1468 Jim_SetEmptyResult(goi->interp);
1469 } else {
1470 Jim_SetResult(goi->interp, Jim_DuplicateObj(goi->interp, jteap->body));
1471 }
1472 }
1473 }
1474 /* loop for more */
1475 break;
1476 }
1477 } /* while (goi->argc) */
1478
1479 return JIM_OK;
1480 }
1481
1482 static int jim_newtap_cmd( Jim_GetOptInfo *goi )
1483 {
1484 jtag_tap_t *pTap;
1485 jtag_tap_t **ppTap;
1486 jim_wide w;
1487 int x;
1488 int e;
1489 int reqbits;
1490 Jim_Nvp *n;
1491 char *cp;
1492 const Jim_Nvp opts[] = {
1493 #define NTAP_OPT_IRLEN 0
1494 { .name = "-irlen" , .value = NTAP_OPT_IRLEN },
1495 #define NTAP_OPT_IRMASK 1
1496 { .name = "-irmask" , .value = NTAP_OPT_IRMASK },
1497 #define NTAP_OPT_IRCAPTURE 2
1498 { .name = "-ircapture" , .value = NTAP_OPT_IRCAPTURE },
1499 #define NTAP_OPT_ENABLED 3
1500 { .name = "-enable" , .value = NTAP_OPT_ENABLED },
1501 #define NTAP_OPT_DISABLED 4
1502 { .name = "-disable" , .value = NTAP_OPT_DISABLED },
1503 #define NTAP_OPT_EXPECTED_ID 5
1504 { .name = "-expected-id" , .value = NTAP_OPT_EXPECTED_ID },
1505 { .name = NULL , .value = -1 },
1506 };
1507
1508 pTap = malloc( sizeof(jtag_tap_t) );
1509 memset( pTap, 0, sizeof(*pTap) );
1510 if( !pTap ){
1511 Jim_SetResult_sprintf( goi->interp, "no memory");
1512 return JIM_ERR;
1513 }
1514 /*
1515 * we expect CHIP + TAP + OPTIONS
1516 * */
1517 if( goi->argc < 3 ){
1518 Jim_SetResult_sprintf(goi->interp, "Missing CHIP TAP OPTIONS ....");
1519 return JIM_ERR;
1520 }
1521 Jim_GetOpt_String( goi, &cp, NULL );
1522 pTap->chip = strdup(cp);
1523
1524 Jim_GetOpt_String( goi, &cp, NULL );
1525 pTap->tapname = strdup(cp);
1526
1527 /* name + dot + name + null */
1528 x = strlen(pTap->chip) + 1 + strlen(pTap->tapname) + 1;
1529 cp = malloc( x );
1530 sprintf( cp, "%s.%s", pTap->chip, pTap->tapname );
1531 pTap->dotted_name = cp;
1532
1533 LOG_DEBUG("Creating New Tap, Chip: %s, Tap: %s, Dotted: %s, %d params",
1534 pTap->chip, pTap->tapname, pTap->dotted_name, goi->argc);
1535
1536 /* default is enabled */
1537 pTap->enabled = 1;
1538
1539 /* deal with options */
1540 #define NTREQ_IRLEN 1
1541 #define NTREQ_IRCAPTURE 2
1542 #define NTREQ_IRMASK 4
1543
1544 /* clear them as we find them */
1545 reqbits = (NTREQ_IRLEN | NTREQ_IRCAPTURE | NTREQ_IRMASK);
1546
1547 while( goi->argc ){
1548 e = Jim_GetOpt_Nvp( goi, opts, &n );
1549 if( e != JIM_OK ){
1550 Jim_GetOpt_NvpUnknown( goi, opts, 0 );
1551 return e;
1552 }
1553 LOG_DEBUG("Processing option: %s", n->name );
1554 switch( n->value ){
1555 case NTAP_OPT_ENABLED:
1556 pTap->enabled = 1;
1557 break;
1558 case NTAP_OPT_DISABLED:
1559 pTap->enabled = 0;
1560 break;
1561 case NTAP_OPT_EXPECTED_ID:
1562 {
1563 u32 *new_expected_ids;
1564
1565 e = Jim_GetOpt_Wide( goi, &w );
1566 if( e != JIM_OK) {
1567 Jim_SetResult_sprintf(goi->interp, "option: %s bad parameter", n->name);
1568 return e;
1569 }
1570
1571 new_expected_ids = malloc(sizeof(u32) * (pTap->expected_ids_cnt + 1));
1572 if (new_expected_ids == NULL) {
1573 Jim_SetResult_sprintf( goi->interp, "no memory");
1574 return JIM_ERR;
1575 }
1576
1577 memcpy(new_expected_ids, pTap->expected_ids, sizeof(u32) * pTap->expected_ids_cnt);
1578
1579 new_expected_ids[pTap->expected_ids_cnt] = w;
1580
1581 free(pTap->expected_ids);
1582 pTap->expected_ids = new_expected_ids;
1583 pTap->expected_ids_cnt++;
1584 break;
1585 }
1586 case NTAP_OPT_IRLEN:
1587 case NTAP_OPT_IRMASK:
1588 case NTAP_OPT_IRCAPTURE:
1589 e = Jim_GetOpt_Wide( goi, &w );
1590 if( e != JIM_OK ){
1591 Jim_SetResult_sprintf( goi->interp, "option: %s bad parameter", n->name );
1592 return e;
1593 }
1594 if( (w < 0) || (w > 0xffff) ){
1595 /* wacky value */
1596 Jim_SetResult_sprintf( goi->interp, "option: %s - wacky value: %d (0x%x)",
1597 n->name, (int)(w), (int)(w));
1598 return JIM_ERR;
1599 }
1600 switch(n->value){
1601 case NTAP_OPT_IRLEN:
1602 pTap->ir_length = w;
1603 reqbits &= (~(NTREQ_IRLEN));
1604 break;
1605 case NTAP_OPT_IRMASK:
1606 pTap->ir_capture_mask = w;
1607 reqbits &= (~(NTREQ_IRMASK));
1608 break;
1609 case NTAP_OPT_IRCAPTURE:
1610 pTap->ir_capture_value = w;
1611 reqbits &= (~(NTREQ_IRCAPTURE));
1612 break;
1613 }
1614 } /* switch(n->value) */
1615 } /* while( goi->argc ) */
1616
1617 /* Did we get all the options? */
1618 if( reqbits ){
1619 // no
1620 Jim_SetResult_sprintf( goi->interp,
1621 "newtap: %s missing required parameters",
1622 pTap->dotted_name);
1623 /* TODO: Tell user what is missing :-( */
1624 /* no memory leaks pelase */
1625 free(((void *)(pTap->expected_ids)));
1626 free(((void *)(pTap->chip)));
1627 free(((void *)(pTap->tapname)));
1628 free(((void *)(pTap->dotted_name)));
1629 free(((void *)(pTap)));
1630 return JIM_ERR;
1631 }
1632
1633 pTap->expected = malloc( pTap->ir_length );
1634 pTap->expected_mask = malloc( pTap->ir_length );
1635 pTap->cur_instr = malloc( pTap->ir_length );
1636
1637 buf_set_u32( pTap->expected,
1638 0,
1639 pTap->ir_length,
1640 pTap->ir_capture_value );
1641 buf_set_u32( pTap->expected_mask,
1642 0,
1643 pTap->ir_length,
1644 pTap->ir_capture_mask );
1645 buf_set_ones( pTap->cur_instr,
1646 pTap->ir_length );
1647
1648 pTap->bypass = 1;
1649
1650 jtag_register_event_callback(jtag_reset_callback, pTap );
1651
1652 ppTap = &(jtag_all_taps);
1653 while( (*ppTap) != NULL ){
1654 ppTap = &((*ppTap)->next_tap);
1655 }
1656 *ppTap = pTap;
1657 {
1658 static int n_taps = 0;
1659 pTap->abs_chain_position = n_taps++;
1660 }
1661 LOG_DEBUG( "Created Tap: %s @ abs position %d, irlen %d, capture: 0x%x mask: 0x%x",
1662 (*ppTap)->dotted_name,
1663 (*ppTap)->abs_chain_position,
1664 (*ppTap)->ir_length,
1665 (*ppTap)->ir_capture_value,
1666 (*ppTap)->ir_capture_mask );
1667
1668 return ERROR_OK;
1669 }
1670
1671 static int jim_jtag_command( Jim_Interp *interp, int argc, Jim_Obj *const *argv )
1672 {
1673 Jim_GetOptInfo goi;
1674 int e;
1675 Jim_Nvp *n;
1676 Jim_Obj *o;
1677 struct command_context_s *context;
1678
1679 enum {
1680 JTAG_CMD_INTERFACE,
1681 JTAG_CMD_INIT_RESET,
1682 JTAG_CMD_NEWTAP,
1683 JTAG_CMD_TAPENABLE,
1684 JTAG_CMD_TAPDISABLE,
1685 JTAG_CMD_TAPISENABLED,
1686 JTAG_CMD_CONFIGURE,
1687 JTAG_CMD_CGET
1688 };
1689
1690 const Jim_Nvp jtag_cmds[] = {
1691 { .name = "interface" , .value = JTAG_CMD_INTERFACE },
1692 { .name = "arp_init-reset", .value = JTAG_CMD_INIT_RESET },
1693 { .name = "newtap" , .value = JTAG_CMD_NEWTAP },
1694 { .name = "tapisenabled" , .value = JTAG_CMD_TAPISENABLED },
1695 { .name = "tapenable" , .value = JTAG_CMD_TAPENABLE },
1696 { .name = "tapdisable" , .value = JTAG_CMD_TAPDISABLE },
1697 { .name = "configure" , .value = JTAG_CMD_CONFIGURE },
1698 { .name = "cget" , .value = JTAG_CMD_CGET },
1699
1700 { .name = NULL, .value = -1 },
1701 };
1702
1703 context = Jim_GetAssocData(interp, "context");
1704 /* go past the command */
1705 Jim_GetOpt_Setup( &goi, interp, argc-1, argv+1 );
1706
1707 e = Jim_GetOpt_Nvp( &goi, jtag_cmds, &n );
1708 if( e != JIM_OK ){
1709 Jim_GetOpt_NvpUnknown( &goi, jtag_cmds, 0 );
1710 return e;
1711 }
1712 Jim_SetEmptyResult( goi.interp );
1713 switch( n->value ){
1714 case JTAG_CMD_INTERFACE:
1715 /* return the name of the interface */
1716 /* TCL code might need to know the exact type... */
1717 /* FUTURE: we allow this as a means to "set" the interface. */
1718 if( goi.argc != 0 ){
1719 Jim_WrongNumArgs( goi.interp, 1, goi.argv-1, "(no params)");
1720 return JIM_ERR;
1721 }
1722 Jim_SetResultString( goi.interp, jtag_interface->name, -1 );
1723 return JIM_OK;
1724 case JTAG_CMD_INIT_RESET:
1725 if( goi.argc != 0 ){
1726 Jim_WrongNumArgs( goi.interp, 1, goi.argv-1, "(no params)");
1727 return JIM_ERR;
1728 }
1729 e = jtag_init_reset(context);
1730 if( e != ERROR_OK ){
1731 Jim_SetResult_sprintf( goi.interp, "error: %d", e);
1732 return JIM_ERR;
1733 }
1734 return JIM_OK;
1735 case JTAG_CMD_NEWTAP:
1736 return jim_newtap_cmd( &goi );
1737 break;
1738 case JTAG_CMD_TAPISENABLED:
1739 case JTAG_CMD_TAPENABLE:
1740 case JTAG_CMD_TAPDISABLE:
1741 if( goi.argc != 1 ){
1742 Jim_SetResultString( goi.interp, "Too many parameters",-1 );
1743 return JIM_ERR;
1744 }
1745
1746 {
1747 jtag_tap_t *t;
1748 t = jtag_TapByJimObj( goi.interp, goi.argv[0] );
1749 if( t == NULL ){
1750 return JIM_ERR;
1751 }
1752 switch( n->value ){
1753 case JTAG_CMD_TAPISENABLED:
1754 e = t->enabled;
1755 break;
1756 case JTAG_CMD_TAPENABLE:
1757 jtag_tap_handle_event( t, JTAG_TAP_EVENT_ENABLE);
1758 e = 1;
1759 t->enabled = e;
1760 break;
1761 case JTAG_CMD_TAPDISABLE:
1762 jtag_tap_handle_event( t, JTAG_TAP_EVENT_DISABLE);
1763 e = 0;
1764 t->enabled = e;
1765 break;
1766 }
1767 Jim_SetResult( goi.interp, Jim_NewIntObj( goi.interp, e ) );
1768 return JIM_OK;
1769 }
1770 break;
1771
1772 case JTAG_CMD_CGET:
1773 if( goi.argc < 2 ){
1774 Jim_WrongNumArgs( goi.interp, 0, NULL, "?tap-name? -option ...");
1775 return JIM_ERR;
1776 }
1777
1778 {
1779 jtag_tap_t *t;
1780
1781 Jim_GetOpt_Obj(&goi, &o);
1782 t = jtag_TapByJimObj( goi.interp, o );
1783 if( t == NULL ){
1784 return JIM_ERR;
1785 }
1786
1787 goi.isconfigure = 0;
1788 return jtag_tap_configure_cmd( &goi, t);
1789 }
1790 break;
1791
1792 case JTAG_CMD_CONFIGURE:
1793 if( goi.argc < 3 ){
1794 Jim_WrongNumArgs( goi.interp, 0, NULL, "?tap-name? -option ?VALUE? ...");
1795 return JIM_ERR;
1796 }
1797
1798 {
1799 jtag_tap_t *t;
1800
1801 Jim_GetOpt_Obj(&goi, &o);
1802 t = jtag_TapByJimObj( goi.interp, o );
1803 if( t == NULL ){
1804 return JIM_ERR;
1805 }
1806
1807 goi.isconfigure = 1;
1808 return jtag_tap_configure_cmd( &goi, t);
1809 }
1810 }
1811
1812 return JIM_ERR;
1813 }
1814
1815 int jtag_register_commands(struct command_context_s *cmd_ctx)
1816 {
1817 register_jim( cmd_ctx, "jtag", jim_jtag_command, "perform jtag tap actions");
1818
1819 register_command(cmd_ctx, NULL, "interface", handle_interface_command,
1820 COMMAND_CONFIG, "try to configure interface");
1821 register_command(cmd_ctx, NULL, "jtag_speed", handle_jtag_speed_command,
1822 COMMAND_ANY, "(DEPRECATED) set jtag speed (if supported)");
1823 register_command(cmd_ctx, NULL, "jtag_khz", handle_jtag_khz_command,
1824 COMMAND_ANY, "set maximum jtag speed (if supported); "
1825 "parameter is maximum khz, or 0 for adaptive clocking (RTCK).");
1826 register_command(cmd_ctx, NULL, "jtag_device", handle_jtag_device_command,
1827 COMMAND_CONFIG, "(DEPRECATED) jtag_device <ir_length> <ir_expected> <ir_mask>");
1828 register_command(cmd_ctx, NULL, "reset_config", handle_reset_config_command,
1829 COMMAND_ANY,
1830 "[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]");
1831 register_command(cmd_ctx, NULL, "jtag_nsrst_delay", handle_jtag_nsrst_delay_command,
1832 COMMAND_ANY, "jtag_nsrst_delay <ms> - delay after deasserting srst in ms");
1833 register_command(cmd_ctx, NULL, "jtag_ntrst_delay", handle_jtag_ntrst_delay_command,
1834 COMMAND_ANY, "jtag_ntrst_delay <ms> - delay after deasserting trst in ms");
1835
1836 register_command(cmd_ctx, NULL, "scan_chain", handle_scan_chain_command,
1837 COMMAND_EXEC, "print current scan chain configuration");
1838
1839 register_command(cmd_ctx, NULL, "endstate", handle_endstate_command,
1840 COMMAND_EXEC, "finish JTAG operations in <tap_state>");
1841 register_command(cmd_ctx, NULL, "jtag_reset", handle_jtag_reset_command,
1842 COMMAND_EXEC, "toggle reset lines <trst> <srst>");
1843 register_command(cmd_ctx, NULL, "runtest", handle_runtest_command,
1844 COMMAND_EXEC, "move to Run-Test/Idle, and execute <num_cycles>");
1845 register_command(cmd_ctx, NULL, "irscan", handle_irscan_command,
1846 COMMAND_EXEC, "execute IR scan <device> <instr> [dev2] [instr2] ...");
1847 register_jim(cmd_ctx, "drscan", Jim_Command_drscan, "execute DR scan <device> <num_bits> <value> <num_bits1> <value2> ...");
1848 register_jim(cmd_ctx, "flush_count", Jim_Command_flush_count, "returns number of times the JTAG queue has been flushed");
1849
1850 register_command(cmd_ctx, NULL, "verify_ircapture", handle_verify_ircapture_command,
1851 COMMAND_ANY, "verify value captured during Capture-IR <enable|disable>");
1852 register_command(cmd_ctx, NULL, "verify_jtag", handle_verify_jtag_command,
1853 COMMAND_ANY, "verify value capture <enable|disable>");
1854 register_command(cmd_ctx, NULL, "tms_sequence", handle_tms_sequence_command,
1855 COMMAND_ANY, "choose short(default) or long tms_sequence <short|long>");
1856 return ERROR_OK;
1857 }
1858
1859 int jtag_interface_init(struct command_context_s *cmd_ctx)
1860 {
1861 if (jtag)
1862 return ERROR_OK;
1863
1864 if (!jtag_interface)
1865 {
1866 /* nothing was previously specified by "interface" command */
1867 LOG_ERROR("JTAG interface has to be specified, see \"interface\" command");
1868 return ERROR_JTAG_INVALID_INTERFACE;
1869 }
1870 if(hasKHz)
1871 {
1872 jtag_interface->khz(speed_khz, &jtag_speed);
1873 hasKHz = 0;
1874 }
1875
1876 if (jtag_interface->init() != ERROR_OK)
1877 return ERROR_JTAG_INIT_FAILED;
1878
1879 jtag = jtag_interface;
1880 return ERROR_OK;
1881 }
1882
1883 static int jtag_init_inner(struct command_context_s *cmd_ctx)
1884 {
1885 jtag_tap_t *tap;
1886 int retval;
1887
1888 LOG_DEBUG("Init JTAG chain");
1889
1890 tap = jtag_NextEnabledTap(NULL);
1891 if( tap == NULL ){
1892 LOG_ERROR("There are no enabled taps?");
1893 return ERROR_JTAG_INIT_FAILED;
1894 }
1895
1896 jtag_add_tlr();
1897 if ((retval=jtag_execute_queue())!=ERROR_OK)
1898 return retval;
1899
1900 /* examine chain first, as this could discover the real chain layout */
1901 if (jtag_examine_chain() != ERROR_OK)
1902 {
1903 LOG_ERROR("trying to validate configured JTAG chain anyway...");
1904 }
1905
1906 if (jtag_validate_chain() != ERROR_OK)
1907 {
1908 LOG_WARNING("Could not validate JTAG chain, continuing anyway...");
1909 }
1910
1911 return ERROR_OK;
1912 }
1913
1914 int jtag_interface_quit(void)
1915 {
1916 if (!jtag || !jtag->quit)
1917 return ERROR_OK;
1918
1919 // close the JTAG interface
1920 int result = jtag->quit();
1921 if (ERROR_OK != result)
1922 LOG_ERROR("failed: %d", result);
1923
1924 return ERROR_OK;
1925 }
1926
1927
1928 int jtag_init_reset(struct command_context_s *cmd_ctx)
1929 {
1930 int retval;
1931
1932 if ((retval=jtag_interface_init(cmd_ctx)) != ERROR_OK)
1933 return retval;
1934
1935 LOG_DEBUG("Trying to bring the JTAG controller to life by asserting TRST / RESET");
1936
1937 /* Reset can happen after a power cycle.
1938 *
1939 * Ideally we would only assert TRST or run RESET before the target reset.
1940 *
1941 * However w/srst_pulls_trst, trst is asserted together with the target
1942 * reset whether we want it or not.
1943 *
1944 * NB! Some targets have JTAG circuitry disabled until a
1945 * trst & srst has been asserted.
1946 *
1947 * NB! here we assume nsrst/ntrst delay are sufficient!
1948 *
1949 * NB! order matters!!!! srst *can* disconnect JTAG circuitry
1950 *
1951 */
1952 jtag_add_reset(1, 0); /* RESET or TRST */
1953 if (jtag_reset_config & RESET_HAS_SRST)
1954 {
1955 jtag_add_reset(1, 1);
1956 if ((jtag_reset_config & RESET_SRST_PULLS_TRST)==0)
1957 jtag_add_reset(0, 1);
1958 }
1959 jtag_add_reset(0, 0);
1960 if ((retval = jtag_execute_queue()) != ERROR_OK)
1961 return retval;
1962
1963 /* Check that we can communication on the JTAG chain + eventually we want to
1964 * be able to perform enumeration only after OpenOCD has started
1965 * telnet and GDB server
1966 *
1967 * That would allow users to more easily perform any magic they need to before
1968 * reset happens.
1969 */
1970 return jtag_init_inner(cmd_ctx);
1971 }
1972
1973 int jtag_init(struct command_context_s *cmd_ctx)
1974 {
1975 int retval;
1976 if ((retval=jtag_interface_init(cmd_ctx)) != ERROR_OK)
1977 return retval;
1978 if (jtag_init_inner(cmd_ctx)==ERROR_OK)
1979 {
1980 return ERROR_OK;
1981 }
1982 return jtag_init_reset(cmd_ctx);
1983 }
1984
1985 static int default_khz(int khz, int *jtag_speed)
1986 {
1987 LOG_ERROR("Translation from khz to jtag_speed not implemented");
1988 return ERROR_FAIL;
1989 }
1990
1991 static int default_speed_div(int speed, int *khz)
1992 {
1993 LOG_ERROR("Translation from jtag_speed to khz not implemented");
1994 return ERROR_FAIL;
1995 }
1996
1997 static int default_power_dropout(int *dropout)
1998 {
1999 *dropout=0; /* by default we can't detect power dropout */
2000 return ERROR_OK;
2001 }
2002
2003 static int default_srst_asserted(int *srst_asserted)
2004 {
2005 *srst_asserted=0; /* by default we can't detect srst asserted */
2006 return ERROR_OK;
2007 }
2008
2009 static int handle_interface_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2010 {
2011 int i;
2012 int retval;
2013
2014 /* check whether the interface is already configured */
2015 if (jtag_interface)
2016 {
2017 LOG_WARNING("Interface already configured, ignoring");
2018 return ERROR_OK;
2019 }
2020
2021 /* interface name is a mandatory argument */
2022 if (argc < 1 || args[0][0] == '\0')
2023 {
2024 return ERROR_COMMAND_SYNTAX_ERROR;
2025 }
2026
2027 for (i=0; jtag_interfaces[i]; i++)
2028 {
2029 if (strcmp(args[0], jtag_interfaces[i]->name) == 0)
2030 {
2031 if ((retval = jtag_interfaces[i]->register_commands(cmd_ctx)) != ERROR_OK)
2032 {
2033 return retval;
2034 }
2035
2036 jtag_interface = jtag_interfaces[i];
2037
2038 if (jtag_interface->khz == NULL)
2039 {
2040 jtag_interface->khz = default_khz;
2041 }
2042 if (jtag_interface->speed_div == NULL)
2043 {
2044 jtag_interface->speed_div = default_speed_div;
2045 }
2046 if (jtag_interface->power_dropout == NULL)
2047 {
2048 jtag_interface->power_dropout = default_power_dropout;
2049 }
2050 if (jtag_interface->srst_asserted == NULL)
2051 {
2052 jtag_interface->srst_asserted = default_srst_asserted;
2053 }
2054
2055 return ERROR_OK;
2056 }
2057 }
2058
2059 /* no valid interface was found (i.e. the configuration option,
2060 * didn't match one of the compiled-in interfaces
2061 */
2062 LOG_ERROR("No valid jtag interface found (%s)", args[0]);
2063 LOG_ERROR("compiled-in jtag interfaces:");
2064 for (i = 0; jtag_interfaces[i]; i++)
2065 {
2066 LOG_ERROR("%i: %s", i, jtag_interfaces[i]->name);
2067 }
2068
2069 return ERROR_JTAG_INVALID_INTERFACE;
2070 }
2071
2072 static int handle_jtag_device_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2073 {
2074 int e;
2075 char buf[1024];
2076 Jim_Obj *newargs[ 10 ];
2077 /*
2078 * CONVERT SYNTAX
2079 * argv[-1] = command
2080 * argv[ 0] = ir length
2081 * argv[ 1] = ir capture
2082 * argv[ 2] = ir mask
2083 * argv[ 3] = not actually used by anything but in the docs
2084 */
2085
2086 if( argc < 4 ){
2087 command_print( cmd_ctx, "OLD DEPRECATED SYNTAX: Please use the NEW syntax");
2088 return ERROR_OK;
2089 }
2090 command_print( cmd_ctx, "OLD SYNTAX: DEPRECATED - translating to new syntax");
2091 command_print( cmd_ctx, "jtag newtap CHIP TAP -irlen %s -ircapture %s -irvalue %s",
2092 args[0],
2093 args[1],
2094 args[2] );
2095 command_print( cmd_ctx, "Example: STM32 has 2 taps, the cortexM3(len4) + boundaryscan(len5)");
2096 command_print( cmd_ctx, "jtag newtap stm32 cortexm3 ....., thus creating the tap: \"stm32.cortexm3\"");
2097 command_print( cmd_ctx, "jtag newtap stm32 boundary ....., and the tap: \"stm32.boundary\"");
2098 command_print( cmd_ctx, "And then refer to the taps by the dotted name.");
2099
2100 newargs[0] = Jim_NewStringObj( interp, "jtag", -1 );
2101 newargs[1] = Jim_NewStringObj( interp, "newtap", -1 );
2102 sprintf( buf, "chip%d", jtag_NumTotalTaps() );
2103 newargs[2] = Jim_NewStringObj( interp, buf, -1 );
2104 sprintf( buf, "tap%d", jtag_NumTotalTaps() );
2105 newargs[3] = Jim_NewStringObj( interp, buf, -1 );
2106 newargs[4] = Jim_NewStringObj( interp, "-irlen", -1 );
2107 newargs[5] = Jim_NewStringObj( interp, args[0], -1 );
2108 newargs[6] = Jim_NewStringObj( interp, "-ircapture", -1 );
2109 newargs[7] = Jim_NewStringObj( interp, args[1], -1 );
2110 newargs[8] = Jim_NewStringObj( interp, "-irmask", -1 );
2111 newargs[9] = Jim_NewStringObj( interp, args[2], -1 );
2112
2113 command_print( cmd_ctx, "NEW COMMAND:");
2114 sprintf( buf, "%s %s %s %s %s %s %s %s %s %s",
2115 Jim_GetString( newargs[0], NULL ),
2116 Jim_GetString( newargs[1], NULL ),
2117 Jim_GetString( newargs[2], NULL ),
2118 Jim_GetString( newargs[3], NULL ),
2119 Jim_GetString( newargs[4], NULL ),
2120 Jim_GetString( newargs[5], NULL ),
2121 Jim_GetString( newargs[6], NULL ),
2122 Jim_GetString( newargs[7], NULL ),
2123 Jim_GetString( newargs[8], NULL ),
2124 Jim_GetString( newargs[9], NULL ) );
2125
2126 e = jim_jtag_command( interp, 10, newargs );
2127 if( e != JIM_OK ){
2128 command_print( cmd_ctx, "%s", Jim_GetString( Jim_GetResult(interp), NULL ) );
2129 }
2130 return e;
2131 }
2132
2133 static int handle_scan_chain_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2134 {
2135 jtag_tap_t *tap;
2136
2137 tap = jtag_all_taps;
2138 command_print(cmd_ctx, " TapName | Enabled | IdCode Expected IrLen IrCap IrMask Instr ");
2139 command_print(cmd_ctx, "---|--------------------|---------|------------|------------|------|------|------|---------");
2140
2141 while( tap ){
2142 u32 expected, expected_mask, cur_instr, ii;
2143 expected = buf_get_u32(tap->expected, 0, tap->ir_length);
2144 expected_mask = buf_get_u32(tap->expected_mask, 0, tap->ir_length);
2145 cur_instr = buf_get_u32(tap->cur_instr, 0, tap->ir_length);
2146
2147 command_print(cmd_ctx,
2148 "%2d | %-18s | %c | 0x%08x | 0x%08x | 0x%02x | 0x%02x | 0x%02x | 0x%02x",
2149 tap->abs_chain_position,
2150 tap->dotted_name,
2151 tap->enabled ? 'Y' : 'n',
2152 tap->idcode,
2153 (tap->expected_ids_cnt > 0 ? tap->expected_ids[0] : 0),
2154 tap->ir_length,
2155 expected,
2156 expected_mask,
2157 cur_instr);
2158
2159 for (ii = 1; ii < tap->expected_ids_cnt; ii++) {
2160 command_print(cmd_ctx, " | | | | 0x%08x | | | | ",
2161 tap->expected_ids[ii]);
2162 }
2163
2164 tap = tap->next_tap;
2165 }
2166
2167 return ERROR_OK;
2168 }
2169
2170 static int handle_reset_config_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2171 {
2172 int new_cfg = 0;
2173 int mask = 0;
2174
2175 if (argc < 1)
2176 return ERROR_COMMAND_SYNTAX_ERROR;
2177
2178 /* Original versions cared about the order of these tokens:
2179 * reset_config signals [combination [trst_type [srst_type]]]
2180 * They also clobbered the previous configuration even on error.
2181 *
2182 * Here we don't care about the order, and only change values
2183 * which have been explicitly specified.
2184 */
2185 for (; argc; argc--, args++) {
2186 int tmp = 0;
2187 int m;
2188
2189 /* signals */
2190 m = RESET_HAS_TRST | RESET_HAS_SRST;
2191 if (strcmp(*args, "none") == 0)
2192 tmp = RESET_NONE;
2193 else if (strcmp(*args, "trst_only") == 0)
2194 tmp = RESET_HAS_TRST;
2195 else if (strcmp(*args, "srst_only") == 0)
2196 tmp = RESET_HAS_SRST;
2197 else if (strcmp(*args, "trst_and_srst") == 0)
2198 tmp = RESET_HAS_TRST | RESET_HAS_SRST;
2199 else
2200 m = 0;
2201 if (mask & m) {
2202 LOG_ERROR("extra reset_config %s spec (%s)",
2203 "signal", *args);
2204 return ERROR_INVALID_ARGUMENTS;
2205 }
2206 if (m)
2207 goto next;
2208
2209 /* combination (options for broken wiring) */
2210 m = RESET_SRST_PULLS_TRST | RESET_TRST_PULLS_SRST;
2211 if (strcmp(*args, "separate") == 0)
2212 /* separate reset lines - default */;
2213 else if (strcmp(*args, "srst_pulls_trst") == 0)
2214 tmp |= RESET_SRST_PULLS_TRST;
2215 else if (strcmp(*args, "trst_pulls_srst") == 0)
2216 tmp |= RESET_TRST_PULLS_SRST;
2217 else if (strcmp(*args, "combined") == 0)
2218 tmp |= RESET_SRST_PULLS_TRST | RESET_TRST_PULLS_SRST;
2219 else
2220 m = 0;
2221 if (mask & m) {
2222 LOG_ERROR("extra reset_config %s spec (%s)",
2223 "combination", *args);
2224 return ERROR_INVALID_ARGUMENTS;
2225 }
2226 if (m)
2227 goto next;
2228
2229 /* trst_type (NOP without HAS_TRST) */
2230 m = RESET_TRST_OPEN_DRAIN;
2231 if (strcmp(*args, "trst_open_drain") == 0)
2232 tmp |= RESET_TRST_OPEN_DRAIN;
2233 else if (strcmp(*args, "trst_push_pull") == 0)
2234 /* push/pull from adapter - default */;
2235 else
2236 m = 0;
2237 if (mask & m) {
2238 LOG_ERROR("extra reset_config %s spec (%s)",
2239 "trst_type", *args);
2240 return ERROR_INVALID_ARGUMENTS;
2241 }
2242 if (m)
2243 goto next;
2244
2245 /* srst_type (NOP without HAS_SRST) */
2246 m |= RESET_SRST_PUSH_PULL;
2247 if (strcmp(*args, "srst_push_pull") == 0)
2248 tmp |= RESET_SRST_PUSH_PULL;
2249 else if (strcmp(*args, "srst_open_drain") == 0)
2250 /* open drain from adapter - default */;
2251 else
2252 m = 0;
2253 if (mask & m) {
2254 LOG_ERROR("extra reset_config %s spec (%s)",
2255 "srst_type", *args);
2256 return ERROR_INVALID_ARGUMENTS;
2257 }
2258 if (m)
2259 goto next;
2260
2261 /* caller provided nonsense; fail */
2262 LOG_ERROR("unknown reset_config flag (%s)", *args);
2263 return ERROR_INVALID_ARGUMENTS;
2264
2265 next:
2266 /* Remember the bits which were specified (mask)
2267 * and their new values (new_cfg).
2268 */
2269 mask |= m;
2270 new_cfg |= tmp;
2271 }
2272
2273 /* clear previous values of those bits, save new values */
2274 jtag_reset_config &= ~mask;
2275 jtag_reset_config |= new_cfg;
2276
2277 return ERROR_OK;
2278 }
2279
2280 static int handle_jtag_nsrst_delay_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2281 {
2282 if (argc < 1)
2283 {
2284 LOG_ERROR("jtag_nsrst_delay <ms> command takes one required argument");
2285 exit(-1);
2286 }
2287 else
2288 {
2289 jtag_nsrst_delay = strtoul(args[0], NULL, 0);
2290 }
2291
2292 return ERROR_OK;
2293 }
2294
2295 static int handle_jtag_ntrst_delay_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2296 {
2297 if (argc < 1)
2298 {
2299 LOG_ERROR("jtag_ntrst_delay <ms> command takes one required argument");
2300 exit(-1);
2301 }
2302 else
2303 {
2304 jtag_ntrst_delay = strtoul(args[0], NULL, 0);
2305 }
2306
2307 return ERROR_OK;
2308 }
2309
2310 static int handle_jtag_speed_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2311 {
2312 int retval=ERROR_OK;
2313
2314 if (argc == 1)
2315 {
2316 LOG_DEBUG("handle jtag speed");
2317
2318 int cur_speed = 0;
2319 cur_speed = jtag_speed = strtoul(args[0], NULL, 0);
2320
2321 /* this command can be called during CONFIG,
2322 * in which case jtag isn't initialized */
2323 if (jtag)
2324 {
2325 retval=jtag->speed(cur_speed);
2326 }
2327 } else if (argc == 0)
2328 {
2329 } else
2330 {
2331 return ERROR_COMMAND_SYNTAX_ERROR;
2332 }
2333 command_print(cmd_ctx, "jtag_speed: %d", jtag_speed);
2334
2335 return retval;
2336 }
2337
2338 static int handle_jtag_khz_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2339 {
2340 int retval=ERROR_OK;
2341 LOG_DEBUG("handle jtag khz");
2342
2343 if(argc == 1)
2344 {
2345 speed_khz = strtoul(args[0], NULL, 0);
2346 if (jtag != NULL)
2347 {
2348 int cur_speed = 0;
2349 LOG_DEBUG("have interface set up");
2350 int speed_div1;
2351 if ((retval=jtag->khz(speed_khz, &speed_div1))!=ERROR_OK)
2352 {
2353 speed_khz = 0;
2354 return retval;
2355 }
2356
2357 cur_speed = jtag_speed = speed_div1;
2358
2359 retval=jtag->speed(cur_speed);
2360 } else
2361 {
2362 hasKHz = 1;
2363 }
2364 } else if (argc==0)
2365 {
2366 } else
2367 {
2368 return ERROR_COMMAND_SYNTAX_ERROR;
2369 }
2370
2371 if (jtag!=NULL)
2372 {
2373 if ((retval=jtag->speed_div(jtag_speed, &speed_khz))!=ERROR_OK)
2374 return retval;
2375 }
2376
2377 if (speed_khz==0)
2378 {
2379 command_print(cmd_ctx, "RCLK - adaptive");
2380 } else
2381 {
2382 command_print(cmd_ctx, "%d kHz", speed_khz);
2383 }
2384 return retval;
2385
2386 }
2387
2388 static int handle_endstate_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2389 {
2390 tap_state_t state;
2391
2392 if (argc < 1)
2393 {
2394 return ERROR_COMMAND_SYNTAX_ERROR;
2395 }
2396 else
2397 {
2398 state = tap_state_by_name( args[0] );
2399 if( state < 0 ){
2400 command_print( cmd_ctx, "Invalid state name: %s\n", args[0] );
2401 return ERROR_COMMAND_SYNTAX_ERROR;
2402 }
2403 jtag_add_end_state(state);
2404 jtag_execute_queue();
2405 }
2406 command_print(cmd_ctx, "current endstate: %s", tap_state_name(cmd_queue_end_state));
2407
2408 return ERROR_OK;
2409 }
2410
2411 static int handle_jtag_reset_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2412 {
2413 int trst = -1;
2414 int srst = -1;
2415
2416 if (argc < 2)
2417 {
2418 return ERROR_COMMAND_SYNTAX_ERROR;
2419 }
2420
2421 if (args[0][0] == '1')
2422 trst = 1;
2423 else if (args[0][0] == '0')
2424 trst = 0;
2425 else
2426 {
2427 return ERROR_COMMAND_SYNTAX_ERROR;
2428 }
2429
2430 if (args[1][0] == '1')
2431 srst = 1;
2432 else if (args[1][0] == '0')
2433 srst = 0;
2434 else
2435 {
2436 return ERROR_COMMAND_SYNTAX_ERROR;
2437 }
2438
2439 if (jtag_interface_init(cmd_ctx) != ERROR_OK)
2440 return ERROR_JTAG_INIT_FAILED;
2441
2442 jtag_add_reset(trst, srst);
2443 jtag_execute_queue();
2444
2445 return ERROR_OK;
2446 }
2447
2448 static int handle_runtest_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2449 {
2450 if (argc < 1)
2451 {
2452 return ERROR_COMMAND_SYNTAX_ERROR;
2453 }
2454
2455 jtag_add_runtest(strtol(args[0], NULL, 0), TAP_INVALID);
2456 jtag_execute_queue();
2457
2458 return ERROR_OK;
2459
2460 }
2461
2462 /*
2463 * For "irscan" or "drscan" commands, the "end" (really, "next") state
2464 * should be stable ... and *NOT* a shift state, otherwise free-running
2465 * jtag clocks could change the values latched by the update state.
2466 */
2467 static bool scan_is_safe(tap_state_t state)
2468 {
2469 switch (state)
2470 {
2471 case TAP_RESET:
2472 case TAP_IDLE:
2473 case TAP_DRPAUSE:
2474 case TAP_IRPAUSE:
2475 return true;
2476 default:
2477 return false;
2478 }
2479 }
2480
2481
2482 static int handle_irscan_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2483 {
2484 int i;
2485 scan_field_t *fields;
2486 jtag_tap_t *tap;
2487 tap_state_t endstate;
2488
2489 if ((argc < 2) || (argc % 2))
2490 {
2491 return ERROR_COMMAND_SYNTAX_ERROR;
2492 }
2493
2494 /* optional "-endstate" "statename" at the end of the arguments,
2495 * so that e.g. IRPAUSE can let us load the data register before
2496 * entering RUN/IDLE to execute the instruction we load here.
2497 */
2498 endstate = TAP_IDLE;
2499
2500 if( argc >= 4 ){
2501 /* have at least one pair of numbers. */
2502 /* is last pair the magic text? */
2503 if( 0 == strcmp( "-endstate", args[ argc - 2 ] ) ){
2504 const char *cpA;
2505 const char *cpS;
2506 cpA = args[ argc-1 ];
2507 for( endstate = 0 ; endstate < TAP_NUM_STATES ; endstate++ ){
2508 cpS = tap_state_name( endstate );
2509 if( 0 == strcmp( cpA, cpS ) ){
2510 break;
2511 }
2512 }
2513 if( endstate >= TAP_NUM_STATES ){
2514 return ERROR_COMMAND_SYNTAX_ERROR;
2515 } else {
2516 if (!scan_is_safe(endstate))
2517 LOG_WARNING("irscan with unsafe "
2518 "endstate \"%s\"", cpA);
2519 /* found - remove the last 2 args */
2520 argc -= 2;
2521 }
2522 }
2523 }
2524
2525 int num_fields = argc / 2;
2526
2527 fields = malloc(sizeof(scan_field_t) * num_fields);
2528
2529 for (i = 0; i < num_fields; i++)
2530 {
2531 tap = jtag_TapByString( args[i*2] );
2532 if (tap==NULL)
2533 {
2534 command_print( cmd_ctx, "Tap: %s unknown", args[i*2] );
2535 return ERROR_FAIL;
2536 }
2537 int field_size = tap->ir_length;
2538 fields[i].tap = tap;
2539 fields[i].num_bits = field_size;
2540 fields[i].out_value = malloc(CEIL(field_size, 8));
2541 buf_set_u32(fields[i].out_value, 0, field_size, strtoul(args[i*2+1], NULL, 0));
2542 fields[i].in_value = NULL;
2543 }
2544
2545 /* did we have an endstate? */
2546 jtag_add_ir_scan(num_fields, fields, endstate);
2547
2548 int retval=jtag_execute_queue();
2549
2550 for (i = 0; i < num_fields; i++)
2551 free(fields[i].out_value);
2552
2553 free (fields);
2554
2555 return retval;
2556 }
2557
2558 static int Jim_Command_drscan(Jim_Interp *interp, int argc, Jim_Obj *const *args)
2559 {
2560 int retval;
2561 scan_field_t *fields;
2562 int num_fields;
2563 int field_count = 0;
2564 int i, e;
2565 jtag_tap_t *tap;
2566 tap_state_t endstate;
2567
2568 /* args[1] = device
2569 * args[2] = num_bits
2570 * args[3] = hex string
2571 * ... repeat num bits and hex string ...
2572 *
2573 * .. optionally:
2574 * args[N-2] = "-endstate"
2575 * args[N-1] = statename
2576 */
2577 if ((argc < 4) || ((argc % 2)!=0))
2578 {
2579 Jim_WrongNumArgs(interp, 1, args, "wrong arguments");
2580 return JIM_ERR;
2581 }
2582
2583 endstate = TAP_IDLE;
2584
2585 /* validate arguments as numbers */
2586 e = JIM_OK;
2587 for (i = 2; i < argc; i+=2)
2588 {
2589 long bits;
2590 const char *cp;
2591
2592 e = Jim_GetLong(interp, args[i], &bits);
2593 /* If valid - try next arg */
2594 if( e == JIM_OK ){
2595 continue;
2596 }
2597
2598 /* Not valid.. are we at the end? */
2599 if ( ((i+2) != argc) ){
2600 /* nope, then error */
2601 return e;
2602 }
2603
2604 /* it could be: "-endstate FOO"
2605 * e.g. DRPAUSE so we can issue more instructions
2606 * before entering RUN/IDLE and executing them.
2607 */
2608
2609 /* get arg as a string. */
2610 cp = Jim_GetString( args[i], NULL );
2611 /* is it the magic? */
2612 if( 0 == strcmp( "-endstate", cp ) ){
2613 /* is the statename valid? */
2614 cp = Jim_GetString( args[i+1], NULL );
2615
2616 /* see if it is a valid state name */
2617 endstate = tap_state_by_name(cp);
2618 if( endstate < 0 ){
2619 /* update the error message */
2620 Jim_SetResult_sprintf(interp,"endstate: %s invalid", cp );
2621 } else {
2622 if (!scan_is_safe(endstate))
2623 LOG_WARNING("drscan with unsafe "
2624 "endstate \"%s\"", cp);
2625
2626 /* valid - so clear the error */
2627 e = JIM_OK;
2628 /* and remove the last 2 args */
2629 argc -= 2;
2630 }
2631 }
2632
2633 /* Still an error? */
2634 if( e != JIM_OK ){
2635 return e; /* too bad */
2636 }
2637 } /* validate args */
2638
2639 tap = jtag_TapByJimObj( interp, args[1] );
2640 if( tap == NULL ){
2641 return JIM_ERR;
2642 }
2643
2644 num_fields=(argc-2)/2;
2645 fields = malloc(sizeof(scan_field_t) * num_fields);
2646 for (i = 2; i < argc; i+=2)
2647 {
2648 long bits;
2649 int len;
2650 const char *str;
2651
2652 Jim_GetLong(interp, args[i], &bits);
2653 str = Jim_GetString(args[i+1], &len);
2654
2655 fields[field_count].tap = tap;
2656 fields[field_count].num_bits = bits;
2657 fields[field_count].out_value = malloc(CEIL(bits, 8));
2658 str_to_buf(str, len, fields[field_count].out_value, bits, 0);
2659 fields[field_count].in_value = fields[field_count].out_value;
2660 field_count++;
2661 }
2662
2663 jtag_add_dr_scan(num_fields, fields, endstate);
2664
2665 retval = jtag_execute_queue();
2666 if (retval != ERROR_OK)
2667 {
2668 Jim_SetResultString(interp, "drscan: jtag execute failed",-1);
2669 return JIM_ERR;
2670 }
2671
2672 field_count=0;
2673 Jim_Obj *list = Jim_NewListObj(interp, NULL, 0);
2674 for (i = 2; i < argc; i+=2)
2675 {
2676 long bits;
2677 char *str;
2678
2679 Jim_GetLong(interp, args[i], &bits);
2680 str = buf_to_str(fields[field_count].in_value, bits, 16);
2681 free(fields[field_count].out_value);
2682
2683 Jim_ListAppendElement(interp, list, Jim_NewStringObj(interp, str, strlen(str)));
2684 free(str);
2685 field_count++;
2686 }
2687
2688 Jim_SetResult(interp, list);
2689
2690 free(fields);
2691
2692 return JIM_OK;
2693 }
2694
2695
2696 static int Jim_Command_flush_count(Jim_Interp *interp, int argc, Jim_Obj *const *args)
2697 {
2698 Jim_SetResult(interp, Jim_NewIntObj(interp, jtag_flush_queue_count));
2699
2700 return JIM_OK;
2701 }
2702
2703
2704 static int handle_verify_ircapture_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2705 {
2706 if (argc == 1)
2707 {
2708 if (strcmp(args[0], "enable") == 0)
2709 {
2710 jtag_verify_capture_ir = 1;
2711 }
2712 else if (strcmp(args[0], "disable") == 0)
2713 {
2714 jtag_verify_capture_ir = 0;
2715 } else
2716 {
2717 return ERROR_COMMAND_SYNTAX_ERROR;
2718 }
2719 } else if (argc != 0)
2720 {
2721 return ERROR_COMMAND_SYNTAX_ERROR;
2722 }
2723
2724 command_print(cmd_ctx, "verify Capture-IR is %s", (jtag_verify_capture_ir) ? "enabled": "disabled");
2725
2726 return ERROR_OK;
2727 }
2728
2729 static int handle_verify_jtag_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2730 {
2731 if (argc == 1)
2732 {
2733 if (strcmp(args[0], "enable") == 0)
2734 {
2735 jtag_verify = 1;
2736 }
2737 else if (strcmp(args[0], "disable") == 0)
2738 {
2739 jtag_verify = 0;
2740 } else
2741 {
2742 return ERROR_COMMAND_SYNTAX_ERROR;
2743 }
2744 } else if (argc != 0)
2745 {
2746 return ERROR_COMMAND_SYNTAX_ERROR;
2747 }
2748
2749 command_print(cmd_ctx, "verify jtag capture is %s", (jtag_verify) ? "enabled": "disabled");
2750
2751 return ERROR_OK;
2752 }
2753
2754
2755 int jtag_power_dropout(int *dropout)
2756 {
2757 return jtag->power_dropout(dropout);
2758 }
2759
2760 int jtag_srst_asserted(int *srst_asserted)
2761 {
2762 return jtag->srst_asserted(srst_asserted);
2763 }
2764
2765 void jtag_tap_handle_event( jtag_tap_t * tap, enum jtag_tap_event e)
2766 {
2767 jtag_tap_event_action_t * jteap;
2768 int done;
2769
2770 jteap = tap->event_action;
2771
2772 done = 0;
2773 while (jteap) {
2774 if (jteap->event == e) {
2775 done = 1;
2776 LOG_DEBUG( "JTAG tap: %s event: %d (%s) action: %s\n",
2777 tap->dotted_name,
2778 e,
2779 Jim_Nvp_value2name_simple(nvp_jtag_tap_event, e)->name,
2780 Jim_GetString(jteap->body, NULL) );
2781 if (Jim_EvalObj(interp, jteap->body) != JIM_OK) {
2782 Jim_PrintErrorMessage(interp);
2783 }
2784 }
2785
2786 jteap = jteap->next;
2787 }
2788
2789 if (!done) {
2790 LOG_DEBUG( "event %d %s - no action",
2791 e,
2792 Jim_Nvp_value2name_simple( nvp_jtag_tap_event, e)->name);
2793 }
2794 }
2795
2796 /*-----<Cable Helper API>---------------------------------------*/
2797
2798 /* these Cable Helper API functions are all documented in the jtag.h header file,
2799 using a Doxygen format. And since Doxygen's configuration file "Doxyfile",
2800 is setup to prefer its docs in the header file, no documentation is here, for
2801 if it were, it would have to be doubly maintained.
2802 */
2803
2804 /**
2805 * @see tap_set_state() and tap_get_state() accessors.
2806 * Actual name is not important since accessors hide it.
2807 */
2808 static tap_state_t state_follower = TAP_RESET;
2809
2810 void tap_set_state_impl( tap_state_t new_state )
2811 {
2812 /* this is the state we think the TAPs are in now, was cur_state */
2813 state_follower = new_state;
2814 }
2815
2816 tap_state_t tap_get_state()
2817 {
2818 return state_follower;
2819 }
2820
2821 /**
2822 * @see tap_set_end_state() and tap_get_end_state() accessors.
2823 * Actual name is not important because accessors hide it.
2824 */
2825 static tap_state_t end_state_follower = TAP_RESET;
2826
2827 void tap_set_end_state( tap_state_t new_end_state )
2828 {
2829 /* this is the state we think the TAPs will be in at completion of the
2830 current TAP operation, was end_state
2831 */
2832 end_state_follower = new_end_state;
2833 }
2834
2835 tap_state_t tap_get_end_state()
2836 {
2837 return end_state_follower;
2838 }
2839
2840
2841 int tap_move_ndx( tap_state_t astate )
2842 {
2843 /* given a stable state, return the index into the tms_seqs[] array within tap_get_tms_path() */
2844
2845 int ndx;
2846
2847 switch( astate )
2848 {
2849 case TAP_RESET: ndx = 0; break;
2850 case TAP_DRSHIFT: ndx = 2; break;
2851 case TAP_DRPAUSE: ndx = 3; break;
2852 case TAP_IDLE: ndx = 1; break;
2853 case TAP_IRSHIFT: ndx = 4; break;
2854 case TAP_IRPAUSE: ndx = 5; break;
2855 default:
2856 LOG_ERROR( "fatal: unstable state \"%s\" used in tap_move_ndx()", tap_state_name(astate) );
2857 exit(1);
2858 }
2859
2860 return ndx;
2861 }
2862
2863
2864 /* tap_move[i][j]: tap movement command to go from state i to state j
2865 * 0: Test-Logic-Reset
2866 * 1: Run-Test/Idle
2867 * 2: Shift-DR
2868 * 3: Pause-DR
2869 * 4: Shift-IR
2870 * 5: Pause-IR
2871 *
2872 * DRSHIFT->DRSHIFT and IRSHIFT->IRSHIFT have to be caught in interface specific code
2873 */
2874 struct tms_sequences
2875 {
2876 u8 bits;
2877 u8 bit_count;
2878
2879 };
2880
2881 /*
2882 * These macros allow us to specify TMS state transitions by bits rather than hex bytes.
2883 * Read the bits from LSBit first to MSBit last (right-to-left).
2884 */
2885 #define HEX__(n) 0x##n##LU
2886
2887 #define B8__(x) \
2888 (((x) & 0x0000000FLU)?(1<<0):0) \
2889 +(((x) & 0x000000F0LU)?(1<<1):0) \
2890 +(((x) & 0x00000F00LU)?(1<<2):0) \
2891 +(((x) & 0x0000F000LU)?(1<<3):0) \
2892 +(((x) & 0x000F0000LU)?(1<<4):0) \
2893 +(((x) & 0x00F00000LU)?(1<<5):0) \
2894 +(((x) & 0x0F000000LU)?(1<<6):0) \
2895 +(((x) & 0xF0000000LU)?(1<<7):0)
2896
2897 #define B8(bits,count) { ((u8)B8__(HEX__(bits))), (count) }
2898
2899 static const struct tms_sequences old_tms_seqs[6][6] = /* [from_state_ndx][to_state_ndx] */
2900 {
2901 /* value clocked to TMS to move from one of six stable states to another.
2902 * N.B. OOCD clocks TMS from LSB first, so read these right-to-left.
2903 * N.B. These values are tightly bound to the table in tap_get_tms_path_len().
2904 * N.B. Reset only needs to be 0b11111, but in JLink an even byte of 1's is more stable.
2905 * These extra ones cause no TAP state problem, because we go into reset and stay in reset.
2906 */
2907
2908
2909
2910 /* to state: */
2911 /* RESET IDLE DRSHIFT DRPAUSE IRSHIFT IRPAUSE */ /* from state: */
2912 { B8(1111111,7), B8(0000000,7), B8(0010111,7), B8(0001010,7), B8(0011011,7), B8(0010110,7) }, /* RESET */
2913 { B8(1111111,7), B8(0000000,7), B8(0100101,7), B8(0000101,7), B8(0101011,7), B8(0001011,7) }, /* IDLE */
2914 { B8(1111111,7), B8(0110001,7), B8(0000000,7), B8(0000001,7), B8(0001111,7), B8(0101111,7) }, /* DRSHIFT */
2915 { B8(1111111,7), B8(0110000,7), B8(0100000,7), B8(0010111,7), B8(0011110,7), B8(0101111,7) }, /* DRPAUSE */
2916 { B8(1111111,7), B8(0110001,7), B8(0000111,7), B8(0010111,7), B8(0000000,7), B8(0000001,7) }, /* IRSHIFT */
2917 { B8(1111111,7), B8(0110000,7), B8(0011100,7), B8(0010111,7), B8(0011110,7), B8(0101111,7) }, /* IRPAUSE */
2918 };
2919
2920
2921
2922 static const struct tms_sequences short_tms_seqs[6][6] = /* [from_state_ndx][to_state_ndx] */
2923 {
2924 /* this is the table submitted by Jeff Williams on 3/30/2009 with this comment:
2925
2926 OK, I added Peter's version of the state table, and it works OK for
2927 me on MC1322x. I've recreated the jlink portion of patch with this
2928 new state table. His changes to my state table are pretty minor in
2929 terms of total transitions, but Peter feels that his version fixes
2930 some long-standing problems.
2931 Jeff
2932
2933 I added the bit count into the table, reduced RESET column to 7 bits from 8.
2934 Dick
2935
2936 state specific comments:
2937 ------------------------
2938 *->RESET tried the 5 bit reset and it gave me problems, 7 bits seems to
2939 work better on ARM9 with ft2232 driver. (Dick)
2940
2941 RESET->DRSHIFT add 1 extra clock cycles in the RESET state before advancing.
2942 needed on ARM9 with ft2232 driver. (Dick)
2943
2944 RESET->IRSHIFT add 1 extra clock cycles in the RESET state before advancing.
2945 needed on ARM9 with ft2232 driver. (Dick)
2946 */
2947
2948 /* to state: */
2949 /* RESET IDLE DRSHIFT DRPAUSE IRSHIFT IRPAUSE */ /* from state: */
2950 { B8(1111111,7), B8(0000000,7), B8(0010111,7), B8(0001010,7), B8(0011011,7), B8(0010110,7) }, /* RESET */
2951 { B8(1111111,7), B8(0000000,7), B8(001,3), B8(0101,4), B8(0011,4), B8(01011,5) }, /* IDLE */
2952 { B8(1111111,7), B8(011,3), B8(00111,5), B8(01,2), B8(001111,6), B8(0101111,7) }, /* DRSHIFT */
2953 { B8(1111111,7), B8(011,3), B8(01,2), B8(0,1), B8(001111,6), B8(0101111,7) }, /* DRPAUSE */
2954 { B8(1111111,7), B8(011,3), B8(00111,5), B8(010111,6), B8(001111,6), B8(01,2) }, /* IRSHIFT */
2955 { B8(1111111,7), B8(011,3), B8(00111,5), B8(010111,6), B8(01,2), B8(0,1) } /* IRPAUSE */
2956
2957 };
2958
2959 typedef const struct tms_sequences tms_table[6][6];
2960
2961 static tms_table *tms_seqs=&short_tms_seqs;
2962
2963 int tap_get_tms_path( tap_state_t from, tap_state_t to )
2964 {
2965 return (*tms_seqs)[tap_move_ndx(from)][tap_move_ndx(to)].bits;
2966 }
2967
2968
2969 int tap_get_tms_path_len( tap_state_t from, tap_state_t to )
2970 {
2971 return (*tms_seqs)[tap_move_ndx(from)][tap_move_ndx(to)].bit_count;
2972 }
2973
2974
2975 bool tap_is_state_stable(tap_state_t astate)
2976 {
2977 bool is_stable;
2978
2979 /* A switch() is used because it is symbol dependent
2980 (not value dependent like an array), and can also check bounds.
2981 */
2982 switch( astate )
2983 {
2984 case TAP_RESET:
2985 case TAP_IDLE:
2986 case TAP_DRSHIFT:
2987 case TAP_DRPAUSE:
2988 case TAP_IRSHIFT:
2989 case TAP_IRPAUSE:
2990 is_stable = true;
2991 break;
2992 default:
2993 is_stable = false;
2994 }
2995
2996 return is_stable;
2997 }
2998
2999 tap_state_t tap_state_transition(tap_state_t cur_state, bool tms)
3000 {
3001 tap_state_t new_state;
3002
3003 /* A switch is used because it is symbol dependent and not value dependent
3004 like an array. Also it can check for out of range conditions.
3005 */
3006
3007 if (tms)
3008 {
3009 switch (cur_state)
3010 {
3011 case TAP_RESET:
3012 new_state = cur_state;
3013 break;
3014 case TAP_IDLE:
3015 case TAP_DRUPDATE:
3016 case TAP_IRUPDATE:
3017 new_state = TAP_DRSELECT;
3018 break;
3019 case TAP_DRSELECT:
3020 new_state = TAP_IRSELECT;
3021 break;
3022 case TAP_DRCAPTURE:
3023 case TAP_DRSHIFT:
3024 new_state = TAP_DREXIT1;
3025 break;
3026 case TAP_DREXIT1:
3027 case TAP_DREXIT2:
3028 new_state = TAP_DRUPDATE;
3029 break;
3030 case TAP_DRPAUSE:
3031 new_state = TAP_DREXIT2;
3032 break;
3033 case TAP_IRSELECT:
3034 new_state = TAP_RESET;
3035 break;
3036 case TAP_IRCAPTURE:
3037 case TAP_IRSHIFT:
3038 new_state = TAP_IREXIT1;
3039 break;
3040 case TAP_IREXIT1:
3041 case TAP_IREXIT2:
3042 new_state = TAP_IRUPDATE;
3043 break;
3044 case TAP_IRPAUSE:
3045 new_state = TAP_IREXIT2;
3046 break;
3047 default:
3048 LOG_ERROR( "fatal: invalid argument cur_state=%d", cur_state );
3049 exit(1);
3050 break;
3051 }
3052 }
3053 else
3054 {
3055 switch (cur_state)
3056 {
3057 case TAP_RESET:
3058 case TAP_IDLE:
3059 case TAP_DRUPDATE:
3060 case TAP_IRUPDATE:
3061 new_state = TAP_IDLE;
3062 break;
3063 case TAP_DRSELECT:
3064 new_state = TAP_DRCAPTURE;
3065 break;
3066 case TAP_DRCAPTURE:
3067 case TAP_DRSHIFT:
3068 case TAP_DREXIT2:
3069 new_state = TAP_DRSHIFT;
3070 break;
3071 case TAP_DREXIT1:
3072 case TAP_DRPAUSE:
3073 new_state = TAP_DRPAUSE;
3074 break;
3075 case TAP_IRSELECT:
3076 new_state = TAP_IRCAPTURE;
3077 break;
3078 case TAP_IRCAPTURE:
3079 case TAP_IRSHIFT:
3080 case TAP_IREXIT2:
3081 new_state = TAP_IRSHIFT;
3082 break;
3083 case TAP_IREXIT1:
3084 case TAP_IRPAUSE:
3085 new_state = TAP_IRPAUSE;
3086 break;
3087 default:
3088 LOG_ERROR( "fatal: invalid argument cur_state=%d", cur_state );
3089 exit(1);
3090 break;
3091 }
3092 }
3093
3094 return new_state;
3095 }
3096
3097 const char* tap_state_name(tap_state_t state)
3098 {
3099 const char* ret;
3100
3101 switch( state )
3102 {
3103 case TAP_RESET: ret = "RESET"; break;
3104 case TAP_IDLE: ret = "RUN/IDLE"; break;
3105 case TAP_DRSELECT: ret = "DRSELECT"; break;
3106 case TAP_DRCAPTURE: ret = "DRCAPTURE"; break;
3107 case TAP_DRSHIFT: ret = "DRSHIFT"; break;
3108 case TAP_DREXIT1: ret = "DREXIT1"; break;
3109 case TAP_DRPAUSE: ret = "DRPAUSE"; break;
3110 case TAP_DREXIT2: ret = "DREXIT2"; break;
3111 case TAP_DRUPDATE: ret = "DRUPDATE"; break;
3112 case TAP_IRSELECT: ret = "IRSELECT"; break;
3113 case TAP_IRCAPTURE: ret = "IRCAPTURE"; break;
3114 case TAP_IRSHIFT: ret = "IRSHIFT"; break;
3115 case TAP_IREXIT1: ret = "IREXIT1"; break;
3116 case TAP_IRPAUSE: ret = "IRPAUSE"; break;
3117 case TAP_IREXIT2: ret = "IREXIT2"; break;
3118 case TAP_IRUPDATE: ret = "IRUPDATE"; break;
3119 default: ret = "???";
3120 }
3121
3122 return ret;
3123 }
3124
3125 static tap_state_t tap_state_by_name( const char *name )
3126 {
3127 tap_state_t x;
3128
3129 for( x = 0 ; x < TAP_NUM_STATES ; x++ ){
3130 /* be nice to the human */
3131 if( 0 == strcasecmp( name, tap_state_name(x) ) ){
3132 return x;
3133 }
3134 }
3135 /* not found */
3136 return TAP_INVALID;
3137 }
3138
3139 #ifdef _DEBUG_JTAG_IO_
3140
3141 #define JTAG_DEBUG_STATE_APPEND(buf, len, bit) \
3142 do { buf[len] = bit ? '1' : '0'; } while(0)
3143 #define JTAG_DEBUG_STATE_PRINT(a, b, astr, bstr) \
3144 DEBUG_JTAG_IO("TAP/SM: %9s -> %5s\tTMS: %s\tTDI: %s", \
3145 tap_state_name(a), tap_state_name(b), astr, bstr)
3146
3147 tap_state_t jtag_debug_state_machine(const void *tms_buf, const void *tdi_buf,
3148 unsigned tap_bits, tap_state_t next_state)
3149 {
3150 const u8 *tms_buffer;
3151 const u8 *tdi_buffer;
3152 unsigned tap_bytes;
3153 unsigned cur_byte;
3154 unsigned cur_bit;
3155
3156 unsigned tap_out_bits;
3157 char tms_str[33];
3158 char tdi_str[33];
3159
3160 tap_state_t last_state;
3161
3162 // set startstate (and possibly last, if tap_bits == 0)
3163 last_state = next_state;
3164 DEBUG_JTAG_IO("TAP/SM: START state: %s", tap_state_name(next_state));
3165
3166 tms_buffer = (const u8 *)tms_buf;
3167 tdi_buffer = (const u8 *)tdi_buf;
3168
3169 tap_bytes = TAP_SCAN_BYTES(tap_bits);
3170 DEBUG_JTAG_IO("TAP/SM: TMS bits: %u (bytes: %u)", tap_bits, tap_bytes);
3171
3172 tap_out_bits = 0;
3173 for(cur_byte = 0; cur_byte < tap_bytes; cur_byte++)
3174 {
3175 for(cur_bit = 0; cur_bit < 8; cur_bit++)
3176 {
3177 // make sure we do not run off the end of the buffers
3178 unsigned tap_bit = cur_byte * 8 + cur_bit;
3179 if (tap_bit == tap_bits)
3180 break;
3181
3182 // check and save TMS bit
3183 tap_bit = !!(tms_buffer[cur_byte] & (1 << cur_bit));
3184 JTAG_DEBUG_STATE_APPEND(tms_str, tap_out_bits, tap_bit);
3185
3186 // use TMS bit to find the next TAP state
3187 next_state = tap_state_transition(last_state, tap_bit);
3188
3189 // check and store TDI bit
3190 tap_bit = !!(tdi_buffer[cur_byte] & (1 << cur_bit));
3191 JTAG_DEBUG_STATE_APPEND(tdi_str, tap_out_bits, tap_bit);
3192
3193 // increment TAP bits
3194 tap_out_bits++;
3195
3196 // Only show TDO bits on state transitions, or
3197 // after some number of bits in the same state.
3198 if ((next_state == last_state) && (tap_out_bits < 32))
3199 continue;
3200
3201 // terminate strings and display state transition
3202 tms_str[tap_out_bits] = tdi_str[tap_out_bits] = 0;
3203 JTAG_DEBUG_STATE_PRINT(last_state, next_state, tms_str, tdi_str);
3204
3205 // reset state
3206 last_state = next_state;
3207 tap_out_bits = 0;
3208 }
3209 }
3210
3211 if (tap_out_bits)
3212 {
3213 // terminate strings and display state transition
3214 tms_str[tap_out_bits] = tdi_str[tap_out_bits] = 0;
3215 JTAG_DEBUG_STATE_PRINT(last_state, next_state, tms_str, tdi_str);
3216 }
3217
3218 DEBUG_JTAG_IO("TAP/SM: FINAL state: %s", tap_state_name(next_state));
3219
3220 return next_state;
3221 }
3222 #endif // _DEBUG_JTAG_IO_
3223
3224 static int handle_tms_sequence_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
3225 {
3226 if (argc == 1)
3227 {
3228 if (strcmp(args[0], "short") == 0)
3229 {
3230 tms_seqs=&short_tms_seqs;
3231 }
3232 else if (strcmp(args[0], "long") == 0)
3233 {
3234 tms_seqs=&old_tms_seqs;
3235 } else
3236 {
3237 return ERROR_COMMAND_SYNTAX_ERROR;
3238 }
3239 } else if (argc != 0)
3240 {
3241 return ERROR_COMMAND_SYNTAX_ERROR;
3242 }
3243
3244 command_print(cmd_ctx, "tms sequence is %s", (tms_seqs==&short_tms_seqs) ? "short": "long");
3245
3246 return ERROR_OK;
3247 }
3248
3249 /*-----</Cable Helper API>--------------------------------------*/
3250
3251
3252 /**
3253 * Function jtag_add_statemove
3254 * moves from the current state to the goal \a state. This needs
3255 * to be handled according to the xsvf spec, see the XSTATE command
3256 * description.
3257 */
3258 int jtag_add_statemove(tap_state_t goal_state)
3259 {
3260 int retval = ERROR_OK;
3261
3262 tap_state_t moves[8];
3263 tap_state_t cur_state = cmd_queue_cur_state;
3264 int i;
3265 int tms_bits;
3266 int tms_count;
3267
3268 LOG_DEBUG( "cur_state=%s goal_state=%s",
3269 tap_state_name(cur_state),
3270 tap_state_name(goal_state) );
3271
3272
3273 /* From the XSVF spec, pertaining to XSTATE:
3274
3275 For special states known as stable states (Test-Logic-Reset,
3276 Run-Test/Idle, Pause-DR, Pause- IR), an XSVF interpreter follows
3277 predefined TAP state paths when the starting state is a stable state and
3278 when the XSTATE specifies a new stable state (see the STATE command in
3279 the [Ref 5] for the TAP state paths between stable states). For
3280 non-stable states, XSTATE should specify a state that is only one TAP
3281 state transition distance from the current TAP state to avoid undefined
3282 TAP state paths. A sequence of multiple XSTATE commands can be issued to
3283 transition the TAP through a specific state path.
3284 */
3285
3286 if (goal_state==cur_state )
3287 ; /* nothing to do */
3288
3289 else if( goal_state==TAP_RESET )
3290 {
3291 jtag_add_tlr();
3292 }
3293
3294 else if( tap_is_state_stable(cur_state) && tap_is_state_stable(goal_state) )
3295 {
3296 /* note: unless tms_bits holds a path that agrees with [Ref 5] in above
3297 spec, then this code is not fully conformant to the xsvf spec. This
3298 puts a burden on tap_get_tms_path() function from the xsvf spec.
3299 If in doubt, you should confirm that that burden is being met.
3300 */
3301
3302 tms_bits = tap_get_tms_path(cur_state, goal_state);
3303 tms_count = tap_get_tms_path_len(cur_state, goal_state);
3304
3305 assert( (unsigned) tms_count < DIM(moves) );
3306
3307 for (i=0; i<tms_count; i++, tms_bits>>=1)
3308 {
3309 bool bit = tms_bits & 1;
3310
3311 cur_state = tap_state_transition(cur_state, bit);
3312 moves[i] = cur_state;
3313 }
3314
3315 jtag_add_pathmove(tms_count, moves);
3316 }
3317
3318 /* else state must be immediately reachable in one clock cycle, and does not
3319 need to be a stable state.
3320 */
3321 else if( tap_state_transition(cur_state, true) == goal_state
3322 || tap_state_transition(cur_state, false) == goal_state )
3323 {
3324 /* move a single state */
3325 moves[0] = goal_state;
3326 jtag_add_pathmove( 1, moves );
3327 }
3328
3329 else
3330 {
3331 retval = ERROR_FAIL;
3332 }
3333
3334 return retval;
3335 }
3336
Open On-Chip Debugger

Linking to existing account procedure

If you already have an account and want to add another login method you MUST first sign in with your existing account and then change URL to read https://review.openocd.org/login/?link to get to this page again but this time it'll work for linking. Thank you.

SSH host keys fingerprints

1024 SHA256:YKx8b7u5ZWdcbp7/4AeXNaqElP49m6QrwfXaqQGJAOk gerrit-code-review@openocd.zylin.com (DSA)
384 SHA256:jHIbSQa4REvwCFG4cq5LBlBLxmxSqelQPem/EXIrxjk gerrit-code-review@openocd.org (ECDSA)
521 SHA256:UAOPYkU9Fjtcao0Ul/Rrlnj/OsQvt+pgdYSZ4jOYdgs gerrit-code-review@openocd.org (ECDSA)
256 SHA256:A13M5QlnozFOvTllybRZH6vm7iSt0XLxbA48yfc2yfY gerrit-code-review@openocd.org (ECDSA)
256 SHA256:spYMBqEYoAOtK7yZBrcwE8ZpYt6b68Cfh9yEVetvbXg gerrit-code-review@openocd.org (ED25519)
+--[ED25519 256]--+
|=..              |
|+o..   .         |
|*.o   . .        |
|+B . . .         |
|Bo. = o S        |
|Oo.+ + =         |
|oB=.* = . o      |
| =+=.+   + E     |
|. .=o   . o      |
+----[SHA256]-----+
2048 SHA256:0Onrb7/PHjpo6iVZ7xQX2riKN83FJ3KGU0TvI0TaFG4 gerrit-code-review@openocd.zylin.com (RSA)