embedded hosts: optimize common code path for core arm operations
avoid fn call for the if check on whether anything needs to be done. Signed-off-by: Øyvind Harboe <oyvind.harboe@zylin.com>
This commit is contained in:
parent
a34345451d
commit
068626fde4
|
@ -31,66 +31,55 @@
|
||||||
#define _ARM_JTAG_SCAN_N_CHECK_
|
#define _ARM_JTAG_SCAN_N_CHECK_
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
int arm_jtag_set_instr(struct arm_jtag *jtag_info, uint32_t new_instr, void *no_verify_capture)
|
int arm_jtag_set_instr_inner(struct arm_jtag *jtag_info, uint32_t new_instr, void *no_verify_capture)
|
||||||
{
|
{
|
||||||
struct jtag_tap *tap;
|
struct jtag_tap *tap;
|
||||||
tap = jtag_info->tap;
|
tap = jtag_info->tap;
|
||||||
if (tap == NULL)
|
struct scan_field field;
|
||||||
return ERROR_FAIL;
|
uint8_t t[4];
|
||||||
|
|
||||||
if (buf_get_u32(tap->cur_instr, 0, tap->ir_length) != new_instr)
|
field.tap = tap;
|
||||||
|
field.num_bits = tap->ir_length;
|
||||||
|
field.out_value = t;
|
||||||
|
buf_set_u32(field.out_value, 0, field.num_bits, new_instr);
|
||||||
|
field.in_value = NULL;
|
||||||
|
|
||||||
|
if (no_verify_capture == NULL)
|
||||||
{
|
{
|
||||||
struct scan_field field;
|
jtag_add_ir_scan(1, &field, jtag_get_end_state());
|
||||||
uint8_t t[4];
|
} else
|
||||||
|
{
|
||||||
field.tap = tap;
|
/* FIX!!!! this is a kludge!!! arm926ejs.c should reimplement this arm_jtag_set_instr to
|
||||||
field.num_bits = tap->ir_length;
|
* have special verification code.
|
||||||
field.out_value = t;
|
*/
|
||||||
buf_set_u32(field.out_value, 0, field.num_bits, new_instr);
|
jtag_add_ir_scan_noverify(1, &field, jtag_get_end_state());
|
||||||
field.in_value = NULL;
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
if (no_verify_capture == NULL)
|
|
||||||
{
|
|
||||||
jtag_add_ir_scan(1, &field, jtag_get_end_state());
|
|
||||||
} else
|
|
||||||
{
|
|
||||||
/* FIX!!!! this is a kludge!!! arm926ejs.c should reimplement this arm_jtag_set_instr to
|
|
||||||
* have special verification code.
|
|
||||||
*/
|
|
||||||
jtag_add_ir_scan_noverify(1, &field, jtag_get_end_state());
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
return ERROR_OK;
|
return ERROR_OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
int arm_jtag_scann(struct arm_jtag *jtag_info, uint32_t new_scan_chain)
|
int arm_jtag_scann_inner(struct arm_jtag *jtag_info, uint32_t new_scan_chain)
|
||||||
{
|
{
|
||||||
int retval = ERROR_OK;
|
int retval = ERROR_OK;
|
||||||
if (jtag_info->cur_scan_chain != new_scan_chain)
|
uint32_t values[1];
|
||||||
|
int num_bits[1];
|
||||||
|
|
||||||
|
values[0]=new_scan_chain;
|
||||||
|
num_bits[0]=jtag_info->scann_size;
|
||||||
|
|
||||||
|
if ((retval = arm_jtag_set_instr(jtag_info, jtag_info->scann_instr, NULL)) != ERROR_OK)
|
||||||
{
|
{
|
||||||
uint32_t values[1];
|
return retval;
|
||||||
int num_bits[1];
|
|
||||||
|
|
||||||
values[0]=new_scan_chain;
|
|
||||||
num_bits[0]=jtag_info->scann_size;
|
|
||||||
|
|
||||||
if ((retval = arm_jtag_set_instr(jtag_info, jtag_info->scann_instr, NULL)) != ERROR_OK)
|
|
||||||
{
|
|
||||||
return retval;
|
|
||||||
}
|
|
||||||
|
|
||||||
jtag_add_dr_out(jtag_info->tap,
|
|
||||||
1,
|
|
||||||
num_bits,
|
|
||||||
values,
|
|
||||||
jtag_get_end_state());
|
|
||||||
|
|
||||||
jtag_info->cur_scan_chain = new_scan_chain;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
jtag_add_dr_out(jtag_info->tap,
|
||||||
|
1,
|
||||||
|
num_bits,
|
||||||
|
values,
|
||||||
|
jtag_get_end_state());
|
||||||
|
|
||||||
|
jtag_info->cur_scan_chain = new_scan_chain;
|
||||||
|
|
||||||
return retval;
|
return retval;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -36,9 +36,40 @@ struct arm_jtag
|
||||||
uint32_t intest_instr;
|
uint32_t intest_instr;
|
||||||
};
|
};
|
||||||
|
|
||||||
int arm_jtag_set_instr(struct arm_jtag *jtag_info,
|
int arm_jtag_set_instr_inner(struct arm_jtag *jtag_info, uint32_t new_instr, void *no_verify_capture);
|
||||||
uint32_t new_instr, void *verify_capture);
|
static inline int arm_jtag_set_instr(struct arm_jtag *jtag_info,
|
||||||
int arm_jtag_scann(struct arm_jtag *jtag_info, uint32_t new_scan_chain);
|
uint32_t new_instr, void *no_verify_capture)
|
||||||
|
{
|
||||||
|
/* inline most common code path */
|
||||||
|
struct jtag_tap *tap;
|
||||||
|
tap = jtag_info->tap;
|
||||||
|
if (tap == NULL)
|
||||||
|
return ERROR_FAIL;
|
||||||
|
|
||||||
|
if (buf_get_u32(tap->cur_instr, 0, tap->ir_length) != new_instr)
|
||||||
|
{
|
||||||
|
return arm_jtag_set_instr_inner(jtag_info, new_instr, no_verify_capture);
|
||||||
|
}
|
||||||
|
|
||||||
|
return ERROR_OK;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
int arm_jtag_scann_inner(struct arm_jtag *jtag_info, uint32_t new_scan_chain);
|
||||||
|
static inline int arm_jtag_scann(struct arm_jtag *jtag_info, uint32_t new_scan_chain)
|
||||||
|
{
|
||||||
|
/* inline most common code path */
|
||||||
|
int retval = ERROR_OK;
|
||||||
|
if (jtag_info->cur_scan_chain != new_scan_chain)
|
||||||
|
{
|
||||||
|
return arm_jtag_scann_inner(jtag_info, new_scan_chain);
|
||||||
|
}
|
||||||
|
|
||||||
|
return retval;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
int arm_jtag_setup_connection(struct arm_jtag *jtag_info);
|
int arm_jtag_setup_connection(struct arm_jtag *jtag_info);
|
||||||
|
|
||||||
/* use this as a static so we can inline it in -O3 and refer to it via a pointer */
|
/* use this as a static so we can inline it in -O3 and refer to it via a pointer */
|
||||||
|
|
Loading…
Reference in New Issue