Add jtag_queue_command() by Michael Bruck <mbruck@digenius.de> [6/8]
git-svn-id: svn://svn.berlios.de/openocd/trunk@1820 b42882b7-edfa-0310-969c-e2dbd0fdcd60__archive__
parent
89fd953cc8
commit
48838d5193
|
@ -975,30 +975,28 @@ void jtag_add_plain_dr_scan(int num_fields, scan_field_t *fields, tap_state_t st
|
|||
|
||||
int MINIDRIVER(interface_jtag_add_plain_dr_scan)(int num_fields, scan_field_t *fields, tap_state_t state)
|
||||
{
|
||||
int i;
|
||||
jtag_command_t **last_cmd = jtag_get_last_command_p();
|
||||
|
||||
/* allocate memory for a new list member */
|
||||
*last_cmd = cmd_queue_alloc(sizeof(jtag_command_t));
|
||||
last_comand_pointer = &((*last_cmd)->next);
|
||||
(*last_cmd)->next = NULL;
|
||||
(*last_cmd)->type = JTAG_SCAN;
|
||||
jtag_command_t * cmd = cmd_queue_alloc(sizeof(jtag_command_t));
|
||||
|
||||
jtag_queue_command(cmd);
|
||||
|
||||
cmd->type = JTAG_SCAN;
|
||||
|
||||
/* allocate memory for scan command */
|
||||
(*last_cmd)->cmd.scan = cmd_queue_alloc(sizeof(scan_command_t));
|
||||
(*last_cmd)->cmd.scan->ir_scan = false;
|
||||
(*last_cmd)->cmd.scan->num_fields = num_fields;
|
||||
(*last_cmd)->cmd.scan->fields = cmd_queue_alloc(num_fields * sizeof(scan_field_t));
|
||||
(*last_cmd)->cmd.scan->end_state = state;
|
||||
cmd->cmd.scan = cmd_queue_alloc(sizeof(scan_command_t));
|
||||
cmd->cmd.scan->ir_scan = false;
|
||||
cmd->cmd.scan->num_fields = num_fields;
|
||||
cmd->cmd.scan->fields = cmd_queue_alloc(num_fields * sizeof(scan_field_t));
|
||||
cmd->cmd.scan->end_state = state;
|
||||
|
||||
for (i = 0; i < num_fields; i++)
|
||||
for (int i = 0; i < num_fields; i++)
|
||||
{
|
||||
int num_bits = fields[i].num_bits;
|
||||
int num_bytes = CEIL(fields[i].num_bits, 8);
|
||||
(*last_cmd)->cmd.scan->fields[i].tap = fields[i].tap;
|
||||
(*last_cmd)->cmd.scan->fields[i].num_bits = num_bits;
|
||||
(*last_cmd)->cmd.scan->fields[i].out_value = buf_cpy(fields[i].out_value, cmd_queue_alloc(num_bytes), num_bits);
|
||||
(*last_cmd)->cmd.scan->fields[i].in_value = fields[i].in_value;
|
||||
cmd->cmd.scan->fields[i].tap = fields[i].tap;
|
||||
cmd->cmd.scan->fields[i].num_bits = num_bits;
|
||||
cmd->cmd.scan->fields[i].out_value = buf_cpy(fields[i].out_value, cmd_queue_alloc(num_bytes), num_bits);
|
||||
cmd->cmd.scan->fields[i].in_value = fields[i].in_value;
|
||||
}
|
||||
|
||||
return ERROR_OK;
|
||||
|
|
Loading…
Reference in New Issue