1 /***************************************************************************
2 * Copyright (C) 2009 by Simon Qian *
3 * SimonQian@SimonQian.com *
5 * This program is free software; you can redistribute it and/or modify *
6 * it under the terms of the GNU General Public License as published by *
7 * the Free Software Foundation; either version 2 of the License, or *
8 * (at your option) any later version. *
10 * This program is distributed in the hope that it will be useful, *
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
13 * GNU General Public License for more details. *
15 * You should have received a copy of the GNU General Public License *
16 * along with this program; if not, write to the *
17 * Free Software Foundation, Inc., *
18 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
19 ***************************************************************************/
22 /* The specification for SVF is available here:
23 * http://www.asset-intertech.com/support/svf.pdf
24 * Below, this document is refered to as the "SVF spec".
26 * The specification for XSVF is available here:
27 * http://www.xilinx.com/support/documentation/application_notes/xapp503.pdf
28 * Below, this document is refered to as the "XSVF spec".
37 #include "time_support.h"
59 const char *svf_command_name
[14] =
85 const char *svf_trst_mode_name
[4] =
93 char *svf_tap_state_name
[TAP_NUM_STATES
];
95 #define XXR_TDI (1 << 0)
96 #define XXR_TDO (1 << 1)
97 #define XXR_MASK (1 << 2)
98 #define XXR_SMASK (1 << 3)
112 tap_state_t ir_end_state
;
113 tap_state_t dr_end_state
;
114 tap_state_t runtest_run_state
;
115 tap_state_t runtest_end_state
;
116 trst_mode_t trst_mode
;
118 svf_xxr_para_t hir_para
;
119 svf_xxr_para_t hdr_para
;
120 svf_xxr_para_t tir_para
;
121 svf_xxr_para_t tdr_para
;
122 svf_xxr_para_t sir_para
;
123 svf_xxr_para_t sdr_para
;
127 const svf_para_t svf_para_init
=
129 // frequency, ir_end_state, dr_end_state, runtest_run_state, runtest_end_state, trst_mode
130 0, TAP_IDLE
, TAP_IDLE
, TAP_IDLE
, TAP_IDLE
, TRST_Z
,
132 // {len, data_mask, tdi, tdo, mask, smask},
133 {0, 0, NULL
, NULL
, NULL
, NULL
},
135 // {len, data_mask, tdi, tdo, mask, smask},
136 {0, 0, NULL
, NULL
, NULL
, NULL
},
138 // {len, data_mask, tdi, tdo, mask, smask},
139 {0, 0, NULL
, NULL
, NULL
, NULL
},
141 // {len, data_mask, tdi, tdo, mask, smask},
142 {0, 0, NULL
, NULL
, NULL
, NULL
},
144 // {len, data_mask, tdi, tdo, mask, smask},
145 {0, 0, NULL
, NULL
, NULL
, NULL
},
147 // {len, data_mask, tdi, tdo, mask, smask},
148 {0, 0, NULL
, NULL
, NULL
, NULL
},
153 int line_num
; // used to record line number of the check operation
154 // so more information could be printed
155 int enabled
; // check is enabled or not
156 int buffer_offset
; // buffer_offset to buffers
157 int bit_len
; // bit length to check
158 }svf_check_tdo_para_t
;
160 #define SVF_CHECK_TDO_PARA_SIZE 1024
161 static svf_check_tdo_para_t
*svf_check_tdo_para
= NULL
;
162 static int svf_check_tdo_para_index
= 0;
164 #define dimof(a) (sizeof(a) / sizeof((a)[0]))
166 static int svf_read_command_from_file(int fd
);
167 static int svf_check_tdo(void);
168 static int svf_add_check_para(u8 enabled
, int buffer_offset
, int bit_len
);
169 static int svf_run_command(struct command_context_s
*cmd_ctx
, char *cmd_str
);
170 static int handle_svf_command(struct command_context_s
*cmd_ctx
, char *cmd
, char **args
, int argc
);
172 static int svf_fd
= 0;
173 static char *svf_command_buffer
= NULL
;
174 static int svf_command_buffer_size
= 0;
175 static int svf_line_number
= 1;
177 static jtag_tap_t
*tap
= NULL
;
178 static tap_state_t last_state
= TAP_RESET
;
180 #define SVF_MAX_BUFFER_SIZE_TO_COMMIT (4 * 1024)
181 static u8
*svf_tdi_buffer
= NULL
, *svf_tdo_buffer
= NULL
, *svf_mask_buffer
= NULL
;
182 static int svf_buffer_index
= 0, svf_buffer_size
= 0;
183 static int svf_quiet
= 0;
186 int svf_register_commands(struct command_context_s
*cmd_ctx
)
188 register_command(cmd_ctx
, NULL
, "svf", handle_svf_command
,
189 COMMAND_EXEC
, "run svf <file>");
194 void svf_free_xxd_para(svf_xxr_para_t
*para
)
198 if (para
->tdi
!= NULL
)
203 if (para
->tdo
!= NULL
)
208 if (para
->mask
!= NULL
)
213 if (para
->smask
!= NULL
)
221 static int handle_svf_command(struct command_context_s
*cmd_ctx
, char *cmd
, char **args
, int argc
)
223 #define SVF_NUM_OF_OPTIONS 1
224 int command_num
= 0, i
;
228 if ((argc
< 1) || (argc
> (1 + SVF_NUM_OF_OPTIONS
)))
230 command_print(cmd_ctx
, "usage: svf <file> [quiet]");
236 for (i
= 1; i
< argc
; i
++)
238 if (!strcmp(args
[i
], "quiet"))
244 LOG_ERROR("unknown variant for svf: %s", args
[i
]);
246 // no need to free anything now
251 if ((svf_fd
= open(args
[0], O_RDONLY
)) < 0)
253 command_print(cmd_ctx
, "file \"%s\" not found", args
[0]);
255 // no need to free anything now
259 LOG_USER("svf processing file: \"%s\"", args
[0]);
262 time_ago
= timeval_ms();
266 svf_command_buffer_size
= 0;
268 svf_check_tdo_para_index
= 0;
269 svf_check_tdo_para
= malloc(sizeof(svf_check_tdo_para_t
) * SVF_CHECK_TDO_PARA_SIZE
);
270 if (NULL
== svf_check_tdo_para
)
272 LOG_ERROR("not enough memory");
277 svf_buffer_index
= 0;
278 // double the buffer size
279 // in case current command cannot be commited, and next command is a bit scan command
280 // here is 32K bits for this big scan command, it should be enough
281 // buffer will be reallocated if buffer size is not enough
282 svf_tdi_buffer
= (u8
*)malloc(2 * SVF_MAX_BUFFER_SIZE_TO_COMMIT
);
283 if (NULL
== svf_tdi_buffer
)
285 LOG_ERROR("not enough memory");
289 svf_tdo_buffer
= (u8
*)malloc(2 * SVF_MAX_BUFFER_SIZE_TO_COMMIT
);
290 if (NULL
== svf_tdo_buffer
)
292 LOG_ERROR("not enough memory");
296 svf_mask_buffer
= (u8
*)malloc(2 * SVF_MAX_BUFFER_SIZE_TO_COMMIT
);
297 if (NULL
== svf_mask_buffer
)
299 LOG_ERROR("not enough memory");
303 svf_buffer_size
= 2 * SVF_MAX_BUFFER_SIZE_TO_COMMIT
;
305 memcpy(&svf_para
, &svf_para_init
, sizeof(svf_para
));
306 for (i
= 0; i
< (int)dimof(svf_tap_state_name
); i
++)
308 svf_tap_state_name
[i
] = (char *)tap_state_name(i
);
313 while ( ERROR_OK
== svf_read_command_from_file(svf_fd
) )
315 if (ERROR_OK
!= svf_run_command(cmd_ctx
, svf_command_buffer
))
317 LOG_ERROR("fail to run command at line %d", svf_line_number
);
323 if (ERROR_OK
!= jtag_execute_queue())
327 else if (ERROR_OK
!= svf_check_tdo())
333 command_print(cmd_ctx
, "%lld ms used", timeval_ms() - time_ago
);
341 if (svf_command_buffer
)
343 free(svf_command_buffer
);
344 svf_command_buffer
= NULL
;
345 svf_command_buffer_size
= 0;
347 if (svf_check_tdo_para
)
349 free(svf_check_tdo_para
);
350 svf_check_tdo_para
= NULL
;
351 svf_check_tdo_para_index
= 0;
355 free(svf_tdi_buffer
);
356 svf_tdi_buffer
= NULL
;
360 free(svf_tdo_buffer
);
361 svf_tdo_buffer
= NULL
;
365 free(svf_mask_buffer
);
366 svf_mask_buffer
= NULL
;
368 svf_buffer_index
= 0;
371 svf_free_xxd_para(&svf_para
.hdr_para
);
372 svf_free_xxd_para(&svf_para
.hir_para
);
373 svf_free_xxd_para(&svf_para
.tdr_para
);
374 svf_free_xxd_para(&svf_para
.tir_para
);
375 svf_free_xxd_para(&svf_para
.sdr_para
);
376 svf_free_xxd_para(&svf_para
.sir_para
);
380 command_print(cmd_ctx
, "svf file programmed successfully for %d commands", command_num
);
384 command_print(cmd_ctx
, "svf file programmed failed");
390 #define SVFP_CMD_INC_CNT 1024
391 static int svf_read_command_from_file(int fd
)
393 char ch
, *tmp_buffer
= NULL
;
394 int cmd_pos
= 0, cmd_ok
= 0, slash
= 0, comment
= 0;
396 while (!cmd_ok
&& (read(fd
, &ch
, 1) > 0) )
426 if (cmd_pos
>= svf_command_buffer_size
- 1)
428 tmp_buffer
= (char*)malloc(svf_command_buffer_size
+ SVFP_CMD_INC_CNT
); // 1 more byte for '\0'
429 if (NULL
== tmp_buffer
)
431 LOG_ERROR("not enough memory");
434 if (svf_command_buffer_size
> 0)
436 memcpy(tmp_buffer
, svf_command_buffer
, svf_command_buffer_size
);
438 if (svf_command_buffer
!= NULL
)
440 free(svf_command_buffer
);
442 svf_command_buffer
= tmp_buffer
;
443 svf_command_buffer_size
+= SVFP_CMD_INC_CNT
;
446 svf_command_buffer
[cmd_pos
++] = (char)toupper(ch
);
454 svf_command_buffer
[cmd_pos
] = '\0';
463 static int svf_parse_cmd_string(char *str
, int len
, char **argus
, int *num_of_argu
)
465 int pos
= 0, num
= 0, space_found
= 1;
475 LOG_ERROR("fail to parse svf command");
485 argus
[num
++] = &str
[pos
];
498 static int svf_tap_state_is_stable(tap_state_t state
)
500 return ((TAP_RESET
== state
) || (TAP_IDLE
== state
) || (TAP_DRPAUSE
== state
) || (TAP_IRPAUSE
== state
));
503 static int svf_tap_state_is_valid(tap_state_t state
)
505 return state
>= 0 && state
< TAP_NUM_STATES
;
508 static int svf_find_string_in_array(char *str
, char **strs
, int num_of_element
)
512 for (i
= 0; i
< num_of_element
; i
++)
514 if (!strcmp(str
, strs
[i
]))
522 static int svf_adjust_array_length(u8
**arr
, int orig_bit_len
, int new_bit_len
)
524 int new_byte_len
= (new_bit_len
+ 7) >> 3;
526 if ((NULL
== *arr
) || (((orig_bit_len
+ 7) >> 3) < ((new_bit_len
+ 7) >> 3)))
533 *arr
= (u8
*)malloc(new_byte_len
);
536 LOG_ERROR("not enough memory");
539 memset(*arr
, 0, new_byte_len
);
544 static int svf_copy_hexstring_to_binary(char *str
, u8
**bin
, int orig_bit_len
, int bit_len
)
546 int i
, str_len
= strlen(str
), str_byte_len
= (bit_len
+ 3) >> 2, loop_cnt
;
547 u8 ch
, need_write
= 1;
549 if (ERROR_OK
!= svf_adjust_array_length(bin
, orig_bit_len
, bit_len
))
551 LOG_ERROR("fail to adjust length of array");
555 if (str_byte_len
> str_len
)
557 loop_cnt
= str_byte_len
;
564 for (i
= 0; i
< loop_cnt
; i
++)
568 ch
= str
[str_len
- i
- 1];
569 if ((ch
>= '0') && (ch
<= '9'))
573 else if ((ch
>= 'A') && (ch
<= 'F'))
579 LOG_ERROR("invalid hex string");
589 if (i
>= str_byte_len
)
591 // all data written, other data should be all '0's and needn't to be written
595 LOG_ERROR("value execede length");
599 else if (i
== (str_byte_len
- 1))
601 // last data byte, written if valid
602 if ((ch
& ~((1 << (bit_len
- 4 * i
)) - 1)) != 0)
604 LOG_ERROR("value execede length");
615 (*bin
)[i
/ 2] |= ch
<< 4;
629 static int svf_check_tdo(void)
633 for (i
= 0; i
< svf_check_tdo_para_index
; i
++)
635 index
= svf_check_tdo_para
[i
].buffer_offset
;
636 len
= svf_check_tdo_para
[i
].bit_len
;
637 if ((svf_check_tdo_para
[i
].enabled
)
638 && buf_cmp_mask(&svf_tdi_buffer
[index
], &svf_tdo_buffer
[index
], &svf_mask_buffer
[index
], len
))
641 unsigned received
, expected
, tapmask
;
642 if (svf_check_tdo_para
[i
].bit_len
>= 32)
644 bitmask
= 0xFFFFFFFF;
648 bitmask
= (1 << svf_check_tdo_para
[i
].bit_len
) - 1;
650 memcpy(&received
, svf_tdi_buffer
+ index
, sizeof(unsigned));
651 memcpy(&expected
, svf_tdo_buffer
+ index
, sizeof(unsigned));
652 memcpy(&tapmask
, svf_mask_buffer
+ index
, sizeof(unsigned));
653 LOG_ERROR("tdo check error at line %d",
654 svf_check_tdo_para
[i
].line_num
);
655 LOG_ERROR("read = 0x%X, want = 0x%X, mask = 0x%X",
662 svf_check_tdo_para_index
= 0;
667 static int svf_add_check_para(u8 enabled
, int buffer_offset
, int bit_len
)
669 if (svf_check_tdo_para_index
>= SVF_CHECK_TDO_PARA_SIZE
)
671 LOG_ERROR("toooooo many operation undone");
675 svf_check_tdo_para
[svf_check_tdo_para_index
].line_num
= svf_line_number
;
676 svf_check_tdo_para
[svf_check_tdo_para_index
].bit_len
= bit_len
;
677 svf_check_tdo_para
[svf_check_tdo_para_index
].enabled
= enabled
;
678 svf_check_tdo_para
[svf_check_tdo_para_index
].buffer_offset
= buffer_offset
;
679 svf_check_tdo_para_index
++;
684 static int svf_execute_tap(void)
686 if (ERROR_OK
!= jtag_execute_queue())
690 else if (ERROR_OK
!= svf_check_tdo())
695 svf_buffer_index
= 0;
700 // not good to use this
701 extern void* cmd_queue_alloc(size_t size
);
702 extern void jtag_queue_command(jtag_command_t
* cmd
);
704 static int svf_run_command(struct command_context_s
*cmd_ctx
, char *cmd_str
)
706 char *argus
[256], command
;
707 int num_of_argu
= 0, i
;
714 float min_time
, max_time
;
716 svf_xxr_para_t
*xxr_para_tmp
;
720 tap_state_t
*path
= NULL
, state
;
724 LOG_USER("%s", svf_command_buffer
);
727 if (ERROR_OK
!= svf_parse_cmd_string(cmd_str
, strlen(cmd_str
), argus
, &num_of_argu
))
732 command
= svf_find_string_in_array(argus
[0], (char **)svf_command_name
, dimof(svf_command_name
));
737 if (num_of_argu
!= 2)
739 LOG_ERROR("invalid parameter of %s", argus
[0]);
742 i_tmp
= svf_find_string_in_array(argus
[1], (char **)svf_tap_state_name
, dimof(svf_tap_state_name
));
743 if (svf_tap_state_is_stable(i_tmp
))
745 if (command
== ENDIR
)
747 svf_para
.ir_end_state
= i_tmp
;
748 LOG_DEBUG("\tir_end_state = %s", svf_tap_state_name
[svf_para
.ir_end_state
]);
752 svf_para
.dr_end_state
= i_tmp
;
753 LOG_DEBUG("\tdr_end_state = %s", svf_tap_state_name
[svf_para
.dr_end_state
]);
758 LOG_ERROR("%s is not valid state", argus
[1]);
763 if ((num_of_argu
!= 1) && (num_of_argu
!= 3))
765 LOG_ERROR("invalid parameter of %s", argus
[0]);
768 if (1 == num_of_argu
)
770 // TODO: set jtag speed to full speed
771 svf_para
.frequency
= 0;
775 if (strcmp(argus
[2], "HZ"))
777 LOG_ERROR("HZ not found in FREQUENCY command");
780 if (ERROR_OK
!= svf_execute_tap())
784 svf_para
.frequency
= atof(argus
[1]);
785 // TODO: set jtag speed to
786 if (svf_para
.frequency
> 0)
788 command_run_linef(cmd_ctx
, "jtag_khz %d", (int)svf_para
.frequency
/ 1000);
789 LOG_DEBUG("\tfrequency = %f", svf_para
.frequency
);
794 xxr_para_tmp
= &svf_para
.hdr_para
;
797 xxr_para_tmp
= &svf_para
.hir_para
;
800 xxr_para_tmp
= &svf_para
.tdr_para
;
803 xxr_para_tmp
= &svf_para
.tir_para
;
806 xxr_para_tmp
= &svf_para
.sdr_para
;
809 xxr_para_tmp
= &svf_para
.sir_para
;
812 // XXR length [TDI (tdi)] [TDO (tdo)][MASK (mask)] [SMASK (smask)]
813 if ((num_of_argu
> 10) || (num_of_argu
% 2))
815 LOG_ERROR("invalid parameter of %s", argus
[0]);
818 i_tmp
= xxr_para_tmp
->len
;
819 xxr_para_tmp
->len
= atoi(argus
[1]);
820 LOG_DEBUG("\tlength = %d", xxr_para_tmp
->len
);
821 xxr_para_tmp
->data_mask
= 0;
822 for (i
= 2; i
< num_of_argu
; i
+= 2)
824 if ((strlen(argus
[i
+ 1]) < 3) || (argus
[i
+ 1][0] != '(') || (argus
[i
+ 1][strlen(argus
[i
+ 1]) - 1] != ')'))
826 LOG_ERROR("data section error");
829 argus
[i
+ 1][strlen(argus
[i
+ 1]) - 1] = '\0';
830 // TDI, TDO, MASK, SMASK
831 if (!strcmp(argus
[i
], "TDI"))
834 pbuffer_tmp
= &xxr_para_tmp
->tdi
;
835 xxr_para_tmp
->data_mask
|= XXR_TDI
;
837 else if (!strcmp(argus
[i
], "TDO"))
840 pbuffer_tmp
= &xxr_para_tmp
->tdo
;
841 xxr_para_tmp
->data_mask
|= XXR_TDO
;
843 else if (!strcmp(argus
[i
], "MASK"))
846 pbuffer_tmp
= &xxr_para_tmp
->mask
;
847 xxr_para_tmp
->data_mask
|= XXR_MASK
;
849 else if (!strcmp(argus
[i
], "SMASK"))
852 pbuffer_tmp
= &xxr_para_tmp
->smask
;
853 xxr_para_tmp
->data_mask
|= XXR_SMASK
;
857 LOG_ERROR("unknow parameter: %s", argus
[i
]);
860 if (ERROR_OK
!= svf_copy_hexstring_to_binary(&argus
[i
+ 1][1], pbuffer_tmp
, i_tmp
, xxr_para_tmp
->len
))
862 LOG_ERROR("fail to parse hex value");
865 LOG_DEBUG("\t%s = 0x%X", argus
[i
], (**(int**)pbuffer_tmp
) & ((1 << (xxr_para_tmp
->len
)) - 1));
867 // If a command changes the length of the last scan of the same type and the MASK parameter is absent,
868 // the mask pattern used is all cares
869 if (!(xxr_para_tmp
->data_mask
& XXR_MASK
) && (i_tmp
!= xxr_para_tmp
->len
))
871 // MASK not defined and length changed
872 if (ERROR_OK
!= svf_adjust_array_length(&xxr_para_tmp
->mask
, i_tmp
, xxr_para_tmp
->len
))
874 LOG_ERROR("fail to adjust length of array");
877 buf_set_ones(xxr_para_tmp
->mask
, xxr_para_tmp
->len
);
879 // do scan if necessary
882 // check buffer size first, reallocate if necessary
883 i
= svf_para
.hdr_para
.len
+ svf_para
.sdr_para
.len
+ svf_para
.tdr_para
.len
;
884 if ((svf_buffer_size
- svf_buffer_index
) < ((i
+ 7) >> 3))
887 // simply print error message
888 LOG_ERROR("buffer is not enough, report to author");
894 buffer_tmp
= (u8
*)malloc(svf_buffer_index
+ ((i
+ 7) >> 3));
895 if (NULL
== buffer_tmp
)
897 LOG_ERROR("not enough memory");
900 memcpy(buffer_tmp
, svf_tdi_buffer
, svf_buffer_index
);
901 // svf_tdi_buffer isn't NULL here
902 free(svf_tdi_buffer
);
903 svf_tdi_buffer
= buffer_tmp
;
905 buffer_tmp
= (u8
*)malloc(svf_buffer_index
+ ((i
+ 7) >> 3));
906 if (NULL
== buffer_tmp
)
908 LOG_ERROR("not enough memory");
911 memcpy(buffer_tmp
, svf_tdo_buffer
, svf_buffer_index
);
912 // svf_tdo_buffer isn't NULL here
913 free(svf_tdo_buffer
);
914 svf_tdo_buffer
= buffer_tmp
;
916 buffer_tmp
= (u8
*)malloc(svf_buffer_index
+ ((i
+ 7) >> 3));
917 if (NULL
== buffer_tmp
)
919 LOG_ERROR("not enough memory");
922 memcpy(buffer_tmp
, svf_mask_buffer
, svf_buffer_index
);
923 // svf_mask_buffer isn't NULL here
924 free(svf_mask_buffer
);
925 svf_mask_buffer
= buffer_tmp
;
928 svf_buffer_size
= svf_buffer_index
+ ((i
+ 7) >> 3);
934 buf_set_buf(svf_para
.hdr_para
.tdi
, 0, &svf_tdi_buffer
[svf_buffer_index
], i
, svf_para
.hdr_para
.len
);
935 i
+= svf_para
.hdr_para
.len
;
936 buf_set_buf(svf_para
.sdr_para
.tdi
, 0, &svf_tdi_buffer
[svf_buffer_index
], i
, svf_para
.sdr_para
.len
);
937 i
+= svf_para
.sdr_para
.len
;
938 buf_set_buf(svf_para
.tdr_para
.tdi
, 0, &svf_tdi_buffer
[svf_buffer_index
], i
, svf_para
.tdr_para
.len
);
939 i
+= svf_para
.tdr_para
.len
;
942 if (svf_para
.sdr_para
.data_mask
& XXR_TDO
)
944 // assemble dr mask data
946 buf_set_buf(svf_para
.hdr_para
.mask
, 0, &svf_mask_buffer
[svf_buffer_index
], i
, svf_para
.hdr_para
.len
);
947 i
+= svf_para
.hdr_para
.len
;
948 buf_set_buf(svf_para
.sdr_para
.mask
, 0, &svf_mask_buffer
[svf_buffer_index
], i
, svf_para
.sdr_para
.len
);
949 i
+= svf_para
.sdr_para
.len
;
950 buf_set_buf(svf_para
.tdr_para
.mask
, 0, &svf_mask_buffer
[svf_buffer_index
], i
, svf_para
.tdr_para
.len
);
951 i
+= svf_para
.tdr_para
.len
;
952 // assemble dr check data
954 buf_set_buf(svf_para
.hdr_para
.tdo
, 0, &svf_tdo_buffer
[svf_buffer_index
], i
, svf_para
.hdr_para
.len
);
955 i
+= svf_para
.hdr_para
.len
;
956 buf_set_buf(svf_para
.sdr_para
.tdo
, 0, &svf_tdo_buffer
[svf_buffer_index
], i
, svf_para
.sdr_para
.len
);
957 i
+= svf_para
.sdr_para
.len
;
958 buf_set_buf(svf_para
.tdr_para
.tdo
, 0, &svf_tdo_buffer
[svf_buffer_index
], i
, svf_para
.tdr_para
.len
);
959 i
+= svf_para
.tdr_para
.len
;
961 svf_add_check_para(1, svf_buffer_index
, i
);
965 svf_add_check_para(0, svf_buffer_index
, i
);
969 field
.out_value
= &svf_tdi_buffer
[svf_buffer_index
];
971 field
.in_value
= &svf_tdi_buffer
[svf_buffer_index
];
976 jtag_add_plain_dr_scan(1, &field
, svf_para
.dr_end_state
);
978 svf_buffer_index
+= (i
+ 7) >> 3;
979 last_state
= svf_para
.dr_end_state
;
981 else if (SIR
== command
)
983 // check buffer size first, reallocate if necessary
984 i
= svf_para
.hir_para
.len
+ svf_para
.sir_para
.len
+ svf_para
.tir_para
.len
;
985 if ((svf_buffer_size
- svf_buffer_index
) < ((i
+ 7) >> 3))
988 // simply print error message
989 LOG_ERROR("buffer is not enough, report to author");
995 buffer_tmp
= (u8
*)malloc(svf_buffer_index
+ ((i
+ 7) >> 3));
996 if (NULL
== buffer_tmp
)
998 LOG_ERROR("not enough memory");
1001 memcpy(buffer_tmp
, svf_tdi_buffer
, svf_buffer_index
);
1002 // svf_tdi_buffer isn't NULL here
1003 free(svf_tdi_buffer
);
1004 svf_tdi_buffer
= buffer_tmp
;
1006 buffer_tmp
= (u8
*)malloc(svf_buffer_index
+ ((i
+ 7) >> 3));
1007 if (NULL
== buffer_tmp
)
1009 LOG_ERROR("not enough memory");
1012 memcpy(buffer_tmp
, svf_tdo_buffer
, svf_buffer_index
);
1013 // svf_tdo_buffer isn't NULL here
1014 free(svf_tdo_buffer
);
1015 svf_tdo_buffer
= buffer_tmp
;
1017 buffer_tmp
= (u8
*)malloc(svf_buffer_index
+ ((i
+ 7) >> 3));
1018 if (NULL
== buffer_tmp
)
1020 LOG_ERROR("not enough memory");
1023 memcpy(buffer_tmp
, svf_mask_buffer
, svf_buffer_index
);
1024 // svf_mask_buffer isn't NULL here
1025 free(svf_mask_buffer
);
1026 svf_mask_buffer
= buffer_tmp
;
1029 svf_buffer_size
= svf_buffer_index
+ ((i
+ 7) >> 3);
1035 buf_set_buf(svf_para
.hir_para
.tdi
, 0, &svf_tdi_buffer
[svf_buffer_index
], i
, svf_para
.hir_para
.len
);
1036 i
+= svf_para
.hir_para
.len
;
1037 buf_set_buf(svf_para
.sir_para
.tdi
, 0, &svf_tdi_buffer
[svf_buffer_index
], i
, svf_para
.sir_para
.len
);
1038 i
+= svf_para
.sir_para
.len
;
1039 buf_set_buf(svf_para
.tir_para
.tdi
, 0, &svf_tdi_buffer
[svf_buffer_index
], i
, svf_para
.tir_para
.len
);
1040 i
+= svf_para
.tir_para
.len
;
1043 if (svf_para
.sir_para
.data_mask
& XXR_TDO
)
1045 // assemble dr mask data
1047 buf_set_buf(svf_para
.hir_para
.mask
, 0, &svf_mask_buffer
[svf_buffer_index
], i
, svf_para
.hir_para
.len
);
1048 i
+= svf_para
.hir_para
.len
;
1049 buf_set_buf(svf_para
.sir_para
.mask
, 0, &svf_mask_buffer
[svf_buffer_index
], i
, svf_para
.sir_para
.len
);
1050 i
+= svf_para
.sir_para
.len
;
1051 buf_set_buf(svf_para
.tir_para
.mask
, 0, &svf_mask_buffer
[svf_buffer_index
], i
, svf_para
.tir_para
.len
);
1052 i
+= svf_para
.tir_para
.len
;
1053 // assemble dr check data
1055 buf_set_buf(svf_para
.hir_para
.tdo
, 0, &svf_tdo_buffer
[svf_buffer_index
], i
, svf_para
.hir_para
.len
);
1056 i
+= svf_para
.hir_para
.len
;
1057 buf_set_buf(svf_para
.sir_para
.tdo
, 0, &svf_tdo_buffer
[svf_buffer_index
], i
, svf_para
.sir_para
.len
);
1058 i
+= svf_para
.sir_para
.len
;
1059 buf_set_buf(svf_para
.tir_para
.tdo
, 0, &svf_tdo_buffer
[svf_buffer_index
], i
, svf_para
.tir_para
.len
);
1060 i
+= svf_para
.tir_para
.len
;
1062 svf_add_check_para(1, svf_buffer_index
, i
);
1066 svf_add_check_para(0, svf_buffer_index
, i
);
1070 field
.out_value
= &svf_tdi_buffer
[svf_buffer_index
];
1072 field
.in_value
= &svf_tdi_buffer
[svf_buffer_index
];
1077 jtag_add_plain_ir_scan(1, &field
, svf_para
.ir_end_state
);
1079 svf_buffer_index
+= (i
+ 7) >> 3;
1080 last_state
= svf_para
.ir_end_state
;
1085 LOG_ERROR("PIO and PIOMAP are not supported");
1089 // RUNTEST [run_state] run_count run_clk [min_time SEC [MAXIMUM max_time SEC]] [ENDSTATE end_state]
1090 // RUNTEST [run_state] min_time SEC [MAXIMUM max_time SEC] [ENDSTATE end_state]
1091 if ((num_of_argu
< 3) && (num_of_argu
> 11))
1093 LOG_ERROR("invalid parameter of %s", argus
[0]);
1102 i_tmp
= svf_find_string_in_array(argus
[i
], (char **)svf_tap_state_name
, dimof(svf_tap_state_name
));
1103 if (svf_tap_state_is_valid(i_tmp
))
1105 if (svf_tap_state_is_stable(i_tmp
))
1107 svf_para
.runtest_run_state
= i_tmp
;
1109 // When a run_state is specified, the new run_state becomes the default end_state
1110 svf_para
.runtest_end_state
= i_tmp
;
1111 LOG_DEBUG("\trun_state = %s", svf_tap_state_name
[svf_para
.runtest_run_state
]);
1116 LOG_ERROR("%s is not valid state", svf_tap_state_name
[i_tmp
]);
1120 // run_count run_clk
1121 if (((i
+ 2) <= num_of_argu
) && strcmp(argus
[i
+ 1], "SEC"))
1123 if (!strcmp(argus
[i
+ 1], "TCK"))
1125 // clock source is TCK
1126 run_count
= atoi(argus
[i
]);
1127 LOG_DEBUG("\trun_count@TCK = %d", run_count
);
1131 LOG_ERROR("%s not supported for clock", argus
[i
+ 1]);
1137 if (((i
+ 2) <= num_of_argu
) && !strcmp(argus
[i
+ 1], "SEC"))
1139 min_time
= atof(argus
[i
]);
1140 LOG_DEBUG("\tmin_time = %fs", min_time
);
1143 // MAXIMUM max_time SEC
1144 if (((i
+ 3) <= num_of_argu
) && !strcmp(argus
[i
], "MAXIMUM") && !strcmp(argus
[i
+ 2], "SEC"))
1146 max_time
= atof(argus
[i
+ 1]);
1147 LOG_DEBUG("\tmax_time = %fs", max_time
);
1150 // ENDSTATE end_state
1151 if (((i
+ 2) <= num_of_argu
) && !strcmp(argus
[i
], "ENDSTATE"))
1153 i_tmp
= svf_find_string_in_array(argus
[i
+ 1], (char **)svf_tap_state_name
, dimof(svf_tap_state_name
));
1154 if (svf_tap_state_is_stable(i_tmp
))
1156 svf_para
.runtest_end_state
= i_tmp
;
1157 LOG_DEBUG("\tend_state = %s", svf_tap_state_name
[svf_para
.runtest_end_state
]);
1161 LOG_ERROR("%s is not valid state", svf_tap_state_name
[i_tmp
]);
1166 // calculate run_count
1167 if ((0 == run_count
) && (min_time
> 0))
1169 run_count
= min_time
* svf_para
.frequency
;
1171 // all parameter should be parsed
1172 if (i
== num_of_argu
)
1176 // run_state and end_state is checked to be stable state
1179 // enter into run_state if necessary
1180 if (last_state
!= svf_para
.runtest_run_state
)
1182 jtag_command_t
* cmd
= cmd_queue_alloc(sizeof(jtag_command_t
));
1184 jtag_queue_command(cmd
);
1186 cmd
->type
= JTAG_STATEMOVE
;
1187 cmd
->cmd
.statemove
= cmd_queue_alloc(sizeof(statemove_command_t
));
1188 cmd
->cmd
.statemove
->end_state
= svf_para
.runtest_run_state
;
1190 cmd_queue_end_state
= cmd_queue_cur_state
= cmd
->cmd
.statemove
->end_state
;
1193 // call jtag_add_clocks
1194 jtag_add_clocks(run_count
);
1196 if (svf_para
.runtest_end_state
!= svf_para
.runtest_run_state
)
1198 // move to end_state
1199 jtag_command_t
* cmd
= cmd_queue_alloc(sizeof(jtag_command_t
));
1201 jtag_queue_command(cmd
);
1202 cmd
->type
= JTAG_STATEMOVE
;
1203 cmd
->cmd
.statemove
= cmd_queue_alloc(sizeof(statemove_command_t
));
1204 cmd
->cmd
.statemove
->end_state
= svf_para
.runtest_end_state
;
1206 cmd_queue_end_state
= cmd_queue_cur_state
= cmd
->cmd
.statemove
->end_state
;
1208 last_state
= svf_para
.runtest_end_state
;
1210 if (svf_para
.runtest_run_state
!= TAP_IDLE
)
1212 // RUNTEST can only executed in TAP_IDLE
1213 LOG_ERROR("cannot runtest in %s state", svf_tap_state_name
[svf_para
.runtest_run_state
]);
1217 jtag_add_runtest(run_count
, svf_para
.runtest_end_state
);
1223 LOG_ERROR("fail to parse parameter of RUNTEST, %d out of %d is parsed", i
, num_of_argu
);
1228 // STATE [pathstate1 [pathstate2 ...[pathstaten]]] stable_state
1229 if (num_of_argu
< 2)
1231 LOG_ERROR("invalid parameter of %s", argus
[0]);
1234 if (num_of_argu
> 2)
1236 // STATE pathstate1 ... stable_state
1237 path
= (tap_state_t
*)malloc((num_of_argu
- 1) * sizeof(tap_state_t
));
1240 LOG_ERROR("not enough memory");
1243 num_of_argu
--; // num of path
1244 i_tmp
= 1; // path is from patameter 1
1245 for (i
= 0; i
< num_of_argu
; i
++)
1247 path
[i
] = svf_find_string_in_array(argus
[i_tmp
++], (char **)svf_tap_state_name
, dimof(svf_tap_state_name
));
1248 if (!svf_tap_state_is_valid(path
[i
]))
1250 LOG_ERROR("%s is not valid state", svf_tap_state_name
[path
[i
]]);
1253 if (TAP_RESET
== path
[i
])
1257 jtag_add_pathmove(i
, path
);
1260 num_of_argu
-= i
+ 1;
1264 if (num_of_argu
> 0)
1266 // execute last path if necessary
1267 if (svf_tap_state_is_stable(path
[num_of_argu
- 1]))
1269 // last state MUST be stable state
1270 // TODO: call path_move
1271 jtag_add_pathmove(num_of_argu
, path
);
1272 last_state
= path
[num_of_argu
- 1];
1273 LOG_DEBUG("\tmove to %s by path_move", svf_tap_state_name
[path
[num_of_argu
- 1]]);
1277 LOG_ERROR("%s is not valid state", svf_tap_state_name
[path
[num_of_argu
- 1]]);
1281 // no need to keep this memory, in jtag_add_pathmove, path will be duplicated
1290 // STATE stable_state
1291 state
= svf_find_string_in_array(argus
[1], (char **)svf_tap_state_name
, dimof(svf_tap_state_name
));
1292 if (svf_tap_state_is_stable(state
))
1294 // TODO: move to state
1295 jtag_command_t
* cmd
= cmd_queue_alloc(sizeof(jtag_command_t
));
1297 jtag_queue_command(cmd
);
1299 cmd
->type
= JTAG_STATEMOVE
;
1300 cmd
->cmd
.statemove
= cmd_queue_alloc(sizeof(statemove_command_t
));
1301 cmd
->cmd
.statemove
->end_state
= state
;
1303 cmd_queue_end_state
= cmd_queue_cur_state
= cmd
->cmd
.statemove
->end_state
;
1306 LOG_DEBUG("\tmove to %s by state_move", svf_tap_state_name
[state
]);
1310 LOG_ERROR("%s is not valid state", svf_tap_state_name
[state
]);
1317 if (num_of_argu
!= 2)
1319 LOG_ERROR("invalid parameter of %s", argus
[0]);
1322 if (svf_para
.trst_mode
!= TRST_ABSENT
)
1324 if (ERROR_OK
!= svf_execute_tap())
1328 i_tmp
= svf_find_string_in_array(argus
[1], (char **)svf_trst_mode_name
, dimof(svf_trst_mode_name
));
1332 last_state
= TAP_RESET
;
1333 jtag_add_reset(1, 0);
1337 jtag_add_reset(0, 0);
1342 LOG_ERROR("unknown TRST mode: %s", argus
[1]);
1345 svf_para
.trst_mode
= i_tmp
;
1346 LOG_DEBUG("\ttrst_mode = %s", svf_trst_mode_name
[svf_para
.trst_mode
]);
1350 LOG_ERROR("can not accpet TRST command if trst_mode is ABSENT");
1355 LOG_ERROR("invalid svf command: %s", argus
[0]);
1360 if (debug_level
>= LOG_LVL_DEBUG
)
1362 // for convenient debugging, execute tap if possible
1363 if ((svf_buffer_index
> 0) && \
1364 (((command
!= STATE
) && (command
!= RUNTEST
)) || \
1365 ((command
== STATE
) && (num_of_argu
== 2))))
1367 if (ERROR_OK
!= svf_execute_tap())
1372 // output debug info
1373 if ((SIR
== command
) || (SDR
== command
))
1376 memcpy(&read_value
, svf_tdi_buffer
, sizeof(int));
1377 // in debug mode, data is from index 0
1378 int read_mask
= (1 << (svf_check_tdo_para
[0].bit_len
)) - 1;
1379 LOG_DEBUG("\tTDO read = 0x%X", read_value
& read_mask
);
1385 // for fast executing, execute tap if necessary
1386 // half of the buffer is for the next command
1387 if (((svf_buffer_index
>= SVF_MAX_BUFFER_SIZE_TO_COMMIT
) || (svf_check_tdo_para_index
>= SVF_CHECK_TDO_PARA_SIZE
/ 2)) && \
1388 (((command
!= STATE
) && (command
!= RUNTEST
)) || \
1389 ((command
== STATE
) && (num_of_argu
== 2))))
1391 return svf_execute_tap();
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)