Code Review / openocd.git / blob
? search:


15a5900c41c2151b1c1adcf0bfb5a2bb4fe83848
[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 * This program is free software; you can redistribute it and/or modify *
9 * it under the terms of the GNU General Public License as published by *
10 * the Free Software Foundation; either version 2 of the License, or *
11 * (at your option) any later version. *
12 * *
13 * This program is distributed in the hope that it will be useful, *
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
16 * GNU General Public License for more details. *
17 * *
18 * You should have received a copy of the GNU General Public License *
19 * along with this program; if not, write to the *
20 * Free Software Foundation, Inc., *
21 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
22 ***************************************************************************/
23 #ifdef HAVE_CONFIG_H
24 #include "config.h"
25 #endif
26
27 #include "replacements.h"
28
29 #include "jtag.h"
30
31 #include "command.h"
32 #include "log.h"
33
34 #include "stdlib.h"
35 #include "string.h"
36 #include <unistd.h>
37
38 /* note that this is not marked as static as it must be available from outside jtag.c for those
39 that implement the jtag_xxx() minidriver layer
40 */
41 int jtag_error=ERROR_OK;
42
43
44 char* tap_state_strings[16] =
45 {
46 "tlr",
47 "sds", "cd", "sd", "e1d", "pd", "e2d", "ud",
48 "rti",
49 "sis", "ci", "si", "e1i", "pi", "e2i", "ui"
50 };
51
52 typedef struct cmd_queue_page_s
53 {
54 void *address;
55 size_t used;
56 struct cmd_queue_page_s *next;
57 } cmd_queue_page_t;
58
59 #define CMD_QUEUE_PAGE_SIZE (1024 * 1024)
60 static cmd_queue_page_t *cmd_queue_pages = NULL;
61
62 /* tap_move[i][j]: tap movement command to go from state i to state j
63 * 0: Test-Logic-Reset
64 * 1: Run-Test/Idle
65 * 2: Shift-DR
66 * 3: Pause-DR
67 * 4: Shift-IR
68 * 5: Pause-IR
69 *
70 * SD->SD and SI->SI have to be caught in interface specific code
71 */
72 u8 tap_move[6][6] =
73 {
74 /* TLR RTI SD PD SI PI */
75 {0x7f, 0x00, 0x17, 0x0a, 0x1b, 0x16}, /* TLR */
76 {0x7f, 0x00, 0x25, 0x05, 0x2b, 0x0b}, /* RTI */
77 {0x7f, 0x31, 0x00, 0x01, 0x0f, 0x2f}, /* SD */
78 {0x7f, 0x30, 0x20, 0x17, 0x1e, 0x2f}, /* PD */
79 {0x7f, 0x31, 0x07, 0x17, 0x00, 0x01}, /* SI */
80 {0x7f, 0x30, 0x1c, 0x17, 0x20, 0x2f} /* PI */
81 };
82
83 int tap_move_map[16] = {
84 0, -1, -1, 2, -1, 3, -1, -1,
85 1, -1, -1, 4, -1, 5, -1, -1
86 };
87
88 tap_transition_t tap_transitions[16] =
89 {
90 {TAP_TLR, TAP_RTI}, /* TLR */
91 {TAP_SIS, TAP_CD}, /* SDS */
92 {TAP_E1D, TAP_SD}, /* CD */
93 {TAP_E1D, TAP_SD}, /* SD */
94 {TAP_UD, TAP_PD}, /* E1D */
95 {TAP_E2D, TAP_PD}, /* PD */
96 {TAP_UD, TAP_SD}, /* E2D */
97 {TAP_SDS, TAP_RTI}, /* UD */
98 {TAP_SDS, TAP_RTI}, /* RTI */
99 {TAP_TLR, TAP_CI}, /* SIS */
100 {TAP_E1I, TAP_SI}, /* CI */
101 {TAP_E1I, TAP_SI}, /* SI */
102 {TAP_UI, TAP_PI}, /* E1I */
103 {TAP_E2I, TAP_PI}, /* PI */
104 {TAP_UI, TAP_SI}, /* E2I */
105 {TAP_SDS, TAP_RTI} /* UI */
106 };
107
108 char* jtag_event_strings[] =
109 {
110 "JTAG controller reset (TLR or TRST)"
111 };
112
113 /* kludge!!!! these are just global variables that the
114 * interface use internally. They really belong
115 * inside the drivers, but we don't want to break
116 * linking the drivers!!!!
117 */
118 enum tap_state end_state = TAP_TLR;
119 enum tap_state cur_state = TAP_TLR;
120 int jtag_trst = 0;
121 int jtag_srst = 0;
122
123 jtag_command_t *jtag_command_queue = NULL;
124 jtag_command_t **last_comand_pointer = &jtag_command_queue;
125 jtag_device_t *jtag_devices = NULL;
126 int jtag_num_devices = 0;
127 int jtag_ir_scan_size = 0;
128 enum reset_types jtag_reset_config = RESET_NONE;
129 enum tap_state cmd_queue_end_state = TAP_TLR;
130 enum tap_state cmd_queue_cur_state = TAP_TLR;
131
132 int jtag_verify_capture_ir = 1;
133
134 /* how long the OpenOCD should wait before attempting JTAG communication after reset lines deasserted (in ms) */
135 int jtag_nsrst_delay = 0; /* default to no nSRST delay */
136 int jtag_ntrst_delay = 0; /* default to no nTRST delay */
137
138 /* maximum number of JTAG devices expected in the chain
139 */
140 #define JTAG_MAX_CHAIN_SIZE 20
141
142 /* callbacks to inform high-level handlers about JTAG state changes */
143 jtag_event_callback_t *jtag_event_callbacks;
144
145 /* speed in kHz*/
146 static int speed_khz = 0;
147 /* flag if the kHz speed was defined */
148 static int hasKHz = 0;
149
150 /* jtag interfaces (parport, FTDI-USB, TI-USB, ...)
151 */
152
153 #if BUILD_ECOSBOARD == 1
154 extern jtag_interface_t eCosBoard_interface;
155 #endif
156
157 #if BUILD_PARPORT == 1
158 extern jtag_interface_t parport_interface;
159 #endif
160
161 #if BUILD_DUMMY == 1
162 extern jtag_interface_t dummy_interface;
163 #endif
164
165 #if BUILD_FT2232_FTD2XX == 1
166 extern jtag_interface_t ft2232_interface;
167 #endif
168
169 #if BUILD_FT2232_LIBFTDI == 1
170 extern jtag_interface_t ft2232_interface;
171 #endif
172
173 #if BUILD_AMTJTAGACCEL == 1
174 extern jtag_interface_t amt_jtagaccel_interface;
175 #endif
176
177 #if BUILD_EP93XX == 1
178 extern jtag_interface_t ep93xx_interface;
179 #endif
180
181 #if BUILD_AT91RM9200 == 1
182 extern jtag_interface_t at91rm9200_interface;
183 #endif
184
185 #if BUILD_GW16012 == 1
186 extern jtag_interface_t gw16012_interface;
187 #endif
188
189 #if BUILD_PRESTO_LIBFTDI == 1 || BUILD_PRESTO_FTD2XX == 1
190 extern jtag_interface_t presto_interface;
191 #endif
192
193 #if BUILD_USBPROG == 1
194 extern jtag_interface_t usbprog_interface;
195 #endif
196
197 #if BUILD_JLINK == 1
198 extern jtag_interface_t jlink_interface;
199 #endif
200
201 jtag_interface_t *jtag_interfaces[] = {
202 #if BUILD_ECOSBOARD == 1
203 &eCosBoard_interface,
204 #endif
205 #if BUILD_PARPORT == 1
206 &parport_interface,
207 #endif
208 #if BUILD_DUMMY == 1
209 &dummy_interface,
210 #endif
211 #if BUILD_FT2232_FTD2XX == 1
212 &ft2232_interface,
213 #endif
214 #if BUILD_FT2232_LIBFTDI == 1
215 &ft2232_interface,
216 #endif
217 #if BUILD_AMTJTAGACCEL == 1
218 &amt_jtagaccel_interface,
219 #endif
220 #if BUILD_EP93XX == 1
221 &ep93xx_interface,
222 #endif
223 #if BUILD_AT91RM9200 == 1
224 &at91rm9200_interface,
225 #endif
226 #if BUILD_GW16012 == 1
227 &gw16012_interface,
228 #endif
229 #if BUILD_PRESTO_LIBFTDI == 1 || BUILD_PRESTO_FTD2XX == 1
230 &presto_interface,
231 #endif
232 #if BUILD_USBPROG == 1
233 &usbprog_interface,
234 #endif
235 #if BUILD_JLINK == 1
236 &jlink_interface,
237 #endif
238 NULL,
239 };
240
241 jtag_interface_t *jtag = NULL;
242
243 /* configuration */
244 jtag_interface_t *jtag_interface = NULL;
245 int jtag_speed = 0;
246
247
248
249 /* forward declarations */
250 void jtag_add_pathmove(int num_states, enum tap_state *path);
251 void jtag_add_runtest(int num_cycles, enum tap_state endstate);
252 void jtag_add_end_state(enum tap_state endstate);
253 void jtag_add_sleep(u32 us);
254 int jtag_execute_queue(void);
255 int jtag_cancel_queue(void);
256
257 /* jtag commands */
258 int handle_interface_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
259 int handle_jtag_speed_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
260 int handle_jtag_khz_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
261 int handle_jtag_device_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
262 int handle_reset_config_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
263 int handle_jtag_nsrst_delay_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
264 int handle_jtag_ntrst_delay_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
265
266 int handle_scan_chain_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
267
268 int handle_endstate_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
269 int handle_jtag_reset_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
270 int handle_runtest_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
271 int handle_irscan_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
272 int Jim_Command_drscan(Jim_Interp *interp, int argc, Jim_Obj *const *argv);
273
274 int handle_verify_ircapture_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
275
276 int jtag_register_event_callback(int (*callback)(enum jtag_event event, void *priv), void *priv)
277 {
278 jtag_event_callback_t **callbacks_p = &jtag_event_callbacks;
279
280 if (callback == NULL)
281 {
282 return ERROR_INVALID_ARGUMENTS;
283 }
284
285 if (*callbacks_p)
286 {
287 while ((*callbacks_p)->next)
288 callbacks_p = &((*callbacks_p)->next);
289 callbacks_p = &((*callbacks_p)->next);
290 }
291
292 (*callbacks_p) = malloc(sizeof(jtag_event_callback_t));
293 (*callbacks_p)->callback = callback;
294 (*callbacks_p)->priv = priv;
295 (*callbacks_p)->next = NULL;
296
297 return ERROR_OK;
298 }
299
300 int jtag_unregister_event_callback(int (*callback)(enum jtag_event event, void *priv))
301 {
302 jtag_event_callback_t **callbacks_p = &jtag_event_callbacks;
303
304 if (callback == NULL)
305 {
306 return ERROR_INVALID_ARGUMENTS;
307 }
308
309 while (*callbacks_p)
310 {
311 jtag_event_callback_t **next = &((*callbacks_p)->next);
312 if ((*callbacks_p)->callback == callback)
313 {
314 free(*callbacks_p);
315 *callbacks_p = *next;
316 }
317 callbacks_p = next;
318 }
319
320 return ERROR_OK;
321 }
322
323 int jtag_call_event_callbacks(enum jtag_event event)
324 {
325 jtag_event_callback_t *callback = jtag_event_callbacks;
326
327 LOG_DEBUG("jtag event: %s", jtag_event_strings[event]);
328
329 while (callback)
330 {
331 callback->callback(event, callback->priv);
332 callback = callback->next;
333 }
334
335 return ERROR_OK;
336 }
337
338 /* returns a pointer to the pointer of the last command in queue
339 * this may be a pointer to the root pointer (jtag_command_queue)
340 * or to the next member of the last but one command
341 */
342 jtag_command_t** jtag_get_last_command_p(void)
343 {
344 /* jtag_command_t *cmd = jtag_command_queue;
345
346 if (cmd)
347 while (cmd->next)
348 cmd = cmd->next;
349 else
350 return &jtag_command_queue;
351
352 return &cmd->next;*/
353
354 return last_comand_pointer;
355 }
356
357 /* returns a pointer to the n-th device in the scan chain */
358 jtag_device_t* jtag_get_device(int num)
359 {
360 jtag_device_t *device = jtag_devices;
361 int i = 0;
362
363 while (device)
364 {
365 if (num == i)
366 return device;
367 device = device->next;
368 i++;
369 }
370
371 LOG_ERROR("jtag device number %d not defined", num);
372 exit(-1);
373 }
374
375 void* cmd_queue_alloc(size_t size)
376 {
377 cmd_queue_page_t **p_page = &cmd_queue_pages;
378 int offset;
379 u8 *t;
380
381 if (*p_page)
382 {
383 while ((*p_page)->next)
384 p_page = &((*p_page)->next);
385 if (CMD_QUEUE_PAGE_SIZE - (*p_page)->used < size)
386 p_page = &((*p_page)->next);
387 }
388
389 if (!*p_page)
390 {
391 *p_page = malloc(sizeof(cmd_queue_page_t));
392 (*p_page)->used = 0;
393 (*p_page)->address = malloc(CMD_QUEUE_PAGE_SIZE);
394 (*p_page)->next = NULL;
395 }
396
397 offset = (*p_page)->used;
398 (*p_page)->used += size;
399
400 t=(u8 *)((*p_page)->address);
401 return t + offset;
402 }
403
404 void cmd_queue_free()
405 {
406 cmd_queue_page_t *page = cmd_queue_pages;
407
408 while (page)
409 {
410 cmd_queue_page_t *last = page;
411 free(page->address);
412 page = page->next;
413 free(last);
414 }
415
416 cmd_queue_pages = NULL;
417 }
418
419 static void jtag_prelude1()
420 {
421 if (jtag_trst == 1)
422 {
423 LOG_WARNING("JTAG command queued, while TRST is low (TAP in reset)");
424 jtag_error=ERROR_JTAG_TRST_ASSERTED;
425 return;
426 }
427
428 if (cmd_queue_end_state == TAP_TLR)
429 jtag_call_event_callbacks(JTAG_TRST_ASSERTED);
430 }
431
432 static void jtag_prelude(enum tap_state state)
433 {
434 jtag_prelude1();
435
436 if (state != -1)
437 jtag_add_end_state(state);
438
439 cmd_queue_cur_state = cmd_queue_end_state;
440 }
441
442 void jtag_add_ir_scan(int num_fields, scan_field_t *fields, enum tap_state state)
443 {
444 int retval;
445
446 jtag_prelude(state);
447
448 retval=interface_jtag_add_ir_scan(num_fields, fields, cmd_queue_end_state);
449 if (retval!=ERROR_OK)
450 jtag_error=retval;
451 }
452
453 int MINIDRIVER(interface_jtag_add_ir_scan)(int num_fields, scan_field_t *fields, enum tap_state state)
454 {
455 jtag_command_t **last_cmd;
456 jtag_device_t *device;
457 int i, j;
458 int scan_size = 0;
459
460
461 last_cmd = jtag_get_last_command_p();
462
463 /* allocate memory for a new list member */
464 *last_cmd = cmd_queue_alloc(sizeof(jtag_command_t));
465 (*last_cmd)->next = NULL;
466 last_comand_pointer = &((*last_cmd)->next);
467 (*last_cmd)->type = JTAG_SCAN;
468
469 /* allocate memory for ir scan command */
470 (*last_cmd)->cmd.scan = cmd_queue_alloc(sizeof(scan_command_t));
471 (*last_cmd)->cmd.scan->ir_scan = 1;
472 (*last_cmd)->cmd.scan->num_fields = jtag_num_devices; /* one field per device */
473 (*last_cmd)->cmd.scan->fields = cmd_queue_alloc(jtag_num_devices * sizeof(scan_field_t));
474 (*last_cmd)->cmd.scan->end_state = state;
475
476 for (i = 0; i < jtag_num_devices; i++)
477 {
478 int found = 0;
479 device = jtag_get_device(i);
480 scan_size = device->ir_length;
481 (*last_cmd)->cmd.scan->fields[i].device = i;
482 (*last_cmd)->cmd.scan->fields[i].num_bits = scan_size;
483 (*last_cmd)->cmd.scan->fields[i].in_value = NULL;
484 (*last_cmd)->cmd.scan->fields[i].in_handler = NULL; /* disable verification by default */
485
486 /* search the list */
487 for (j = 0; j < num_fields; j++)
488 {
489 if (i == fields[j].device)
490 {
491 found = 1;
492 (*last_cmd)->cmd.scan->fields[i].out_value = buf_cpy(fields[j].out_value, cmd_queue_alloc(CEIL(scan_size, 8)), scan_size);
493 (*last_cmd)->cmd.scan->fields[i].out_mask = buf_cpy(fields[j].out_mask, cmd_queue_alloc(CEIL(scan_size, 8)), scan_size);
494
495 if (jtag_verify_capture_ir)
496 {
497 if (fields[j].in_handler==NULL)
498 {
499 jtag_set_check_value((*last_cmd)->cmd.scan->fields+i, device->expected, device->expected_mask, NULL);
500 } else
501 {
502 (*last_cmd)->cmd.scan->fields[i].in_handler = fields[j].in_handler;
503 (*last_cmd)->cmd.scan->fields[i].in_handler_priv = fields[j].in_handler_priv;
504 (*last_cmd)->cmd.scan->fields[i].in_check_value = device->expected;
505 (*last_cmd)->cmd.scan->fields[i].in_check_mask = device->expected_mask;
506 }
507 }
508
509 device->bypass = 0;
510 break;
511 }
512 }
513
514 if (!found)
515 {
516 /* if a device isn't listed, set it to BYPASS */
517 (*last_cmd)->cmd.scan->fields[i].out_value = buf_set_ones(cmd_queue_alloc(CEIL(scan_size, 8)), scan_size);
518 (*last_cmd)->cmd.scan->fields[i].out_mask = NULL;
519 device->bypass = 1;
520
521 }
522
523 /* update device information */
524 buf_cpy((*last_cmd)->cmd.scan->fields[i].out_value, jtag_get_device(i)->cur_instr, scan_size);
525 }
526
527 return ERROR_OK;
528 }
529
530 void jtag_add_plain_ir_scan(int num_fields, scan_field_t *fields, enum tap_state state)
531 {
532 int retval;
533
534 jtag_prelude(state);
535
536 retval=interface_jtag_add_plain_ir_scan(num_fields, fields, cmd_queue_end_state);
537 if (retval!=ERROR_OK)
538 jtag_error=retval;
539 }
540
541 int MINIDRIVER(interface_jtag_add_plain_ir_scan)(int num_fields, scan_field_t *fields, enum tap_state state)
542 {
543 int i;
544 jtag_command_t **last_cmd;
545
546 last_cmd = jtag_get_last_command_p();
547
548 /* allocate memory for a new list member */
549 *last_cmd = cmd_queue_alloc(sizeof(jtag_command_t));
550 (*last_cmd)->next = NULL;
551 last_comand_pointer = &((*last_cmd)->next);
552 (*last_cmd)->type = JTAG_SCAN;
553
554 /* allocate memory for ir scan command */
555 (*last_cmd)->cmd.scan = cmd_queue_alloc(sizeof(scan_command_t));
556 (*last_cmd)->cmd.scan->ir_scan = 1;
557 (*last_cmd)->cmd.scan->num_fields = num_fields;
558 (*last_cmd)->cmd.scan->fields = cmd_queue_alloc(num_fields * sizeof(scan_field_t));
559 (*last_cmd)->cmd.scan->end_state = state;
560
561 for (i = 0; i < num_fields; i++)
562 {
563 int num_bits = fields[i].num_bits;
564 int num_bytes = CEIL(fields[i].num_bits, 8);
565 (*last_cmd)->cmd.scan->fields[i].device = fields[i].device;
566 (*last_cmd)->cmd.scan->fields[i].num_bits = num_bits;
567 (*last_cmd)->cmd.scan->fields[i].out_value = buf_cpy(fields[i].out_value, cmd_queue_alloc(num_bytes), num_bits);
568 (*last_cmd)->cmd.scan->fields[i].out_mask = buf_cpy(fields[i].out_mask, cmd_queue_alloc(num_bytes), num_bits);
569 (*last_cmd)->cmd.scan->fields[i].in_value = fields[i].in_value;
570 (*last_cmd)->cmd.scan->fields[i].in_check_value = fields[i].in_check_value;
571 (*last_cmd)->cmd.scan->fields[i].in_check_mask = fields[i].in_check_mask;
572 (*last_cmd)->cmd.scan->fields[i].in_handler = NULL;
573 (*last_cmd)->cmd.scan->fields[i].in_handler_priv = NULL;
574 }
575 return ERROR_OK;
576 }
577
578 void jtag_add_dr_scan(int num_fields, scan_field_t *fields, enum tap_state state)
579 {
580 int retval;
581
582 jtag_prelude(state);
583
584 retval=interface_jtag_add_dr_scan(num_fields, fields, cmd_queue_end_state);
585 if (retval!=ERROR_OK)
586 jtag_error=retval;
587 }
588
589 int MINIDRIVER(interface_jtag_add_dr_scan)(int num_fields, scan_field_t *fields, enum tap_state state)
590 {
591 int i, j;
592 int bypass_devices = 0;
593 int field_count = 0;
594 int scan_size;
595
596 jtag_command_t **last_cmd = jtag_get_last_command_p();
597 jtag_device_t *device = jtag_devices;
598
599 /* count devices in bypass */
600 while (device)
601 {
602 if (device->bypass)
603 bypass_devices++;
604 device = device->next;
605 }
606 if (bypass_devices >= jtag_num_devices)
607 {
608 LOG_ERROR("all devices in bypass");
609 return ERROR_JTAG_DEVICE_ERROR;
610 }
611
612 /* allocate memory for a new list member */
613 *last_cmd = cmd_queue_alloc(sizeof(jtag_command_t));
614 last_comand_pointer = &((*last_cmd)->next);
615 (*last_cmd)->next = NULL;
616 (*last_cmd)->type = JTAG_SCAN;
617
618 /* allocate memory for dr scan command */
619 (*last_cmd)->cmd.scan = cmd_queue_alloc(sizeof(scan_command_t));
620 (*last_cmd)->cmd.scan->ir_scan = 0;
621 (*last_cmd)->cmd.scan->num_fields = num_fields + bypass_devices;
622 (*last_cmd)->cmd.scan->fields = cmd_queue_alloc((num_fields + bypass_devices) * sizeof(scan_field_t));
623 (*last_cmd)->cmd.scan->end_state = state;
624
625 for (i = 0; i < jtag_num_devices; i++)
626 {
627 int found = 0;
628 (*last_cmd)->cmd.scan->fields[field_count].device = i;
629
630 for (j = 0; j < num_fields; j++)
631 {
632 if (i == fields[j].device)
633 {
634 found = 1;
635 scan_size = fields[j].num_bits;
636 (*last_cmd)->cmd.scan->fields[field_count].num_bits = scan_size;
637 (*last_cmd)->cmd.scan->fields[field_count].out_value = buf_cpy(fields[j].out_value, cmd_queue_alloc(CEIL(scan_size, 8)), scan_size);
638 (*last_cmd)->cmd.scan->fields[field_count].out_mask = buf_cpy(fields[j].out_mask, cmd_queue_alloc(CEIL(scan_size, 8)), scan_size);
639 (*last_cmd)->cmd.scan->fields[field_count].in_value = fields[j].in_value;
640 (*last_cmd)->cmd.scan->fields[field_count].in_check_value = fields[j].in_check_value;
641 (*last_cmd)->cmd.scan->fields[field_count].in_check_mask = fields[j].in_check_mask;
642 (*last_cmd)->cmd.scan->fields[field_count].in_handler = fields[j].in_handler;
643 (*last_cmd)->cmd.scan->fields[field_count++].in_handler_priv = fields[j].in_handler_priv;
644 }
645 }
646 if (!found)
647 {
648 #ifdef _DEBUG_JTAG_IO_
649 /* if a device isn't listed, the BYPASS register should be selected */
650 if (!jtag_get_device(i)->bypass)
651 {
652 LOG_ERROR("BUG: no scan data for a device not in BYPASS");
653 exit(-1);
654 }
655 #endif
656 /* program the scan field to 1 bit length, and ignore it's value */
657 (*last_cmd)->cmd.scan->fields[field_count].num_bits = 1;
658 (*last_cmd)->cmd.scan->fields[field_count].out_value = NULL;
659 (*last_cmd)->cmd.scan->fields[field_count].out_mask = NULL;
660 (*last_cmd)->cmd.scan->fields[field_count].in_value = NULL;
661 (*last_cmd)->cmd.scan->fields[field_count].in_check_value = NULL;
662 (*last_cmd)->cmd.scan->fields[field_count].in_check_mask = NULL;
663 (*last_cmd)->cmd.scan->fields[field_count].in_handler = NULL;
664 (*last_cmd)->cmd.scan->fields[field_count++].in_handler_priv = NULL;
665 }
666 else
667 {
668 #ifdef _DEBUG_JTAG_IO_
669 /* if a device is listed, the BYPASS register must not be selected */
670 if (jtag_get_device(i)->bypass)
671 {
672 LOG_ERROR("BUG: scan data for a device in BYPASS");
673 exit(-1);
674 }
675 #endif
676 }
677 }
678 return ERROR_OK;
679 }
680
681 void MINIDRIVER(interface_jtag_add_dr_out)(int device_num,
682 int num_fields,
683 const int *num_bits,
684 const u32 *value,
685 enum tap_state end_state)
686 {
687 int i;
688 int field_count = 0;
689 int scan_size;
690 int bypass_devices = 0;
691
692 jtag_command_t **last_cmd = jtag_get_last_command_p();
693 jtag_device_t *device = jtag_devices;
694 /* count devices in bypass */
695 while (device)
696 {
697 if (device->bypass)
698 bypass_devices++;
699 device = device->next;
700 }
701
702 /* allocate memory for a new list member */
703 *last_cmd = cmd_queue_alloc(sizeof(jtag_command_t));
704 last_comand_pointer = &((*last_cmd)->next);
705 (*last_cmd)->next = NULL;
706 (*last_cmd)->type = JTAG_SCAN;
707
708 /* allocate memory for dr scan command */
709 (*last_cmd)->cmd.scan = cmd_queue_alloc(sizeof(scan_command_t));
710 (*last_cmd)->cmd.scan->ir_scan = 0;
711 (*last_cmd)->cmd.scan->num_fields = num_fields + bypass_devices;
712 (*last_cmd)->cmd.scan->fields = cmd_queue_alloc((num_fields + bypass_devices) * sizeof(scan_field_t));
713 (*last_cmd)->cmd.scan->end_state = end_state;
714
715 for (i = 0; i < jtag_num_devices; i++)
716 {
717 (*last_cmd)->cmd.scan->fields[field_count].device = i;
718
719 if (i == device_num)
720 {
721 int j;
722 #ifdef _DEBUG_JTAG_IO_
723 /* if a device is listed, the BYPASS register must not be selected */
724 if (jtag_get_device(i)->bypass)
725 {
726 LOG_ERROR("BUG: scan data for a device in BYPASS");
727 exit(-1);
728 }
729 #endif
730 for (j = 0; j < num_fields; j++)
731 {
732 u8 out_value[4];
733 scan_size = num_bits[j];
734 buf_set_u32(out_value, 0, scan_size, value[j]);
735 (*last_cmd)->cmd.scan->fields[field_count].num_bits = scan_size;
736 (*last_cmd)->cmd.scan->fields[field_count].out_value = buf_cpy(out_value, cmd_queue_alloc(CEIL(scan_size, 8)), scan_size);
737 (*last_cmd)->cmd.scan->fields[field_count].out_mask = NULL;
738 (*last_cmd)->cmd.scan->fields[field_count].in_value = NULL;
739 (*last_cmd)->cmd.scan->fields[field_count].in_check_value = NULL;
740 (*last_cmd)->cmd.scan->fields[field_count].in_check_mask = NULL;
741 (*last_cmd)->cmd.scan->fields[field_count].in_handler = NULL;
742 (*last_cmd)->cmd.scan->fields[field_count++].in_handler_priv = NULL;
743 }
744 } else
745 {
746 #ifdef _DEBUG_JTAG_IO_
747 /* if a device isn't listed, the BYPASS register should be selected */
748 if (!jtag_get_device(i)->bypass)
749 {
750 LOG_ERROR("BUG: no scan data for a device not in BYPASS");
751 exit(-1);
752 }
753 #endif
754 /* program the scan field to 1 bit length, and ignore it's value */
755 (*last_cmd)->cmd.scan->fields[field_count].num_bits = 1;
756 (*last_cmd)->cmd.scan->fields[field_count].out_value = NULL;
757 (*last_cmd)->cmd.scan->fields[field_count].out_mask = NULL;
758 (*last_cmd)->cmd.scan->fields[field_count].in_value = NULL;
759 (*last_cmd)->cmd.scan->fields[field_count].in_check_value = NULL;
760 (*last_cmd)->cmd.scan->fields[field_count].in_check_mask = NULL;
761 (*last_cmd)->cmd.scan->fields[field_count].in_handler = NULL;
762 (*last_cmd)->cmd.scan->fields[field_count++].in_handler_priv = NULL;
763 }
764 }
765 }
766
767 void jtag_add_plain_dr_scan(int num_fields, scan_field_t *fields, enum tap_state state)
768 {
769 int retval;
770
771 jtag_prelude(state);
772
773 retval=interface_jtag_add_plain_dr_scan(num_fields, fields, cmd_queue_end_state);
774 if (retval!=ERROR_OK)
775 jtag_error=retval;
776 }
777
778 int MINIDRIVER(interface_jtag_add_plain_dr_scan)(int num_fields, scan_field_t *fields, enum tap_state state)
779 {
780 int i;
781 jtag_command_t **last_cmd = jtag_get_last_command_p();
782
783 /* allocate memory for a new list member */
784 *last_cmd = cmd_queue_alloc(sizeof(jtag_command_t));
785 last_comand_pointer = &((*last_cmd)->next);
786 (*last_cmd)->next = NULL;
787 (*last_cmd)->type = JTAG_SCAN;
788
789 /* allocate memory for scan command */
790 (*last_cmd)->cmd.scan = cmd_queue_alloc(sizeof(scan_command_t));
791 (*last_cmd)->cmd.scan->ir_scan = 0;
792 (*last_cmd)->cmd.scan->num_fields = num_fields;
793 (*last_cmd)->cmd.scan->fields = cmd_queue_alloc(num_fields * sizeof(scan_field_t));
794 (*last_cmd)->cmd.scan->end_state = state;
795
796 for (i = 0; i < num_fields; i++)
797 {
798 int num_bits = fields[i].num_bits;
799 int num_bytes = CEIL(fields[i].num_bits, 8);
800 (*last_cmd)->cmd.scan->fields[i].device = fields[i].device;
801 (*last_cmd)->cmd.scan->fields[i].num_bits = num_bits;
802 (*last_cmd)->cmd.scan->fields[i].out_value = buf_cpy(fields[i].out_value, cmd_queue_alloc(num_bytes), num_bits);
803 (*last_cmd)->cmd.scan->fields[i].out_mask = buf_cpy(fields[i].out_mask, cmd_queue_alloc(num_bytes), num_bits);
804 (*last_cmd)->cmd.scan->fields[i].in_value = fields[i].in_value;
805 (*last_cmd)->cmd.scan->fields[i].in_check_value = fields[i].in_check_value;
806 (*last_cmd)->cmd.scan->fields[i].in_check_mask = fields[i].in_check_mask;
807 (*last_cmd)->cmd.scan->fields[i].in_handler = fields[i].in_handler;
808 (*last_cmd)->cmd.scan->fields[i].in_handler_priv = fields[i].in_handler_priv;
809 }
810
811 return ERROR_OK;
812 }
813
814 void jtag_add_tlr()
815 {
816 jtag_prelude(TAP_TLR);
817
818 int retval;
819 retval=interface_jtag_add_tlr();
820 if (retval!=ERROR_OK)
821 jtag_error=retval;
822 }
823
824 int MINIDRIVER(interface_jtag_add_tlr)()
825 {
826 enum tap_state state = TAP_TLR;
827 jtag_command_t **last_cmd = jtag_get_last_command_p();
828
829 /* allocate memory for a new list member */
830 *last_cmd = cmd_queue_alloc(sizeof(jtag_command_t));
831 last_comand_pointer = &((*last_cmd)->next);
832 (*last_cmd)->next = NULL;
833 (*last_cmd)->type = JTAG_STATEMOVE;
834
835 (*last_cmd)->cmd.statemove = cmd_queue_alloc(sizeof(statemove_command_t));
836 (*last_cmd)->cmd.statemove->end_state = state;
837
838
839 return ERROR_OK;
840 }
841
842 void jtag_add_pathmove(int num_states, enum tap_state *path)
843 {
844 enum tap_state cur_state=cmd_queue_cur_state;
845 int i;
846 int retval;
847
848 /* the last state has to be a stable state */
849 if (tap_move_map[path[num_states - 1]] == -1)
850 {
851 LOG_ERROR("BUG: TAP path doesn't finish in a stable state");
852 exit(-1);
853 }
854
855 for (i=0; i<num_states; i++)
856 {
857 if ((tap_transitions[cur_state].low != path[i])&&
858 (tap_transitions[cur_state].high != path[i]))
859 {
860 LOG_ERROR("BUG: %s -> %s isn't a valid TAP transition", tap_state_strings[cur_state], tap_state_strings[path[i]]);
861 exit(-1);
862 }
863 cur_state = path[i];
864 }
865
866 jtag_prelude1();
867
868
869 retval=interface_jtag_add_pathmove(num_states, path);
870 cmd_queue_cur_state = path[num_states - 1];
871 if (retval!=ERROR_OK)
872 jtag_error=retval;
873 }
874
875 int MINIDRIVER(interface_jtag_add_pathmove)(int num_states, enum tap_state *path)
876 {
877 jtag_command_t **last_cmd = jtag_get_last_command_p();
878 int i;
879
880 /* allocate memory for a new list member */
881 *last_cmd = cmd_queue_alloc(sizeof(jtag_command_t));
882 last_comand_pointer = &((*last_cmd)->next);
883 (*last_cmd)->next = NULL;
884 (*last_cmd)->type = JTAG_PATHMOVE;
885
886 (*last_cmd)->cmd.pathmove = cmd_queue_alloc(sizeof(pathmove_command_t));
887 (*last_cmd)->cmd.pathmove->num_states = num_states;
888 (*last_cmd)->cmd.pathmove->path = cmd_queue_alloc(sizeof(enum tap_state) * num_states);
889
890 for (i = 0; i < num_states; i++)
891 (*last_cmd)->cmd.pathmove->path[i] = path[i];
892
893 return ERROR_OK;
894 }
895
896 int MINIDRIVER(interface_jtag_add_runtest)(int num_cycles, enum tap_state state)
897 {
898 jtag_command_t **last_cmd = jtag_get_last_command_p();
899
900 /* allocate memory for a new list member */
901 *last_cmd = cmd_queue_alloc(sizeof(jtag_command_t));
902 (*last_cmd)->next = NULL;
903 last_comand_pointer = &((*last_cmd)->next);
904 (*last_cmd)->type = JTAG_RUNTEST;
905
906 (*last_cmd)->cmd.runtest = cmd_queue_alloc(sizeof(runtest_command_t));
907 (*last_cmd)->cmd.runtest->num_cycles = num_cycles;
908 (*last_cmd)->cmd.runtest->end_state = state;
909
910 return ERROR_OK;
911 }
912
913 void jtag_add_runtest(int num_cycles, enum tap_state state)
914 {
915 int retval;
916
917 jtag_prelude(state);
918
919 /* executed by sw or hw fifo */
920 retval=interface_jtag_add_runtest(num_cycles, cmd_queue_end_state);
921 if (retval!=ERROR_OK)
922 jtag_error=retval;
923 }
924
925 void jtag_add_reset(int req_tlr_or_trst, int req_srst)
926 {
927 int trst_with_tlr = 0;
928 int retval;
929
930 /* FIX!!! there are *many* different cases here. A better
931 * approach is needed for legal combinations of transitions...
932 */
933 if ((jtag_reset_config & RESET_HAS_SRST)&&
934 (jtag_reset_config & RESET_HAS_TRST)&&
935 ((jtag_reset_config & RESET_SRST_PULLS_TRST)==0))
936 {
937 if (((req_tlr_or_trst&&!jtag_trst)||
938 (!req_tlr_or_trst&&jtag_trst))&&
939 ((req_srst&&!jtag_srst)||
940 (!req_srst&&jtag_srst)))
941 {
942 /* FIX!!! srst_pulls_trst allows 1,1 => 0,0 transition.... */
943 //LOG_ERROR("BUG: transition of req_tlr_or_trst and req_srst in the same jtag_add_reset() call is undefined");
944 }
945 }
946
947 /* Make sure that jtag_reset_config allows the requested reset */
948 /* if SRST pulls TRST, we can't fulfill srst == 1 with trst == 0 */
949 if (((jtag_reset_config & RESET_SRST_PULLS_TRST) && (req_srst == 1)) && (!req_tlr_or_trst))
950 {
951 LOG_ERROR("BUG: requested reset would assert trst");
952 jtag_error=ERROR_FAIL;
953 return;
954 }
955
956 /* if TRST pulls SRST, we reset with TAP T-L-R */
957 if (((jtag_reset_config & RESET_TRST_PULLS_SRST) && (req_tlr_or_trst)) && (req_srst == 0))
958 {
959 trst_with_tlr = 1;
960 }
961
962 if (req_srst && !(jtag_reset_config & RESET_HAS_SRST))
963 {
964 LOG_ERROR("BUG: requested SRST assertion, but the current configuration doesn't support this");
965 jtag_error=ERROR_FAIL;
966 return;
967 }
968
969 if (req_tlr_or_trst)
970 {
971 if (!trst_with_tlr && (jtag_reset_config & RESET_HAS_TRST))
972 {
973 jtag_trst = 1;
974 } else
975 {
976 trst_with_tlr = 1;
977 }
978 } else
979 {
980 jtag_trst = 0;
981 }
982
983 jtag_srst = req_srst;
984
985 retval = interface_jtag_add_reset(jtag_trst, jtag_srst);
986 if (retval!=ERROR_OK)
987 {
988 jtag_error=retval;
989 return;
990 }
991
992 if (jtag_srst)
993 {
994 LOG_DEBUG("SRST line asserted");
995 }
996 else
997 {
998 LOG_DEBUG("SRST line released");
999 if (jtag_nsrst_delay)
1000 jtag_add_sleep(jtag_nsrst_delay * 1000);
1001 }
1002
1003 if (trst_with_tlr)
1004 {
1005 LOG_DEBUG("JTAG reset with TLR instead of TRST");
1006 jtag_add_end_state(TAP_TLR);
1007 jtag_add_tlr();
1008 jtag_call_event_callbacks(JTAG_TRST_ASSERTED);
1009 return;
1010 }
1011
1012 if (jtag_trst)
1013 {
1014 /* we just asserted nTRST, so we're now in Test-Logic-Reset,
1015 * and inform possible listeners about this
1016 */
1017 LOG_DEBUG("TRST line asserted");
1018 cmd_queue_cur_state = TAP_TLR;
1019 jtag_call_event_callbacks(JTAG_TRST_ASSERTED);
1020 }
1021 else
1022 {
1023 if (jtag_ntrst_delay)
1024 jtag_add_sleep(jtag_ntrst_delay * 1000);
1025 }
1026 }
1027
1028 int MINIDRIVER(interface_jtag_add_reset)(int req_trst, int req_srst)
1029 {
1030 jtag_command_t **last_cmd = jtag_get_last_command_p();
1031
1032 /* allocate memory for a new list member */
1033 *last_cmd = cmd_queue_alloc(sizeof(jtag_command_t));
1034 (*last_cmd)->next = NULL;
1035 last_comand_pointer = &((*last_cmd)->next);
1036 (*last_cmd)->type = JTAG_RESET;
1037
1038 (*last_cmd)->cmd.reset = cmd_queue_alloc(sizeof(reset_command_t));
1039 (*last_cmd)->cmd.reset->trst = req_trst;
1040 (*last_cmd)->cmd.reset->srst = req_srst;
1041
1042 return ERROR_OK;
1043 }
1044
1045 void jtag_add_end_state(enum tap_state state)
1046 {
1047 cmd_queue_end_state = state;
1048 if ((cmd_queue_end_state == TAP_SD)||(cmd_queue_end_state == TAP_SI))
1049 {
1050 LOG_ERROR("BUG: TAP_SD/SI can't be end state. Calling code should use a larger scan field");
1051 }
1052 }
1053
1054 int MINIDRIVER(interface_jtag_add_sleep)(u32 us)
1055 {
1056 jtag_command_t **last_cmd = jtag_get_last_command_p();
1057
1058 /* allocate memory for a new list member */
1059 *last_cmd = cmd_queue_alloc(sizeof(jtag_command_t));
1060 (*last_cmd)->next = NULL;
1061 last_comand_pointer = &((*last_cmd)->next);
1062 (*last_cmd)->type = JTAG_SLEEP;
1063
1064 (*last_cmd)->cmd.sleep = cmd_queue_alloc(sizeof(sleep_command_t));
1065 (*last_cmd)->cmd.sleep->us = us;
1066
1067 return ERROR_OK;
1068 }
1069
1070 void jtag_add_sleep(u32 us)
1071 {
1072 keep_alive(); /* we might be running on a very slow JTAG clk */
1073 int retval=interface_jtag_add_sleep(us);
1074 if (retval!=ERROR_OK)
1075 jtag_error=retval;
1076 return;
1077 }
1078
1079 int jtag_scan_size(scan_command_t *cmd)
1080 {
1081 int bit_count = 0;
1082 int i;
1083
1084 /* count bits in scan command */
1085 for (i = 0; i < cmd->num_fields; i++)
1086 {
1087 bit_count += cmd->fields[i].num_bits;
1088 }
1089
1090 return bit_count;
1091 }
1092
1093 int jtag_build_buffer(scan_command_t *cmd, u8 **buffer)
1094 {
1095 int bit_count = 0;
1096 int i;
1097
1098 bit_count = jtag_scan_size(cmd);
1099 *buffer = malloc(CEIL(bit_count, 8));
1100
1101 bit_count = 0;
1102
1103 for (i = 0; i < cmd->num_fields; i++)
1104 {
1105 if (cmd->fields[i].out_value)
1106 {
1107 #ifdef _DEBUG_JTAG_IO_
1108 char* char_buf = buf_to_str(cmd->fields[i].out_value, (cmd->fields[i].num_bits > 64) ? 64 : cmd->fields[i].num_bits, 16);
1109 #endif
1110 buf_set_buf(cmd->fields[i].out_value, 0, *buffer, bit_count, cmd->fields[i].num_bits);
1111 #ifdef _DEBUG_JTAG_IO_
1112 LOG_DEBUG("fields[%i].out_value: 0x%s", i, char_buf);
1113 free(char_buf);
1114 #endif
1115 }
1116
1117 bit_count += cmd->fields[i].num_bits;
1118 }
1119
1120 return bit_count;
1121 }
1122
1123 int jtag_read_buffer(u8 *buffer, scan_command_t *cmd)
1124 {
1125 int i;
1126 int bit_count = 0;
1127 int retval;
1128
1129 /* we return ERROR_OK, unless a check fails, or a handler reports a problem */
1130 retval = ERROR_OK;
1131
1132 for (i = 0; i < cmd->num_fields; i++)
1133 {
1134 /* if neither in_value nor in_handler
1135 * are specified we don't have to examine this field
1136 */
1137 if (cmd->fields[i].in_value || cmd->fields[i].in_handler)
1138 {
1139 int num_bits = cmd->fields[i].num_bits;
1140 u8 *captured = buf_set_buf(buffer, bit_count, malloc(CEIL(num_bits, 8)), 0, num_bits);
1141
1142 #ifdef _DEBUG_JTAG_IO_
1143 char *char_buf;
1144
1145 char_buf = buf_to_str(captured, (num_bits > 64) ? 64 : num_bits, 16);
1146 LOG_DEBUG("fields[%i].in_value: 0x%s", i, char_buf);
1147 free(char_buf);
1148 #endif
1149
1150 if (cmd->fields[i].in_value)
1151 {
1152 buf_cpy(captured, cmd->fields[i].in_value, num_bits);
1153
1154 if (cmd->fields[i].in_handler)
1155 {
1156 if (cmd->fields[i].in_handler(cmd->fields[i].in_value, cmd->fields[i].in_handler_priv, cmd->fields+i) != ERROR_OK)
1157 {
1158 LOG_WARNING("in_handler reported a failed check");
1159 retval = ERROR_JTAG_QUEUE_FAILED;
1160 }
1161 }
1162 }
1163
1164 /* no in_value specified, but a handler takes care of the scanned data */
1165 if (cmd->fields[i].in_handler && (!cmd->fields[i].in_value))
1166 {
1167 if (cmd->fields[i].in_handler(captured, cmd->fields[i].in_handler_priv, cmd->fields+i) != ERROR_OK)
1168 {
1169 /* We're going to call the error:handler later, but if the in_handler
1170 * reported an error we report this failure upstream
1171 */
1172 LOG_WARNING("in_handler reported a failed check");
1173 retval = ERROR_JTAG_QUEUE_FAILED;
1174 }
1175 }
1176
1177 free(captured);
1178 }
1179 bit_count += cmd->fields[i].num_bits;
1180 }
1181
1182 return retval;
1183 }
1184
1185 int jtag_check_value(u8 *captured, void *priv, scan_field_t *field)
1186 {
1187 int retval = ERROR_OK;
1188 int num_bits = field->num_bits;
1189
1190 int compare_failed = 0;
1191
1192 if (field->in_check_mask)
1193 compare_failed = buf_cmp_mask(captured, field->in_check_value, field->in_check_mask, num_bits);
1194 else
1195 compare_failed = buf_cmp(captured, field->in_check_value, num_bits);
1196
1197 if (compare_failed)
1198 {
1199 /* An error handler could have caught the failing check
1200 * only report a problem when there wasn't a handler, or if the handler
1201 * acknowledged the error
1202 */
1203 if (compare_failed)
1204 {
1205 char *captured_char = buf_to_str(captured, (num_bits > 64) ? 64 : num_bits, 16);
1206 char *in_check_value_char = buf_to_str(field->in_check_value, (num_bits > 64) ? 64 : num_bits, 16);
1207
1208 if (field->in_check_mask)
1209 {
1210 char *in_check_mask_char;
1211 in_check_mask_char = buf_to_str(field->in_check_mask, (num_bits > 64) ? 64 : num_bits, 16);
1212 LOG_WARNING("value captured during scan didn't pass the requested check: captured: 0x%s check_value: 0x%s check_mask: 0x%s", captured_char, in_check_value_char, in_check_mask_char);
1213 free(in_check_mask_char);
1214 }
1215 else
1216 {
1217 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);
1218 }
1219
1220 free(captured_char);
1221 free(in_check_value_char);
1222
1223 retval = ERROR_JTAG_QUEUE_FAILED;
1224 }
1225
1226 }
1227 return retval;
1228 }
1229
1230 /*
1231 set up checking of this field using the in_handler. The values passed in must be valid until
1232 after jtag_execute() has completed.
1233 */
1234 void jtag_set_check_value(scan_field_t *field, u8 *value, u8 *mask, error_handler_t *in_error_handler)
1235 {
1236 if (value)
1237 field->in_handler = jtag_check_value;
1238 else
1239 field->in_handler = NULL; /* No check, e.g. embeddedice uses value==NULL to indicate no check */
1240 field->in_handler_priv = NULL;
1241 field->in_check_value = value;
1242 field->in_check_mask = mask;
1243 }
1244
1245 enum scan_type jtag_scan_type(scan_command_t *cmd)
1246 {
1247 int i;
1248 int type = 0;
1249
1250 for (i = 0; i < cmd->num_fields; i++)
1251 {
1252 if (cmd->fields[i].in_value || cmd->fields[i].in_handler)
1253 type |= SCAN_IN;
1254 if (cmd->fields[i].out_value)
1255 type |= SCAN_OUT;
1256 }
1257
1258 return type;
1259 }
1260
1261 int MINIDRIVER(interface_jtag_execute_queue)(void)
1262 {
1263 int retval;
1264
1265 if (jtag==NULL)
1266 {
1267 LOG_ERROR("No JTAG interface configured yet. Issue 'init' command in startup scripts before communicating with targets.");
1268 return ERROR_FAIL;
1269 }
1270
1271 retval = jtag->execute_queue();
1272
1273 cmd_queue_free();
1274
1275 jtag_command_queue = NULL;
1276 last_comand_pointer = &jtag_command_queue;
1277
1278 return retval;
1279 }
1280
1281 int jtag_execute_queue(void)
1282 {
1283 int retval=interface_jtag_execute_queue();
1284 if (retval==ERROR_OK)
1285 {
1286 retval=jtag_error;
1287 }
1288 jtag_error=ERROR_OK;
1289 return retval;
1290 }
1291
1292 int jtag_reset_callback(enum jtag_event event, void *priv)
1293 {
1294 jtag_device_t *device = priv;
1295
1296 LOG_DEBUG("-");
1297
1298 if (event == JTAG_TRST_ASSERTED)
1299 {
1300 buf_set_ones(device->cur_instr, device->ir_length);
1301 device->bypass = 1;
1302 }
1303
1304 return ERROR_OK;
1305 }
1306
1307 void jtag_sleep(u32 us)
1308 {
1309 usleep(us);
1310 }
1311
1312 /* Try to examine chain layout according to IEEE 1149.1 §12
1313 */
1314 int jtag_examine_chain()
1315 {
1316 jtag_device_t *device = jtag_devices;
1317 scan_field_t field;
1318 u8 idcode_buffer[JTAG_MAX_CHAIN_SIZE * 4];
1319 int i;
1320 int bit_count;
1321 int device_count = 0;
1322 u8 zero_check = 0x0;
1323 u8 one_check = 0xff;
1324
1325 field.device = 0;
1326 field.num_bits = sizeof(idcode_buffer) * 8;
1327 field.out_value = idcode_buffer;
1328 field.out_mask = NULL;
1329 field.in_value = idcode_buffer;
1330 field.in_check_value = NULL;
1331 field.in_check_mask = NULL;
1332 field.in_handler = NULL;
1333 field.in_handler_priv = NULL;
1334
1335 for (i = 0; i < JTAG_MAX_CHAIN_SIZE; i++)
1336 {
1337 buf_set_u32(idcode_buffer, i * 32, 32, 0x000000FF);
1338 }
1339
1340 jtag_add_plain_dr_scan(1, &field, TAP_TLR);
1341 jtag_execute_queue();
1342
1343 for (i = 0; i < JTAG_MAX_CHAIN_SIZE * 4; i++)
1344 {
1345 zero_check |= idcode_buffer[i];
1346 one_check &= idcode_buffer[i];
1347 }
1348
1349 /* if there wasn't a single non-zero bit or if all bits were one, the scan isn't valid */
1350 if ((zero_check == 0x00) || (one_check == 0xff))
1351 {
1352 LOG_ERROR("JTAG communication failure, check connection, JTAG interface, target power etc.");
1353 return ERROR_JTAG_INIT_FAILED;
1354 }
1355
1356 for (bit_count = 0; bit_count < (JTAG_MAX_CHAIN_SIZE * 32) - 31;)
1357 {
1358 u32 idcode = buf_get_u32(idcode_buffer, bit_count, 32);
1359 if ((idcode & 1) == 0)
1360 {
1361 /* LSB must not be 0, this indicates a device in bypass */
1362 device_count++;
1363
1364 bit_count += 1;
1365 }
1366 else
1367 {
1368 u32 manufacturer;
1369 u32 part;
1370 u32 version;
1371
1372 if (idcode == 0x000000FF)
1373 {
1374 /* End of chain (invalid manufacturer ID)
1375 *
1376 * The JTAG examine is the very first thing that happens
1377 *
1378 * A single JTAG device requires only 64 bits to be read back correctly.
1379 *
1380 * The code below adds a check that the rest of the data scanned (640 bits)
1381 * are all as expected. This helps diagnose/catch problems with the JTAG chain
1382 *
1383 * earlier and gives more helpful/explicit error messages.
1384 */
1385 for (bit_count += 32; bit_count < (JTAG_MAX_CHAIN_SIZE * 32) - 31;bit_count += 32)
1386 {
1387 idcode = buf_get_u32(idcode_buffer, bit_count, 32);
1388 if (idcode != 0x000000FF)
1389 {
1390 LOG_WARNING("Unexpected idcode after end of chain! 0x%08x", idcode);
1391 }
1392 }
1393
1394 break;
1395 }
1396
1397 if (device)
1398 {
1399 device->idcode = idcode;
1400 device = device->next;
1401 }
1402 device_count++;
1403
1404 manufacturer = (idcode & 0xffe) >> 1;
1405 part = (idcode & 0xffff000) >> 12;
1406 version = (idcode & 0xf0000000) >> 28;
1407
1408 LOG_INFO("JTAG device found: 0x%8.8x (Manufacturer: 0x%3.3x, Part: 0x%4.4x, Version: 0x%1.1x)",
1409 idcode, manufacturer, part, version);
1410
1411 bit_count += 32;
1412 }
1413 }
1414
1415 /* see if number of discovered devices matches configuration */
1416 if (device_count != jtag_num_devices)
1417 {
1418 LOG_ERROR("number of discovered devices in JTAG chain (%i) doesn't match configuration (%i)",
1419 device_count, jtag_num_devices);
1420 LOG_ERROR("check the config file and ensure proper JTAG communication (connections, speed, ...)");
1421 return ERROR_JTAG_INIT_FAILED;
1422 }
1423
1424 return ERROR_OK;
1425 }
1426
1427 int jtag_validate_chain()
1428 {
1429 jtag_device_t *device = jtag_devices;
1430 int total_ir_length = 0;
1431 u8 *ir_test = NULL;
1432 scan_field_t field;
1433 int chain_pos = 0;
1434
1435 while (device)
1436 {
1437 total_ir_length += device->ir_length;
1438 device = device->next;
1439 }
1440
1441 total_ir_length += 2;
1442 ir_test = malloc(CEIL(total_ir_length, 8));
1443 buf_set_ones(ir_test, total_ir_length);
1444
1445 field.device = 0;
1446 field.num_bits = total_ir_length;
1447 field.out_value = ir_test;
1448 field.out_mask = NULL;
1449 field.in_value = ir_test;
1450 field.in_check_value = NULL;
1451 field.in_check_mask = NULL;
1452 field.in_handler = NULL;
1453 field.in_handler_priv = NULL;
1454
1455 jtag_add_plain_ir_scan(1, &field, TAP_TLR);
1456 jtag_execute_queue();
1457
1458 device = jtag_devices;
1459 while (device)
1460 {
1461 if (buf_get_u32(ir_test, chain_pos, 2) != 0x1)
1462 {
1463 char *cbuf = buf_to_str(ir_test, total_ir_length, 16);
1464 LOG_ERROR("Error validating JTAG scan chain, IR mismatch, scan returned 0x%s", cbuf);
1465 free(cbuf);
1466 free(ir_test);
1467 return ERROR_JTAG_INIT_FAILED;
1468 }
1469 chain_pos += device->ir_length;
1470 device = device->next;
1471 }
1472
1473 if (buf_get_u32(ir_test, chain_pos, 2) != 0x3)
1474 {
1475 char *cbuf = buf_to_str(ir_test, total_ir_length, 16);
1476 LOG_ERROR("Error validating JTAG scan chain, IR mismatch, scan returned 0x%s", cbuf);
1477 free(cbuf);
1478 free(ir_test);
1479 return ERROR_JTAG_INIT_FAILED;
1480 }
1481
1482 free(ir_test);
1483
1484 return ERROR_OK;
1485 }
1486
1487 int jtag_register_commands(struct command_context_s *cmd_ctx)
1488 {
1489 register_command(cmd_ctx, NULL, "interface", handle_interface_command,
1490 COMMAND_CONFIG, NULL);
1491 register_command(cmd_ctx, NULL, "jtag_speed", handle_jtag_speed_command,
1492 COMMAND_ANY, "set jtag speed (if supported)");
1493 register_command(cmd_ctx, NULL, "jtag_khz", handle_jtag_khz_command,
1494 COMMAND_ANY, "same as jtag_speed, except it takes maximum khz as arguments. 0 KHz = RTCK.");
1495 register_command(cmd_ctx, NULL, "jtag_device", handle_jtag_device_command,
1496 COMMAND_CONFIG, "jtag_device <ir_length> <ir_expected> <ir_mask>");
1497 register_command(cmd_ctx, NULL, "reset_config", handle_reset_config_command,
1498 COMMAND_CONFIG, NULL);
1499 register_command(cmd_ctx, NULL, "jtag_nsrst_delay", handle_jtag_nsrst_delay_command,
1500 COMMAND_ANY, "jtag_nsrst_delay <ms> - delay after deasserting srst in ms");
1501 register_command(cmd_ctx, NULL, "jtag_ntrst_delay", handle_jtag_ntrst_delay_command,
1502 COMMAND_ANY, "jtag_ntrst_delay <ms> - delay after deasserting trst in ms");
1503
1504 register_command(cmd_ctx, NULL, "scan_chain", handle_scan_chain_command,
1505 COMMAND_EXEC, "print current scan chain configuration");
1506
1507 register_command(cmd_ctx, NULL, "endstate", handle_endstate_command,
1508 COMMAND_EXEC, "finish JTAG operations in <tap_state>");
1509 register_command(cmd_ctx, NULL, "jtag_reset", handle_jtag_reset_command,
1510 COMMAND_EXEC, "toggle reset lines <trst> <srst>");
1511 register_command(cmd_ctx, NULL, "runtest", handle_runtest_command,
1512 COMMAND_EXEC, "move to Run-Test/Idle, and execute <num_cycles>");
1513 register_command(cmd_ctx, NULL, "irscan", handle_irscan_command,
1514 COMMAND_EXEC, "execute IR scan <device> <instr> [dev2] [instr2] ...");
1515 register_jim(cmd_ctx, "drscan", Jim_Command_drscan, "execute DR scan <device> <num_bits> <value> <num_bits1> <value2> ...");
1516
1517 register_command(cmd_ctx, NULL, "verify_ircapture", handle_verify_ircapture_command,
1518 COMMAND_ANY, "verify value captured during Capture-IR <enable|disable>");
1519 return ERROR_OK;
1520 }
1521
1522 int jtag_interface_init(struct command_context_s *cmd_ctx)
1523 {
1524 if (jtag)
1525 return ERROR_OK;
1526
1527 if (!jtag_interface)
1528 {
1529 /* nothing was previously specified by "interface" command */
1530 LOG_ERROR("JTAG interface has to be specified, see \"interface\" command");
1531 return ERROR_JTAG_INVALID_INTERFACE;
1532 }
1533 if(hasKHz)
1534 {
1535 jtag_interface->khz(speed_khz, &jtag_speed);
1536 hasKHz = 0;
1537 }
1538
1539 if (jtag_interface->init() != ERROR_OK)
1540 return ERROR_JTAG_INIT_FAILED;
1541
1542
1543
1544 jtag = jtag_interface;
1545 return ERROR_OK;
1546 }
1547
1548 static int jtag_init_inner(struct command_context_s *cmd_ctx)
1549 {
1550 int validate_tries = 0;
1551 jtag_device_t *device;
1552 int retval;
1553
1554 LOG_DEBUG("Init JTAG chain");
1555
1556 device = jtag_devices;
1557 jtag_ir_scan_size = 0;
1558 jtag_num_devices = 0;
1559 while (device != NULL)
1560 {
1561 jtag_ir_scan_size += device->ir_length;
1562 jtag_num_devices++;
1563 device = device->next;
1564 }
1565
1566 jtag_add_tlr();
1567 if ((retval=jtag_execute_queue())!=ERROR_OK)
1568 return retval;
1569
1570 /* examine chain first, as this could discover the real chain layout */
1571 if (jtag_examine_chain() != ERROR_OK)
1572 {
1573 LOG_ERROR("trying to validate configured JTAG chain anyway...");
1574 }
1575
1576 while (jtag_validate_chain() != ERROR_OK)
1577 {
1578 validate_tries++;
1579
1580 if (validate_tries > 5)
1581 {
1582 LOG_ERROR("Could not validate JTAG chain, exit");
1583 return ERROR_JTAG_INVALID_INTERFACE;
1584 }
1585 usleep(10000);
1586 }
1587
1588 return ERROR_OK;
1589 }
1590
1591 int jtag_init_reset(struct command_context_s *cmd_ctx)
1592 {
1593 int retval;
1594
1595 if ((retval=jtag_interface_init(cmd_ctx)) != ERROR_OK)
1596 return retval;
1597
1598 LOG_DEBUG("Trying to bring the JTAG controller to life by asserting TRST / TLR");
1599
1600 /* Reset can happen after a power cycle.
1601 *
1602 * Ideally we would only assert TRST or run TLR before the target reset.
1603 *
1604 * However w/srst_pulls_trst, trst is asserted together with the target
1605 * reset whether we want it or not.
1606 *
1607 * NB! Some targets have JTAG circuitry disabled until a
1608 * trst & srst has been asserted.
1609 *
1610 * NB! here we assume nsrst/ntrst delay are sufficient!
1611 *
1612 * NB! order matters!!!! srst *can* disconnect JTAG circuitry
1613 *
1614 */
1615 jtag_add_reset(1, 0); /* TLR or TRST */
1616 if (jtag_reset_config & RESET_HAS_SRST)
1617 {
1618 jtag_add_reset(1, 1);
1619 if ((jtag_reset_config & RESET_SRST_PULLS_TRST)==0)
1620 jtag_add_reset(0, 1);
1621 }
1622 jtag_add_reset(0, 0);
1623 if ((retval = jtag_execute_queue()) != ERROR_OK)
1624 return retval;
1625
1626 /* Check that we can communication on the JTAG chain + eventually we want to
1627 * be able to perform enumeration only after OpenOCD has started
1628 * telnet and GDB server
1629 *
1630 * That would allow users to more easily perform any magic they need to before
1631 * reset happens.
1632 */
1633 return jtag_init_inner(cmd_ctx);
1634 }
1635
1636 int jtag_init(struct command_context_s *cmd_ctx)
1637 {
1638 int retval;
1639 if ((retval=jtag_interface_init(cmd_ctx)) != ERROR_OK)
1640 return retval;
1641 if (jtag_init_inner(cmd_ctx)==ERROR_OK)
1642 {
1643 return ERROR_OK;
1644 }
1645 return jtag_init_reset(cmd_ctx);
1646 }
1647
1648 static int default_khz(int khz, int *jtag_speed)
1649 {
1650 LOG_ERROR("Translation from khz to jtag_speed not implemented");
1651 return ERROR_FAIL;
1652 }
1653
1654 static int default_speed_div(int speed, int *khz)
1655 {
1656 return ERROR_FAIL;
1657 }
1658
1659 int handle_interface_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1660 {
1661 int i;
1662
1663 /* check whether the interface is already configured */
1664 if (jtag_interface)
1665 {
1666 LOG_WARNING("Interface already configured, ignoring");
1667 return ERROR_OK;
1668 }
1669
1670 /* interface name is a mandatory argument */
1671 if (argc < 1 || args[0][0] == '\0')
1672 {
1673 return ERROR_COMMAND_SYNTAX_ERROR;
1674 }
1675
1676 for (i=0; jtag_interfaces[i]; i++)
1677 {
1678 if (strcmp(args[0], jtag_interfaces[i]->name) == 0)
1679 {
1680 if (jtag_interfaces[i]->register_commands(cmd_ctx) != ERROR_OK)
1681 exit(-1);
1682
1683 jtag_interface = jtag_interfaces[i];
1684
1685 if (jtag_interface->khz == NULL)
1686 {
1687 jtag_interface->khz = default_khz;
1688 }
1689 if (jtag_interface->speed_div == NULL)
1690 {
1691 jtag_interface->speed_div = default_speed_div;
1692 }
1693 return ERROR_OK;
1694 }
1695 }
1696
1697 /* no valid interface was found (i.e. the configuration option,
1698 * didn't match one of the compiled-in interfaces
1699 */
1700 LOG_ERROR("No valid jtag interface found (%s)", args[0]);
1701 LOG_ERROR("compiled-in jtag interfaces:");
1702 for (i = 0; jtag_interfaces[i]; i++)
1703 {
1704 LOG_ERROR("%i: %s", i, jtag_interfaces[i]->name);
1705 }
1706
1707 return ERROR_JTAG_INVALID_INTERFACE;
1708 }
1709
1710 int handle_jtag_device_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1711 {
1712 jtag_device_t **last_device_p = &jtag_devices;
1713
1714 if (*last_device_p)
1715 {
1716 while ((*last_device_p)->next)
1717 last_device_p = &((*last_device_p)->next);
1718 last_device_p = &((*last_device_p)->next);
1719 }
1720
1721 if (argc < 3)
1722 return ERROR_OK;
1723
1724 *last_device_p = malloc(sizeof(jtag_device_t));
1725 (*last_device_p)->ir_length = strtoul(args[0], NULL, 0);
1726
1727 (*last_device_p)->expected = malloc((*last_device_p)->ir_length);
1728 buf_set_u32((*last_device_p)->expected, 0, (*last_device_p)->ir_length, strtoul(args[1], NULL, 0));
1729 (*last_device_p)->expected_mask = malloc((*last_device_p)->ir_length);
1730 buf_set_u32((*last_device_p)->expected_mask, 0, (*last_device_p)->ir_length, strtoul(args[2], NULL, 0));
1731
1732 (*last_device_p)->cur_instr = malloc((*last_device_p)->ir_length);
1733 (*last_device_p)->bypass = 1;
1734 buf_set_ones((*last_device_p)->cur_instr, (*last_device_p)->ir_length);
1735
1736 (*last_device_p)->next = NULL;
1737
1738 jtag_register_event_callback(jtag_reset_callback, (*last_device_p));
1739
1740 jtag_num_devices++;
1741
1742 return ERROR_OK;
1743 }
1744
1745 int handle_scan_chain_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1746 {
1747 jtag_device_t *device = jtag_devices;
1748 int device_count = 0;
1749
1750 while (device)
1751 {
1752 u32 expected, expected_mask, cur_instr;
1753 expected = buf_get_u32(device->expected, 0, device->ir_length);
1754 expected_mask = buf_get_u32(device->expected_mask, 0, device->ir_length);
1755 cur_instr = buf_get_u32(device->cur_instr, 0, device->ir_length);
1756 command_print(cmd_ctx, "%i: idcode: 0x%8.8x ir length %i, ir capture 0x%x, ir mask 0x%x, current instruction 0x%x", device_count, device->idcode, device->ir_length, expected, expected_mask, cur_instr);
1757 device = device->next;
1758 device_count++;
1759 }
1760
1761 return ERROR_OK;
1762 }
1763
1764 int handle_reset_config_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1765 {
1766 if (argc < 1)
1767 return ERROR_COMMAND_SYNTAX_ERROR;
1768
1769 if (argc >= 1)
1770 {
1771 if (strcmp(args[0], "none") == 0)
1772 jtag_reset_config = RESET_NONE;
1773 else if (strcmp(args[0], "trst_only") == 0)
1774 jtag_reset_config = RESET_HAS_TRST;
1775 else if (strcmp(args[0], "srst_only") == 0)
1776 jtag_reset_config = RESET_HAS_SRST;
1777 else if (strcmp(args[0], "trst_and_srst") == 0)
1778 jtag_reset_config = RESET_TRST_AND_SRST;
1779 else
1780 {
1781 LOG_ERROR("invalid reset_config argument, defaulting to none");
1782 jtag_reset_config = RESET_NONE;
1783 return ERROR_INVALID_ARGUMENTS;
1784 }
1785 }
1786
1787 if (argc >= 2)
1788 {
1789 if (strcmp(args[1], "separate") == 0)
1790 {
1791 /* seperate reset lines - default */
1792 } else
1793 {
1794 if (strcmp(args[1], "srst_pulls_trst") == 0)
1795 jtag_reset_config |= RESET_SRST_PULLS_TRST;
1796 else if (strcmp(args[1], "trst_pulls_srst") == 0)
1797 jtag_reset_config |= RESET_TRST_PULLS_SRST;
1798 else if (strcmp(args[1], "combined") == 0)
1799 jtag_reset_config |= RESET_SRST_PULLS_TRST | RESET_TRST_PULLS_SRST;
1800 else
1801 {
1802 LOG_ERROR("invalid reset_config argument, defaulting to none");
1803 jtag_reset_config = RESET_NONE;
1804 return ERROR_INVALID_ARGUMENTS;
1805 }
1806 }
1807 }
1808
1809 if (argc >= 3)
1810 {
1811 if (strcmp(args[2], "trst_open_drain") == 0)
1812 jtag_reset_config |= RESET_TRST_OPEN_DRAIN;
1813 else if (strcmp(args[2], "trst_push_pull") == 0)
1814 jtag_reset_config &= ~RESET_TRST_OPEN_DRAIN;
1815 else
1816 {
1817 LOG_ERROR("invalid reset_config argument, defaulting to none");
1818 jtag_reset_config = RESET_NONE;
1819 return ERROR_INVALID_ARGUMENTS;
1820 }
1821 }
1822
1823 if (argc >= 4)
1824 {
1825 if (strcmp(args[3], "srst_push_pull") == 0)
1826 jtag_reset_config |= RESET_SRST_PUSH_PULL;
1827 else if (strcmp(args[3], "srst_open_drain") == 0)
1828 jtag_reset_config &= ~RESET_SRST_PUSH_PULL;
1829 else
1830 {
1831 LOG_ERROR("invalid reset_config argument, defaulting to none");
1832 jtag_reset_config = RESET_NONE;
1833 return ERROR_INVALID_ARGUMENTS;
1834 }
1835 }
1836
1837 return ERROR_OK;
1838 }
1839
1840 int handle_jtag_nsrst_delay_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1841 {
1842 if (argc < 1)
1843 {
1844 LOG_ERROR("jtag_nsrst_delay <ms> command takes one required argument");
1845 exit(-1);
1846 }
1847 else
1848 {
1849 jtag_nsrst_delay = strtoul(args[0], NULL, 0);
1850 }
1851
1852 return ERROR_OK;
1853 }
1854
1855 int handle_jtag_ntrst_delay_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1856 {
1857 if (argc < 1)
1858 {
1859 LOG_ERROR("jtag_ntrst_delay <ms> command takes one required argument");
1860 exit(-1);
1861 }
1862 else
1863 {
1864 jtag_ntrst_delay = strtoul(args[0], NULL, 0);
1865 }
1866
1867 return ERROR_OK;
1868 }
1869
1870 int handle_jtag_speed_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1871 {
1872 int retval=ERROR_OK;
1873
1874 if (argc == 1)
1875 {
1876 LOG_DEBUG("handle jtag speed");
1877
1878 int cur_speed = 0;
1879 cur_speed = jtag_speed = strtoul(args[0], NULL, 0);
1880
1881 /* this command can be called during CONFIG,
1882 * in which case jtag isn't initialized */
1883 if (jtag)
1884 {
1885 retval=jtag->speed(cur_speed);
1886 }
1887 } else if (argc == 0)
1888 {
1889 } else
1890 {
1891 retval=ERROR_COMMAND_SYNTAX_ERROR;
1892 }
1893 command_print(cmd_ctx, "jtag_speed: %d", jtag_speed);
1894
1895 return retval;
1896 }
1897
1898 int handle_jtag_khz_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1899 {
1900 int retval=ERROR_OK;
1901 LOG_DEBUG("handle jtag khz");
1902
1903 if(argc == 1)
1904 {
1905 speed_khz = strtoul(args[0], NULL, 0);
1906 if (jtag != NULL)
1907 {
1908 int cur_speed = 0;
1909 LOG_DEBUG("have interface set up");
1910 int speed_div1;
1911 if ((retval=jtag->khz(speed_khz, &speed_div1))!=ERROR_OK)
1912 {
1913 speed_khz = 0;
1914 return retval;
1915 }
1916
1917 cur_speed = jtag_speed = speed_div1;
1918
1919 retval=jtag->speed(cur_speed);
1920 } else
1921 {
1922 hasKHz = 1;
1923 }
1924 } else if (argc==0)
1925 {
1926 } else
1927 {
1928 retval=ERROR_COMMAND_SYNTAX_ERROR;
1929 }
1930 command_print(cmd_ctx, "jtag_khz: %d", speed_khz);
1931 return retval;
1932
1933 }
1934
1935 int handle_endstate_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1936 {
1937 enum tap_state state;
1938
1939 if (argc < 1)
1940 {
1941 return ERROR_COMMAND_SYNTAX_ERROR;
1942 }
1943 else
1944 {
1945 for (state = 0; state < 16; state++)
1946 {
1947 if (strcmp(args[0], tap_state_strings[state]) == 0)
1948 {
1949 jtag_add_end_state(state);
1950 jtag_execute_queue();
1951 }
1952 }
1953 }
1954 command_print(cmd_ctx, "current endstate: %s", tap_state_strings[cmd_queue_end_state]);
1955
1956 return ERROR_OK;
1957 }
1958
1959 int handle_jtag_reset_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1960 {
1961 int trst = -1;
1962 int srst = -1;
1963
1964 if (argc < 2)
1965 {
1966 return ERROR_COMMAND_SYNTAX_ERROR;
1967 }
1968
1969 if (args[0][0] == '1')
1970 trst = 1;
1971 else if (args[0][0] == '0')
1972 trst = 0;
1973 else
1974 {
1975 return ERROR_COMMAND_SYNTAX_ERROR;
1976 }
1977
1978 if (args[1][0] == '1')
1979 srst = 1;
1980 else if (args[1][0] == '0')
1981 srst = 0;
1982 else
1983 {
1984 return ERROR_COMMAND_SYNTAX_ERROR;
1985 }
1986
1987 if (jtag_interface_init(cmd_ctx) != ERROR_OK)
1988 return ERROR_JTAG_INIT_FAILED;
1989
1990 jtag_add_reset(trst, srst);
1991 jtag_execute_queue();
1992
1993 return ERROR_OK;
1994 }
1995
1996 int handle_runtest_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
1997 {
1998 if (argc < 1)
1999 {
2000 return ERROR_COMMAND_SYNTAX_ERROR;
2001 }
2002
2003 jtag_add_runtest(strtol(args[0], NULL, 0), -1);
2004 jtag_execute_queue();
2005
2006 return ERROR_OK;
2007
2008 }
2009
2010 int handle_irscan_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2011 {
2012 int i;
2013 scan_field_t *fields;
2014
2015 if ((argc < 2) || (argc % 2))
2016 {
2017 return ERROR_COMMAND_SYNTAX_ERROR;
2018 }
2019
2020 fields = malloc(sizeof(scan_field_t) * argc / 2);
2021
2022 for (i = 0; i < argc / 2; i++)
2023 {
2024 int device = strtoul(args[i*2], NULL, 0);
2025 int field_size = jtag_get_device(device)->ir_length;
2026 fields[i].device = device;
2027 fields[i].out_value = malloc(CEIL(field_size, 8));
2028 buf_set_u32(fields[i].out_value, 0, field_size, strtoul(args[i*2+1], NULL, 0));
2029 fields[i].out_mask = NULL;
2030 fields[i].in_value = NULL;
2031 fields[i].in_check_mask = NULL;
2032 fields[i].in_handler = NULL;
2033 fields[i].in_handler_priv = NULL;
2034 }
2035
2036 jtag_add_ir_scan(argc / 2, fields, -1);
2037 jtag_execute_queue();
2038
2039 for (i = 0; i < argc / 2; i++)
2040 free(fields[i].out_value);
2041
2042 free (fields);
2043
2044 return ERROR_OK;
2045 }
2046
2047 int Jim_Command_drscan(Jim_Interp *interp, int argc, Jim_Obj *const *args)
2048 {
2049 int retval;
2050 scan_field_t *fields;
2051 int num_fields;
2052 int field_count = 0;
2053 int i, e;
2054 long device;
2055
2056 /* args[1] = device
2057 * args[2] = num_bits
2058 * args[3] = hex string
2059 * ... repeat num bits and hex string ...
2060 */
2061 if ((argc < 4) || ((argc % 2)!=0))
2062 {
2063 Jim_WrongNumArgs(interp, 1, args, "wrong arguments");
2064 return JIM_ERR;
2065 }
2066
2067 for (i = 2; i < argc; i+=2)
2068 {
2069 long bits;
2070
2071 e = Jim_GetLong(interp, args[i], &bits);
2072 if (e != JIM_OK)
2073 return e;
2074 }
2075
2076 e = Jim_GetLong(interp, args[1], &device);
2077 if (e != JIM_OK)
2078 return e;
2079
2080 num_fields=(argc-2)/2;
2081 fields = malloc(sizeof(scan_field_t) * num_fields);
2082 for (i = 2; i < argc; i+=2)
2083 {
2084 long bits;
2085 int len;
2086 const char *str;
2087
2088 Jim_GetLong(interp, args[i], &bits);
2089 str = Jim_GetString(args[i+1], &len);
2090
2091 fields[field_count].device = device;
2092 fields[field_count].num_bits = bits;
2093 fields[field_count].out_value = malloc(CEIL(bits, 8));
2094 str_to_buf(str, len, fields[field_count].out_value, bits, 0);
2095 fields[field_count].out_mask = NULL;
2096 fields[field_count].in_value = fields[field_count].out_value;
2097 fields[field_count].in_check_mask = NULL;
2098 fields[field_count].in_check_value = NULL;
2099 fields[field_count].in_handler = NULL;
2100 fields[field_count++].in_handler_priv = NULL;
2101 }
2102
2103 jtag_add_dr_scan(num_fields, fields, -1);
2104 retval = jtag_execute_queue();
2105 if (retval != ERROR_OK)
2106 {
2107 Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
2108 Jim_AppendStrings(interp, Jim_GetResult(interp), "drscan: jtag execute failed", NULL);
2109 return JIM_ERR;
2110 }
2111
2112 field_count=0;
2113 Jim_Obj *list = Jim_NewListObj(interp, NULL, 0);
2114 for (i = 2; i < argc; i+=2)
2115 {
2116 long bits;
2117 char *str;
2118
2119 Jim_GetLong(interp, args[i], &bits);
2120 str = buf_to_str(fields[field_count].in_value, bits, 16);
2121 free(fields[field_count].out_value);
2122
2123 Jim_ListAppendElement(interp, list, Jim_NewStringObj(interp, str, strlen(str)));
2124 free(str);
2125 field_count++;
2126 }
2127
2128 Jim_SetResult(interp, list);
2129
2130 free(fields);
2131
2132 return JIM_OK;
2133 }
2134
2135 int handle_verify_ircapture_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
2136 {
2137 if (argc == 1)
2138 {
2139 if (strcmp(args[0], "enable") == 0)
2140 {
2141 jtag_verify_capture_ir = 1;
2142 }
2143 else if (strcmp(args[0], "disable") == 0)
2144 {
2145 jtag_verify_capture_ir = 0;
2146 } else
2147 {
2148 return ERROR_COMMAND_SYNTAX_ERROR;
2149 }
2150 } else if (argc != 0)
2151 {
2152 return ERROR_COMMAND_SYNTAX_ERROR;
2153 }
2154
2155 command_print(cmd_ctx, "verify Capture-IR is %s", (jtag_verify_capture_ir) ? "enabled": "disabled");
2156
2157 return ERROR_OK;
2158 }
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)