svf: factorize big switch case
Factorize function svf_run_command() by moving out of the 'case' the common code related to the label 'xxr_common'. The target is to drop later on the ugly label 'xxr_common' inside the switch. Apart for: - the function and local variables declaration, - the added function call in place of original code, - the reduced indentation in the new function, this change is a dummy copy/paste with no code modification. Change-Id: I8149cf25f460326ba6666a9287c5c309e5d99488 Signed-off-by: Antonio Borneo <borneo.antonio@gmail.com> Reviewed-on: https://review.openocd.org/c/openocd/+/9040 Tested-by: jenkins
This commit is contained in:
Antonio Borneo
575
src/svf/svf.c
575
src/svf/svf.c
@@ -979,10 +979,299 @@ static int svf_execute_tap(void)
|
|||||||
return ERROR_OK;
|
return ERROR_OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int svf_xxr_common(char **argus, int num_of_argu, char command, struct svf_xxr_para *xxr_para_tmp)
|
||||||
|
{
|
||||||
|
int i, i_tmp;
|
||||||
|
uint8_t **pbuffer_tmp;
|
||||||
|
struct scan_field field;
|
||||||
|
|
||||||
|
/* XXR length [TDI (tdi)] [TDO (tdo)][MASK (mask)] [SMASK (smask)] */
|
||||||
|
if (num_of_argu > 10 || (num_of_argu % 2)) {
|
||||||
|
LOG_ERROR("invalid parameter of %s", argus[0]);
|
||||||
|
return ERROR_FAIL;
|
||||||
|
}
|
||||||
|
i_tmp = xxr_para_tmp->len;
|
||||||
|
xxr_para_tmp->len = atoi(argus[1]);
|
||||||
|
/* If we are to enlarge the buffers, all parts of xxr_para_tmp
|
||||||
|
* need to be freed */
|
||||||
|
if (i_tmp < xxr_para_tmp->len) {
|
||||||
|
free(xxr_para_tmp->tdi);
|
||||||
|
xxr_para_tmp->tdi = NULL;
|
||||||
|
free(xxr_para_tmp->tdo);
|
||||||
|
xxr_para_tmp->tdo = NULL;
|
||||||
|
free(xxr_para_tmp->mask);
|
||||||
|
xxr_para_tmp->mask = NULL;
|
||||||
|
free(xxr_para_tmp->smask);
|
||||||
|
xxr_para_tmp->smask = NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
LOG_DEBUG("\tlength = %d", xxr_para_tmp->len);
|
||||||
|
xxr_para_tmp->data_mask = 0;
|
||||||
|
for (i = 2; i < num_of_argu; i += 2) {
|
||||||
|
if ((strlen(argus[i + 1]) < 3) || (argus[i + 1][0] != '(') ||
|
||||||
|
argus[i + 1][strlen(argus[i + 1]) - 1] != ')') {
|
||||||
|
LOG_ERROR("data section error");
|
||||||
|
return ERROR_FAIL;
|
||||||
|
}
|
||||||
|
argus[i + 1][strlen(argus[i + 1]) - 1] = '\0';
|
||||||
|
/* TDI, TDO, MASK, SMASK */
|
||||||
|
if (!strcmp(argus[i], "TDI")) {
|
||||||
|
/* TDI */
|
||||||
|
pbuffer_tmp = &xxr_para_tmp->tdi;
|
||||||
|
xxr_para_tmp->data_mask |= XXR_TDI;
|
||||||
|
} else if (!strcmp(argus[i], "TDO")) {
|
||||||
|
/* TDO */
|
||||||
|
pbuffer_tmp = &xxr_para_tmp->tdo;
|
||||||
|
xxr_para_tmp->data_mask |= XXR_TDO;
|
||||||
|
} else if (!strcmp(argus[i], "MASK")) {
|
||||||
|
/* MASK */
|
||||||
|
pbuffer_tmp = &xxr_para_tmp->mask;
|
||||||
|
xxr_para_tmp->data_mask |= XXR_MASK;
|
||||||
|
} else if (!strcmp(argus[i], "SMASK")) {
|
||||||
|
/* SMASK */
|
||||||
|
pbuffer_tmp = &xxr_para_tmp->smask;
|
||||||
|
xxr_para_tmp->data_mask |= XXR_SMASK;
|
||||||
|
} else {
|
||||||
|
LOG_ERROR("unknown parameter: %s", argus[i]);
|
||||||
|
return ERROR_FAIL;
|
||||||
|
}
|
||||||
|
if (ERROR_OK !=
|
||||||
|
svf_copy_hexstring_to_binary(&argus[i + 1][1], pbuffer_tmp, i_tmp,
|
||||||
|
xxr_para_tmp->len)) {
|
||||||
|
LOG_ERROR("fail to parse hex value");
|
||||||
|
return ERROR_FAIL;
|
||||||
|
}
|
||||||
|
SVF_BUF_LOG(DEBUG, *pbuffer_tmp, xxr_para_tmp->len, argus[i]);
|
||||||
|
}
|
||||||
|
/* If a command changes the length of the last scan of the same type and the
|
||||||
|
* MASK parameter is absent, */
|
||||||
|
/* the mask pattern used is all cares */
|
||||||
|
if (!(xxr_para_tmp->data_mask & XXR_MASK) && i_tmp != xxr_para_tmp->len) {
|
||||||
|
/* MASK not defined and length changed */
|
||||||
|
if (ERROR_OK !=
|
||||||
|
svf_adjust_array_length(&xxr_para_tmp->mask, i_tmp,
|
||||||
|
xxr_para_tmp->len)) {
|
||||||
|
LOG_ERROR("fail to adjust length of array");
|
||||||
|
return ERROR_FAIL;
|
||||||
|
}
|
||||||
|
buf_set_ones(xxr_para_tmp->mask, xxr_para_tmp->len);
|
||||||
|
}
|
||||||
|
/* If TDO is absent, no comparison is needed, set the mask to 0 */
|
||||||
|
if (!(xxr_para_tmp->data_mask & XXR_TDO)) {
|
||||||
|
if (!xxr_para_tmp->tdo) {
|
||||||
|
if (ERROR_OK !=
|
||||||
|
svf_adjust_array_length(&xxr_para_tmp->tdo, i_tmp,
|
||||||
|
xxr_para_tmp->len)) {
|
||||||
|
LOG_ERROR("fail to adjust length of array");
|
||||||
|
return ERROR_FAIL;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if (!xxr_para_tmp->mask) {
|
||||||
|
if (ERROR_OK !=
|
||||||
|
svf_adjust_array_length(&xxr_para_tmp->mask, i_tmp,
|
||||||
|
xxr_para_tmp->len)) {
|
||||||
|
LOG_ERROR("fail to adjust length of array");
|
||||||
|
return ERROR_FAIL;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
memset(xxr_para_tmp->mask, 0, (xxr_para_tmp->len + 7) >> 3);
|
||||||
|
}
|
||||||
|
/* do scan if necessary */
|
||||||
|
if (command == SDR) {
|
||||||
|
/* check buffer size first, reallocate if necessary */
|
||||||
|
i = svf_para.hdr_para.len + svf_para.sdr_para.len +
|
||||||
|
svf_para.tdr_para.len;
|
||||||
|
if ((svf_buffer_size - svf_buffer_index) < ((i + 7) >> 3)) {
|
||||||
|
/* reallocate buffer */
|
||||||
|
if (svf_realloc_buffers(svf_buffer_index + ((i + 7) >> 3)) != ERROR_OK) {
|
||||||
|
LOG_ERROR("not enough memory");
|
||||||
|
return ERROR_FAIL;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* assemble dr data */
|
||||||
|
i = 0;
|
||||||
|
buf_set_buf(svf_para.hdr_para.tdi,
|
||||||
|
0,
|
||||||
|
&svf_tdi_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.hdr_para.len);
|
||||||
|
i += svf_para.hdr_para.len;
|
||||||
|
buf_set_buf(svf_para.sdr_para.tdi,
|
||||||
|
0,
|
||||||
|
&svf_tdi_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.sdr_para.len);
|
||||||
|
i += svf_para.sdr_para.len;
|
||||||
|
buf_set_buf(svf_para.tdr_para.tdi,
|
||||||
|
0,
|
||||||
|
&svf_tdi_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.tdr_para.len);
|
||||||
|
i += svf_para.tdr_para.len;
|
||||||
|
|
||||||
|
/* add check data */
|
||||||
|
if (svf_para.sdr_para.data_mask & XXR_TDO) {
|
||||||
|
/* assemble dr mask data */
|
||||||
|
i = 0;
|
||||||
|
buf_set_buf(svf_para.hdr_para.mask,
|
||||||
|
0,
|
||||||
|
&svf_mask_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.hdr_para.len);
|
||||||
|
i += svf_para.hdr_para.len;
|
||||||
|
buf_set_buf(svf_para.sdr_para.mask,
|
||||||
|
0,
|
||||||
|
&svf_mask_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.sdr_para.len);
|
||||||
|
i += svf_para.sdr_para.len;
|
||||||
|
buf_set_buf(svf_para.tdr_para.mask,
|
||||||
|
0,
|
||||||
|
&svf_mask_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.tdr_para.len);
|
||||||
|
|
||||||
|
/* assemble dr check data */
|
||||||
|
i = 0;
|
||||||
|
buf_set_buf(svf_para.hdr_para.tdo,
|
||||||
|
0,
|
||||||
|
&svf_tdo_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.hdr_para.len);
|
||||||
|
i += svf_para.hdr_para.len;
|
||||||
|
buf_set_buf(svf_para.sdr_para.tdo,
|
||||||
|
0,
|
||||||
|
&svf_tdo_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.sdr_para.len);
|
||||||
|
i += svf_para.sdr_para.len;
|
||||||
|
buf_set_buf(svf_para.tdr_para.tdo,
|
||||||
|
0,
|
||||||
|
&svf_tdo_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.tdr_para.len);
|
||||||
|
i += svf_para.tdr_para.len;
|
||||||
|
|
||||||
|
svf_add_check_para(1, svf_buffer_index, i);
|
||||||
|
} else {
|
||||||
|
svf_add_check_para(0, svf_buffer_index, i);
|
||||||
|
}
|
||||||
|
field.num_bits = i;
|
||||||
|
field.out_value = &svf_tdi_buffer[svf_buffer_index];
|
||||||
|
field.in_value = (xxr_para_tmp->data_mask & XXR_TDO) ? &svf_tdi_buffer[svf_buffer_index] : NULL;
|
||||||
|
if (!svf_nil) {
|
||||||
|
/* NOTE: doesn't use SVF-specified state paths */
|
||||||
|
jtag_add_plain_dr_scan(field.num_bits,
|
||||||
|
field.out_value,
|
||||||
|
field.in_value,
|
||||||
|
svf_para.dr_end_state);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (svf_addcycles)
|
||||||
|
jtag_add_clocks(svf_addcycles);
|
||||||
|
|
||||||
|
svf_buffer_index += (i + 7) >> 3;
|
||||||
|
} else if (command == SIR) {
|
||||||
|
/* check buffer size first, reallocate if necessary */
|
||||||
|
i = svf_para.hir_para.len + svf_para.sir_para.len +
|
||||||
|
svf_para.tir_para.len;
|
||||||
|
if ((svf_buffer_size - svf_buffer_index) < ((i + 7) >> 3)) {
|
||||||
|
if (svf_realloc_buffers(svf_buffer_index + ((i + 7) >> 3)) != ERROR_OK) {
|
||||||
|
LOG_ERROR("not enough memory");
|
||||||
|
return ERROR_FAIL;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* assemble ir data */
|
||||||
|
i = 0;
|
||||||
|
buf_set_buf(svf_para.hir_para.tdi,
|
||||||
|
0,
|
||||||
|
&svf_tdi_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.hir_para.len);
|
||||||
|
i += svf_para.hir_para.len;
|
||||||
|
buf_set_buf(svf_para.sir_para.tdi,
|
||||||
|
0,
|
||||||
|
&svf_tdi_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.sir_para.len);
|
||||||
|
i += svf_para.sir_para.len;
|
||||||
|
buf_set_buf(svf_para.tir_para.tdi,
|
||||||
|
0,
|
||||||
|
&svf_tdi_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.tir_para.len);
|
||||||
|
i += svf_para.tir_para.len;
|
||||||
|
|
||||||
|
/* add check data */
|
||||||
|
if (svf_para.sir_para.data_mask & XXR_TDO) {
|
||||||
|
/* assemble dr mask data */
|
||||||
|
i = 0;
|
||||||
|
buf_set_buf(svf_para.hir_para.mask,
|
||||||
|
0,
|
||||||
|
&svf_mask_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.hir_para.len);
|
||||||
|
i += svf_para.hir_para.len;
|
||||||
|
buf_set_buf(svf_para.sir_para.mask,
|
||||||
|
0,
|
||||||
|
&svf_mask_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.sir_para.len);
|
||||||
|
i += svf_para.sir_para.len;
|
||||||
|
buf_set_buf(svf_para.tir_para.mask,
|
||||||
|
0,
|
||||||
|
&svf_mask_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.tir_para.len);
|
||||||
|
|
||||||
|
/* assemble dr check data */
|
||||||
|
i = 0;
|
||||||
|
buf_set_buf(svf_para.hir_para.tdo,
|
||||||
|
0,
|
||||||
|
&svf_tdo_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.hir_para.len);
|
||||||
|
i += svf_para.hir_para.len;
|
||||||
|
buf_set_buf(svf_para.sir_para.tdo,
|
||||||
|
0,
|
||||||
|
&svf_tdo_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.sir_para.len);
|
||||||
|
i += svf_para.sir_para.len;
|
||||||
|
buf_set_buf(svf_para.tir_para.tdo,
|
||||||
|
0,
|
||||||
|
&svf_tdo_buffer[svf_buffer_index],
|
||||||
|
i,
|
||||||
|
svf_para.tir_para.len);
|
||||||
|
i += svf_para.tir_para.len;
|
||||||
|
|
||||||
|
svf_add_check_para(1, svf_buffer_index, i);
|
||||||
|
} else {
|
||||||
|
svf_add_check_para(0, svf_buffer_index, i);
|
||||||
|
}
|
||||||
|
field.num_bits = i;
|
||||||
|
field.out_value = &svf_tdi_buffer[svf_buffer_index];
|
||||||
|
field.in_value = (xxr_para_tmp->data_mask & XXR_TDO) ? &svf_tdi_buffer[svf_buffer_index] : NULL;
|
||||||
|
if (!svf_nil) {
|
||||||
|
/* NOTE: doesn't use SVF-specified state paths */
|
||||||
|
jtag_add_plain_ir_scan(field.num_bits,
|
||||||
|
field.out_value,
|
||||||
|
field.in_value,
|
||||||
|
svf_para.ir_end_state);
|
||||||
|
}
|
||||||
|
|
||||||
|
svf_buffer_index += (i + 7) >> 3;
|
||||||
|
}
|
||||||
|
|
||||||
|
return ERROR_OK;
|
||||||
|
}
|
||||||
|
|
||||||
static int svf_run_command(struct command_context *cmd_ctx, char *cmd_str)
|
static int svf_run_command(struct command_context *cmd_ctx, char *cmd_str)
|
||||||
{
|
{
|
||||||
char *argus[256], command;
|
char *argus[256], command;
|
||||||
int num_of_argu = 0, i;
|
int num_of_argu = 0, i, retval;
|
||||||
|
|
||||||
/* tmp variable */
|
/* tmp variable */
|
||||||
int i_tmp;
|
int i_tmp;
|
||||||
@@ -992,8 +1281,6 @@ static int svf_run_command(struct command_context *cmd_ctx, char *cmd_str)
|
|||||||
float min_time;
|
float min_time;
|
||||||
/* for XXR */
|
/* for XXR */
|
||||||
struct svf_xxr_para *xxr_para_tmp;
|
struct svf_xxr_para *xxr_para_tmp;
|
||||||
uint8_t **pbuffer_tmp;
|
|
||||||
struct scan_field field;
|
|
||||||
/* for STATE */
|
/* for STATE */
|
||||||
enum tap_state *path = NULL, state;
|
enum tap_state *path = NULL, state;
|
||||||
/* flag padding commands skipped due to -tap command */
|
/* flag padding commands skipped due to -tap command */
|
||||||
@@ -1094,285 +1381,9 @@ static int svf_run_command(struct command_context *cmd_ctx, char *cmd_str)
|
|||||||
xxr_para_tmp = &svf_para.sir_para;
|
xxr_para_tmp = &svf_para.sir_para;
|
||||||
goto xxr_common;
|
goto xxr_common;
|
||||||
xxr_common:
|
xxr_common:
|
||||||
/* XXR length [TDI (tdi)] [TDO (tdo)][MASK (mask)] [SMASK (smask)] */
|
retval = svf_xxr_common(argus, num_of_argu, command, xxr_para_tmp);
|
||||||
if (num_of_argu > 10 || (num_of_argu % 2)) {
|
if (retval != ERROR_OK)
|
||||||
LOG_ERROR("invalid parameter of %s", argus[0]);
|
return retval;
|
||||||
return ERROR_FAIL;
|
|
||||||
}
|
|
||||||
i_tmp = xxr_para_tmp->len;
|
|
||||||
xxr_para_tmp->len = atoi(argus[1]);
|
|
||||||
/* If we are to enlarge the buffers, all parts of xxr_para_tmp
|
|
||||||
* need to be freed */
|
|
||||||
if (i_tmp < xxr_para_tmp->len) {
|
|
||||||
free(xxr_para_tmp->tdi);
|
|
||||||
xxr_para_tmp->tdi = NULL;
|
|
||||||
free(xxr_para_tmp->tdo);
|
|
||||||
xxr_para_tmp->tdo = NULL;
|
|
||||||
free(xxr_para_tmp->mask);
|
|
||||||
xxr_para_tmp->mask = NULL;
|
|
||||||
free(xxr_para_tmp->smask);
|
|
||||||
xxr_para_tmp->smask = NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
LOG_DEBUG("\tlength = %d", xxr_para_tmp->len);
|
|
||||||
xxr_para_tmp->data_mask = 0;
|
|
||||||
for (i = 2; i < num_of_argu; i += 2) {
|
|
||||||
if ((strlen(argus[i + 1]) < 3) || (argus[i + 1][0] != '(') ||
|
|
||||||
argus[i + 1][strlen(argus[i + 1]) - 1] != ')') {
|
|
||||||
LOG_ERROR("data section error");
|
|
||||||
return ERROR_FAIL;
|
|
||||||
}
|
|
||||||
argus[i + 1][strlen(argus[i + 1]) - 1] = '\0';
|
|
||||||
/* TDI, TDO, MASK, SMASK */
|
|
||||||
if (!strcmp(argus[i], "TDI")) {
|
|
||||||
/* TDI */
|
|
||||||
pbuffer_tmp = &xxr_para_tmp->tdi;
|
|
||||||
xxr_para_tmp->data_mask |= XXR_TDI;
|
|
||||||
} else if (!strcmp(argus[i], "TDO")) {
|
|
||||||
/* TDO */
|
|
||||||
pbuffer_tmp = &xxr_para_tmp->tdo;
|
|
||||||
xxr_para_tmp->data_mask |= XXR_TDO;
|
|
||||||
} else if (!strcmp(argus[i], "MASK")) {
|
|
||||||
/* MASK */
|
|
||||||
pbuffer_tmp = &xxr_para_tmp->mask;
|
|
||||||
xxr_para_tmp->data_mask |= XXR_MASK;
|
|
||||||
} else if (!strcmp(argus[i], "SMASK")) {
|
|
||||||
/* SMASK */
|
|
||||||
pbuffer_tmp = &xxr_para_tmp->smask;
|
|
||||||
xxr_para_tmp->data_mask |= XXR_SMASK;
|
|
||||||
} else {
|
|
||||||
LOG_ERROR("unknown parameter: %s", argus[i]);
|
|
||||||
return ERROR_FAIL;
|
|
||||||
}
|
|
||||||
if (ERROR_OK !=
|
|
||||||
svf_copy_hexstring_to_binary(&argus[i + 1][1], pbuffer_tmp, i_tmp,
|
|
||||||
xxr_para_tmp->len)) {
|
|
||||||
LOG_ERROR("fail to parse hex value");
|
|
||||||
return ERROR_FAIL;
|
|
||||||
}
|
|
||||||
SVF_BUF_LOG(DEBUG, *pbuffer_tmp, xxr_para_tmp->len, argus[i]);
|
|
||||||
}
|
|
||||||
/* If a command changes the length of the last scan of the same type and the
|
|
||||||
* MASK parameter is absent, */
|
|
||||||
/* the mask pattern used is all cares */
|
|
||||||
if (!(xxr_para_tmp->data_mask & XXR_MASK) && i_tmp != xxr_para_tmp->len) {
|
|
||||||
/* MASK not defined and length changed */
|
|
||||||
if (ERROR_OK !=
|
|
||||||
svf_adjust_array_length(&xxr_para_tmp->mask, i_tmp,
|
|
||||||
xxr_para_tmp->len)) {
|
|
||||||
LOG_ERROR("fail to adjust length of array");
|
|
||||||
return ERROR_FAIL;
|
|
||||||
}
|
|
||||||
buf_set_ones(xxr_para_tmp->mask, xxr_para_tmp->len);
|
|
||||||
}
|
|
||||||
/* If TDO is absent, no comparison is needed, set the mask to 0 */
|
|
||||||
if (!(xxr_para_tmp->data_mask & XXR_TDO)) {
|
|
||||||
if (!xxr_para_tmp->tdo) {
|
|
||||||
if (ERROR_OK !=
|
|
||||||
svf_adjust_array_length(&xxr_para_tmp->tdo, i_tmp,
|
|
||||||
xxr_para_tmp->len)) {
|
|
||||||
LOG_ERROR("fail to adjust length of array");
|
|
||||||
return ERROR_FAIL;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
if (!xxr_para_tmp->mask) {
|
|
||||||
if (ERROR_OK !=
|
|
||||||
svf_adjust_array_length(&xxr_para_tmp->mask, i_tmp,
|
|
||||||
xxr_para_tmp->len)) {
|
|
||||||
LOG_ERROR("fail to adjust length of array");
|
|
||||||
return ERROR_FAIL;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
memset(xxr_para_tmp->mask, 0, (xxr_para_tmp->len + 7) >> 3);
|
|
||||||
}
|
|
||||||
/* do scan if necessary */
|
|
||||||
if (command == SDR) {
|
|
||||||
/* check buffer size first, reallocate if necessary */
|
|
||||||
i = svf_para.hdr_para.len + svf_para.sdr_para.len +
|
|
||||||
svf_para.tdr_para.len;
|
|
||||||
if ((svf_buffer_size - svf_buffer_index) < ((i + 7) >> 3)) {
|
|
||||||
/* reallocate buffer */
|
|
||||||
if (svf_realloc_buffers(svf_buffer_index + ((i + 7) >> 3)) != ERROR_OK) {
|
|
||||||
LOG_ERROR("not enough memory");
|
|
||||||
return ERROR_FAIL;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* assemble dr data */
|
|
||||||
i = 0;
|
|
||||||
buf_set_buf(svf_para.hdr_para.tdi,
|
|
||||||
0,
|
|
||||||
&svf_tdi_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.hdr_para.len);
|
|
||||||
i += svf_para.hdr_para.len;
|
|
||||||
buf_set_buf(svf_para.sdr_para.tdi,
|
|
||||||
0,
|
|
||||||
&svf_tdi_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.sdr_para.len);
|
|
||||||
i += svf_para.sdr_para.len;
|
|
||||||
buf_set_buf(svf_para.tdr_para.tdi,
|
|
||||||
0,
|
|
||||||
&svf_tdi_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.tdr_para.len);
|
|
||||||
i += svf_para.tdr_para.len;
|
|
||||||
|
|
||||||
/* add check data */
|
|
||||||
if (svf_para.sdr_para.data_mask & XXR_TDO) {
|
|
||||||
/* assemble dr mask data */
|
|
||||||
i = 0;
|
|
||||||
buf_set_buf(svf_para.hdr_para.mask,
|
|
||||||
0,
|
|
||||||
&svf_mask_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.hdr_para.len);
|
|
||||||
i += svf_para.hdr_para.len;
|
|
||||||
buf_set_buf(svf_para.sdr_para.mask,
|
|
||||||
0,
|
|
||||||
&svf_mask_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.sdr_para.len);
|
|
||||||
i += svf_para.sdr_para.len;
|
|
||||||
buf_set_buf(svf_para.tdr_para.mask,
|
|
||||||
0,
|
|
||||||
&svf_mask_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.tdr_para.len);
|
|
||||||
|
|
||||||
/* assemble dr check data */
|
|
||||||
i = 0;
|
|
||||||
buf_set_buf(svf_para.hdr_para.tdo,
|
|
||||||
0,
|
|
||||||
&svf_tdo_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.hdr_para.len);
|
|
||||||
i += svf_para.hdr_para.len;
|
|
||||||
buf_set_buf(svf_para.sdr_para.tdo,
|
|
||||||
0,
|
|
||||||
&svf_tdo_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.sdr_para.len);
|
|
||||||
i += svf_para.sdr_para.len;
|
|
||||||
buf_set_buf(svf_para.tdr_para.tdo,
|
|
||||||
0,
|
|
||||||
&svf_tdo_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.tdr_para.len);
|
|
||||||
i += svf_para.tdr_para.len;
|
|
||||||
|
|
||||||
svf_add_check_para(1, svf_buffer_index, i);
|
|
||||||
} else {
|
|
||||||
svf_add_check_para(0, svf_buffer_index, i);
|
|
||||||
}
|
|
||||||
field.num_bits = i;
|
|
||||||
field.out_value = &svf_tdi_buffer[svf_buffer_index];
|
|
||||||
field.in_value = (xxr_para_tmp->data_mask & XXR_TDO) ? &svf_tdi_buffer[svf_buffer_index] : NULL;
|
|
||||||
if (!svf_nil) {
|
|
||||||
/* NOTE: doesn't use SVF-specified state paths */
|
|
||||||
jtag_add_plain_dr_scan(field.num_bits,
|
|
||||||
field.out_value,
|
|
||||||
field.in_value,
|
|
||||||
svf_para.dr_end_state);
|
|
||||||
}
|
|
||||||
|
|
||||||
if (svf_addcycles)
|
|
||||||
jtag_add_clocks(svf_addcycles);
|
|
||||||
|
|
||||||
svf_buffer_index += (i + 7) >> 3;
|
|
||||||
} else if (command == SIR) {
|
|
||||||
/* check buffer size first, reallocate if necessary */
|
|
||||||
i = svf_para.hir_para.len + svf_para.sir_para.len +
|
|
||||||
svf_para.tir_para.len;
|
|
||||||
if ((svf_buffer_size - svf_buffer_index) < ((i + 7) >> 3)) {
|
|
||||||
if (svf_realloc_buffers(svf_buffer_index + ((i + 7) >> 3)) != ERROR_OK) {
|
|
||||||
LOG_ERROR("not enough memory");
|
|
||||||
return ERROR_FAIL;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* assemble ir data */
|
|
||||||
i = 0;
|
|
||||||
buf_set_buf(svf_para.hir_para.tdi,
|
|
||||||
0,
|
|
||||||
&svf_tdi_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.hir_para.len);
|
|
||||||
i += svf_para.hir_para.len;
|
|
||||||
buf_set_buf(svf_para.sir_para.tdi,
|
|
||||||
0,
|
|
||||||
&svf_tdi_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.sir_para.len);
|
|
||||||
i += svf_para.sir_para.len;
|
|
||||||
buf_set_buf(svf_para.tir_para.tdi,
|
|
||||||
0,
|
|
||||||
&svf_tdi_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.tir_para.len);
|
|
||||||
i += svf_para.tir_para.len;
|
|
||||||
|
|
||||||
/* add check data */
|
|
||||||
if (svf_para.sir_para.data_mask & XXR_TDO) {
|
|
||||||
/* assemble dr mask data */
|
|
||||||
i = 0;
|
|
||||||
buf_set_buf(svf_para.hir_para.mask,
|
|
||||||
0,
|
|
||||||
&svf_mask_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.hir_para.len);
|
|
||||||
i += svf_para.hir_para.len;
|
|
||||||
buf_set_buf(svf_para.sir_para.mask,
|
|
||||||
0,
|
|
||||||
&svf_mask_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.sir_para.len);
|
|
||||||
i += svf_para.sir_para.len;
|
|
||||||
buf_set_buf(svf_para.tir_para.mask,
|
|
||||||
0,
|
|
||||||
&svf_mask_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.tir_para.len);
|
|
||||||
|
|
||||||
/* assemble dr check data */
|
|
||||||
i = 0;
|
|
||||||
buf_set_buf(svf_para.hir_para.tdo,
|
|
||||||
0,
|
|
||||||
&svf_tdo_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.hir_para.len);
|
|
||||||
i += svf_para.hir_para.len;
|
|
||||||
buf_set_buf(svf_para.sir_para.tdo,
|
|
||||||
0,
|
|
||||||
&svf_tdo_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.sir_para.len);
|
|
||||||
i += svf_para.sir_para.len;
|
|
||||||
buf_set_buf(svf_para.tir_para.tdo,
|
|
||||||
0,
|
|
||||||
&svf_tdo_buffer[svf_buffer_index],
|
|
||||||
i,
|
|
||||||
svf_para.tir_para.len);
|
|
||||||
i += svf_para.tir_para.len;
|
|
||||||
|
|
||||||
svf_add_check_para(1, svf_buffer_index, i);
|
|
||||||
} else {
|
|
||||||
svf_add_check_para(0, svf_buffer_index, i);
|
|
||||||
}
|
|
||||||
field.num_bits = i;
|
|
||||||
field.out_value = &svf_tdi_buffer[svf_buffer_index];
|
|
||||||
field.in_value = (xxr_para_tmp->data_mask & XXR_TDO) ? &svf_tdi_buffer[svf_buffer_index] : NULL;
|
|
||||||
if (!svf_nil) {
|
|
||||||
/* NOTE: doesn't use SVF-specified state paths */
|
|
||||||
jtag_add_plain_ir_scan(field.num_bits,
|
|
||||||
field.out_value,
|
|
||||||
field.in_value,
|
|
||||||
svf_para.ir_end_state);
|
|
||||||
}
|
|
||||||
|
|
||||||
svf_buffer_index += (i + 7) >> 3;
|
|
||||||
}
|
|
||||||
break;
|
break;
|
||||||
case PIO:
|
case PIO:
|
||||||
case PIOMAP:
|
case PIOMAP:
|
||||||
|
|||||||
Reference in New Issue
Block a user