jtag_add_shift() fn - minidriver work in progress.
git-svn-id: svn://svn.berlios.de/openocd/trunk@367 b42882b7-edfa-0310-969c-e2dbd0fdcd60__archive__
parent
ebbcbd3f29
commit
7cdb05b7d6
|
@ -1898,6 +1898,43 @@ int handle_drscan_command(struct command_context_s *cmd_ctx, char *cmd, char **a
|
|||
return ERROR_OK;
|
||||
}
|
||||
|
||||
|
||||
|
||||
int MINIDRIVER(interface_jtag_add_shift)(const enum tap_state shift_state, const enum tap_state end_state, int num_bits, u32 value)
|
||||
{
|
||||
u8 out_buf[4];
|
||||
buf_set_u32(out_buf, 0, 32, flip_u32(value, 32));
|
||||
|
||||
/* allocate memory for a new list member */
|
||||
jtag_command_t **last_cmd;
|
||||
last_cmd = jtag_get_last_command_p();
|
||||
*last_cmd = cmd_queue_alloc(sizeof(jtag_command_t));
|
||||
last_comand_pointer = &((*last_cmd)->next);
|
||||
(*last_cmd)->next = NULL;
|
||||
(*last_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 = (shift_state==TAP_SI);
|
||||
(*last_cmd)->cmd.scan->num_fields = 1;
|
||||
(*last_cmd)->cmd.scan->fields = cmd_queue_alloc(1 * sizeof(scan_field_t));
|
||||
(*last_cmd)->cmd.scan->end_state = end_state;
|
||||
|
||||
int num_bytes = CEIL(num_bits, 8);
|
||||
int i=0;
|
||||
(*last_cmd)->cmd.scan->fields[i].device = 0; /* not used by any drivers */
|
||||
(*last_cmd)->cmd.scan->fields[i].num_bits = num_bits;
|
||||
(*last_cmd)->cmd.scan->fields[i].out_value = buf_cpy(out_buf, cmd_queue_alloc(num_bytes), num_bits);
|
||||
(*last_cmd)->cmd.scan->fields[i].out_mask = NULL;
|
||||
(*last_cmd)->cmd.scan->fields[i].in_value = NULL;
|
||||
(*last_cmd)->cmd.scan->fields[i].in_check_value = NULL;
|
||||
(*last_cmd)->cmd.scan->fields[i].in_check_mask = NULL;
|
||||
(*last_cmd)->cmd.scan->fields[i].in_handler = NULL;
|
||||
(*last_cmd)->cmd.scan->fields[i].in_handler_priv = NULL;
|
||||
|
||||
return ERROR_OK;
|
||||
}
|
||||
|
||||
int handle_verify_ircapture_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
|
||||
{
|
||||
if (argc == 1)
|
||||
|
|
|
@ -22,6 +22,7 @@
|
|||
|
||||
#include "types.h"
|
||||
#include "binarybuffer.h"
|
||||
#include "log.h"
|
||||
|
||||
#include "command.h"
|
||||
|
||||
|
@ -289,6 +290,9 @@ extern int jtag_add_end_state(enum tap_state endstate);
|
|||
extern int interface_jtag_add_end_state(enum tap_state endstate);
|
||||
extern int jtag_add_sleep(u32 us);
|
||||
extern int interface_jtag_add_sleep(u32 us);
|
||||
|
||||
|
||||
|
||||
/*
|
||||
* For software FIFO implementations, the queued commands can be executed
|
||||
* during this call or earlier. A sw queue might decide to push out
|
||||
|
@ -340,4 +344,30 @@ extern int jtag_verify_capture_ir;
|
|||
#define ERROR_JTAG_DEVICE_ERROR (-107)
|
||||
|
||||
|
||||
/* Here a #define MINIDRIVER() and an inline version of hw fifo interface_jtag_add_shift can be defined */
|
||||
|
||||
#ifndef MINIDRIVER
|
||||
extern int interface_jtag_add_shift(const enum tap_state shift_state, const enum tap_state end_state, int bits, u32 value);
|
||||
#endif
|
||||
|
||||
/* Enter the shift_state and cycle "bits" times out of that state.
|
||||
*
|
||||
* So if the end_state!=shift_state, then the transition from shift_state to
|
||||
* end_state counts as a transition out of shift_state.
|
||||
*
|
||||
* Legal shift states TAP_SD and TAP_SI
|
||||
*
|
||||
* Legal end state does not include TAP_TLR
|
||||
*
|
||||
* Bits are clocked out from value LSB first.
|
||||
*/
|
||||
static __inline int jtag_add_shift(const enum tap_state shift_state, const enum tap_state end_state, int bits, u32 value)
|
||||
{
|
||||
int retval;
|
||||
retval=interface_jtag_add_shift(shift_state, end_state, bits, value);
|
||||
cmd_queue_end_state = end_state;
|
||||
return retval;
|
||||
}
|
||||
|
||||
|
||||
#endif /* JTAG_H */
|
||||
|
|
Loading…
Reference in New Issue