interesting
/
riscv-openocd
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

vsllink support for stable clocks by Simon Qian <simonqian@SimonQian.com> 

git-svn-id: svn://svn.berlios.de/openocd/trunk@1356 b42882b7-edfa-0310-969c-e2dbd0fdcd60
This commit is contained in:
kc8apf 2009-01-23 07:02:47 +00:00
parent 3b4d5ae050
commit 44a7b25487
1 changed files with 147 additions and 89 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

126
src/jtag/vsllink.c
View File

@ -54,7 +54,7 @@ u16 vsllink_pid;
u8 vsllink_bulkout; u8 vsllink_bulkout;
u8 vsllink_bulkin; u8 vsllink_bulkin;
#define VSLLINK_USB_TIMEOUT 5000 #define VSLLINK_USB_TIMEOUT 10000
static int VSLLINK_BufferSize = 1024; static int VSLLINK_BufferSize = 1024;
@ -76,7 +76,7 @@ static u8* vsllink_usb_out_buffer = NULL;
#define VSLLINK_CMD_HW_SWDCMD 0xA2 #define VSLLINK_CMD_HW_SWDCMD 0xA2
#define VSLLINK_CMDJTAGSEQ_TMSBYTE 0x00 #define VSLLINK_CMDJTAGSEQ_TMSBYTE 0x00
#define VSLLINK_CMDJTAGSEQ_TMS0BYTE 0x40 #define VSLLINK_CMDJTAGSEQ_TMSCLOCK 0x40
#define VSLLINK_CMDJTAGSEQ_SCAN 0x80 #define VSLLINK_CMDJTAGSEQ_SCAN 0x80
#define VSLLINK_CMDJTAGSEQ_CMDMSK 0xC0 #define VSLLINK_CMDJTAGSEQ_CMDMSK 0xC0
@ -206,6 +206,7 @@ void vsllink_end_state(enum tap_state state);
void vsllink_state_move(void); void vsllink_state_move(void);
void vsllink_path_move(int num_states, enum tap_state *path); void vsllink_path_move(int num_states, enum tap_state *path);
void vsllink_runtest(int num_cycles); void vsllink_runtest(int num_cycles);
void vsllink_stableclocks(int num_cycles, int tms);
void vsllink_scan(int ir_scan, enum scan_type type, u8 *buffer, int scan_size, scan_command_t *command); void vsllink_scan(int ir_scan, enum scan_type type, u8 *buffer, int scan_size, scan_command_t *command);
void vsllink_reset(int trst, int srst); void vsllink_reset(int trst, int srst);
void vsllink_simple_command(u8 command); void vsllink_simple_command(u8 command);
@ -257,7 +258,7 @@ int vsllink_execute_queue(void)
enum scan_type type; enum scan_type type;
u8 *buffer; u8 *buffer;
DEBUG_JTAG_IO("--------------------------------------------------------------------------------"); DEBUG_JTAG_IO("--------------------------------- vsllink -------------------------------------");
vsllink_usb_out_buffer[0] = VSLLINK_CMD_HW_JTAGSEQCMD; vsllink_usb_out_buffer[0] = VSLLINK_CMD_HW_JTAGSEQCMD;
vsllink_usb_out_buffer_idx = 3; vsllink_usb_out_buffer_idx = 3;
@ -349,8 +350,32 @@ int vsllink_execute_queue(void)
jtag_sleep(cmd->cmd.sleep->us); jtag_sleep(cmd->cmd.sleep->us);
break; break;
case JTAG_STABLECLOCKS:
DEBUG_JTAG_IO("add %d clocks", cmd->cmd.stableclocks->num_cycles);
switch(cur_state)
{
case TAP_RESET:
// tms should be '1' to stay in TAP_RESET mode
scan_size = 1;
break;
case TAP_DRSHIFT:
case TAP_IDLE:
case TAP_DRPAUSE:
case TAP_IRSHIFT:
case TAP_IRPAUSE:
// in other mode, tms should be '0'
scan_size = 0;
break; /* above stable states are OK */
default: default:
LOG_ERROR("BUG: unknown JTAG command type encountered"); LOG_ERROR( "jtag_add_clocks() was called with TAP in non-stable state \"%s\"",
jtag_state_name(cur_state) );
exit(-1);
}
vsllink_stableclocks(cmd->cmd.stableclocks->num_cycles, scan_size);
break;
default:
LOG_ERROR("BUG: unknown JTAG command type encountered: %d", cmd->type);
exit(-1); exit(-1);
} }
cmd = cmd->next; cmd = cmd->next;
@ -752,25 +777,26 @@ void vsllink_path_move(int num_states, enum tap_state *path)
} }
} }
void vsllink_runtest(int num_cycles) void vsllink_stableclocks(int num_cycles, int tms)
{ {
int tms_len; int tms_len;
enum tap_state saved_end_state = end_state; u16 tms_append_byte;
if (cur_state != TAP_IDLE)
{
// enter into IDLE state
vsllink_end_state(TAP_IDLE);
vsllink_state_move();
}
else
{
// cur_state == TAP_IDLE
if (vsllink_tms_data_len > 0) if (vsllink_tms_data_len > 0)
{ {
// there are vsllink_tms_data_len more tms bits to be shifted // there are vsllink_tms_data_len more tms bits to be shifted
// so there are vsllink_tms_data_len + num_cycles tms bits in all // so there are vsllink_tms_data_len + num_cycles tms bits in all
tms_len = vsllink_tms_data_len + num_cycles; tms_len = vsllink_tms_data_len + num_cycles;
if (tms > 0)
{
// append '1' for tms
tms_append_byte = (u16)((((1 << num_cycles) - 1) << vsllink_tms_data_len) & 0xFFFF);
}
else
{
// append '0' for tms
tms_append_byte = 0;
}
if (tms_len <= 16) if (tms_len <= 16)
{ {
// merge into last tms shift // merge into last tms shift
@ -779,13 +805,14 @@ void vsllink_runtest(int num_cycles)
// just add to vsllink_tms_data_len // just add to vsllink_tms_data_len
// same result if tun through // same result if tun through
//vsllink_tms_data_len += num_cycles; //vsllink_tms_data_len += num_cycles;
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx] |= (u8)(tms_append_byte & 0xFF);
} }
else if (tms_len == 8) else if (tms_len == 8)
{ {
// end last tms shift command // end last tms shift command
// just reduce it, no need to append_tms // just reduce it, and append last tms byte
(*vsllink_tms_cmd_pos)--; (*vsllink_tms_cmd_pos)--;
vsllink_usb_out_buffer_idx++; vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] |= (u8)(tms_append_byte & 0xFF);
} }
else if (tms_len < 16) else if (tms_len < 16)
{ {
@ -795,8 +822,8 @@ void vsllink_runtest(int num_cycles)
// there is enought tms length in the current tms shift command // there is enought tms length in the current tms shift command
// increase the tms byte length by 1 and set the last byte to 0 // increase the tms byte length by 1 and set the last byte to 0
(*vsllink_tms_cmd_pos)++; (*vsllink_tms_cmd_pos)++;
vsllink_usb_out_buffer_idx++; vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] |= (u8)(tms_append_byte & 0xFF);
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx] = 0; vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx] = (u8)(tms_append_byte >> 8);
} }
else else
{ {
@ -805,23 +832,23 @@ void vsllink_runtest(int num_cycles)
// so a new command should be added // so a new command should be added
// first decrease byte length of last tms shift command // first decrease byte length of last tms shift command
(*vsllink_tms_cmd_pos)--; (*vsllink_tms_cmd_pos)--;
// move the command pointer to the next empty position // append last tms byte and move the command pointer to the next empty position
vsllink_usb_out_buffer_idx++; vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] |= (u8)(tms_append_byte & 0xFF);
// add new command(3 bytes) // add new command(3 bytes)
vsllink_tap_ensure_space(0, 3); vsllink_tap_ensure_space(0, 3);
vsllink_tms_cmd_pos = &vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx]; vsllink_tms_cmd_pos = &vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx];
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = VSLLINK_CMDJTAGSEQ_TMSBYTE | 1; vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = VSLLINK_CMDJTAGSEQ_TMSBYTE | 1;
vsllink_usb_out_buffer[++vsllink_usb_out_buffer_idx] = 0; vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx] = (u8)(tms_append_byte >> 8);
} }
} }
else if (tms_len == 16) else if (tms_len == 16)
{ {
// end last tms shift command // end last tms shift command
vsllink_usb_out_buffer_idx++; vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] |= (u8)(tms_append_byte & 0xFF);
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = 0; vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = (u8)(tms_append_byte >> 8);
} }
vsllink_tms_data_len = (vsllink_tms_data_len + num_cycles) & 7; vsllink_tms_data_len = tms_len & 7;
if (vsllink_tms_data_len == 0) if (vsllink_tms_data_len == 0)
{ {
vsllink_tms_cmd_pos = NULL; vsllink_tms_cmd_pos = NULL;
@ -830,15 +857,15 @@ void vsllink_runtest(int num_cycles)
} }
else else
{ {
vsllink_usb_out_buffer_idx++; // more shifts will be needed
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = 0; vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] |= (u8)(tms_append_byte & 0xFF);
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = (u8)(tms_append_byte >> 8);
num_cycles -= 16 - vsllink_tms_data_len; num_cycles -= 16 - vsllink_tms_data_len;
vsllink_tms_data_len = 0; vsllink_tms_data_len = 0;
vsllink_tms_cmd_pos = NULL; vsllink_tms_cmd_pos = NULL;
} }
} }
}
// from here vsllink_tms_data_len == 0 or num_cycles == 0 // from here vsllink_tms_data_len == 0 or num_cycles == 0
if (vsllink_tms_data_len > 0) if (vsllink_tms_data_len > 0)
@ -860,7 +887,15 @@ void vsllink_runtest(int num_cycles)
vsllink_tap_ensure_space(1, 5); vsllink_tap_ensure_space(1, 5);
// if tms_len > 0, vsllink_tms_data_len == 0 // if tms_len > 0, vsllink_tms_data_len == 0
// so just add new command // so just add new command
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = VSLLINK_CMDJTAGSEQ_TMS0BYTE; // LSB of the command byte is the tms value when do the shifting
if (tms > 0)
{
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = VSLLINK_CMDJTAGSEQ_TMSCLOCK | 1;
}
else
{
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = VSLLINK_CMDJTAGSEQ_TMSCLOCK;
}
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = (tms_len >> 0) & 0xff; vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = (tms_len >> 0) & 0xff;
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = (tms_len >> 8) & 0xff; vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = (tms_len >> 8) & 0xff;
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = (tms_len >> 16) & 0xff; vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = (tms_len >> 16) & 0xff;
@ -873,20 +908,42 @@ void vsllink_runtest(int num_cycles)
if (tms_len > 0xFFFF) if (tms_len > 0xFFFF)
{ {
vsllink_tap_execute(); vsllink_tap_execute();
vsllink_usb_out_buffer[0] = VSLLINK_CMD_HW_JTAGSEQCMD;
vsllink_usb_out_buffer_idx = 3;
} }
} }
// post-process
vsllink_tms_data_len = num_cycles & 7; vsllink_tms_data_len = num_cycles & 7;
if (vsllink_tms_data_len > 0) if (vsllink_tms_data_len > 0)
{ {
vsllink_tap_ensure_space(0, 3); vsllink_tap_ensure_space(0, 3);
vsllink_tms_cmd_pos = &vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx]; vsllink_tms_cmd_pos = &vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx];
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = VSLLINK_CMDJTAGSEQ_TMSBYTE | 1; vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx++] = VSLLINK_CMDJTAGSEQ_TMSBYTE | 1;
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx] = 0; if (tms > 0)
{
// append '1' for tms
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx] = (1 << vsllink_tms_data_len) - 1;
}
else
{
// append '0' for tms
vsllink_usb_out_buffer[vsllink_usb_out_buffer_idx] = 0x00;
} }
} }
}
}
void vsllink_runtest(int num_cycles)
{
enum tap_state saved_end_state = end_state;
if (cur_state != TAP_IDLE)
{
// enter into IDLE state
vsllink_end_state(TAP_IDLE);
vsllink_state_move();
}
vsllink_stableclocks(num_cycles, 0);
// post-process // post-process
// set end_state // set end_state
@ -1122,8 +1179,6 @@ void vsllink_tap_ensure_space(int scans, int bytes)
if (scans > available_scans || bytes > available_bytes) if (scans > available_scans || bytes > available_bytes)
{ {
vsllink_tap_execute(); vsllink_tap_execute();
vsllink_usb_out_buffer[0] = VSLLINK_CMD_HW_JTAGSEQCMD;
vsllink_usb_out_buffer_idx = 3;
} }
} }
@ -1239,6 +1294,9 @@ int vsllink_tap_execute(void)
vsllink_tap_init(); vsllink_tap_init();
} }
vsllink_usb_out_buffer[0] = VSLLINK_CMD_HW_JTAGSEQCMD;
vsllink_usb_out_buffer_idx = 3;
return ERROR_OK; return ERROR_OK;
} }