Skip to content

Commit

Permalink
WIP : FTDI driver : code clean up.
Browse files Browse the repository at this point in the history
  • Loading branch information
@jfdelnero
jfdelnero committed Oct 14, 2024
1 parent 6451ec0 commit 89159e2
Showing 1 changed file with 79 additions and 90 deletions.
169 changes: 79 additions & 90 deletions lib_jtag_core/src/drivers/ftdi_jtag/ftdi_jtag_drv.c
View file
Original file line number Diff line number Diff line change
Expand Up @@ -693,42 +693,44 @@ int drv_FTDI_DeInit(jtag_core * jc)

int drv_FTDI_TDOTDI_xfer(jtag_core * jc, unsigned char * str_out, unsigned char * str_in, int size)
{
int i,j,l,payloadsize;
int wr_bit_index,rd_bit_index;
int j,l,payloadsize;
int rounded_size;
DWORD nbRead,nbtosend;
FT_STATUS status;
int read_ptr;
unsigned char opcode,data;

read_ptr = 0;
rd_bit_index = 0;
wr_bit_index = 0;

memset(ftdi_out_buf, 0, sizeof(ftdi_out_buf));
memset(ftdi_in_buf, 0, sizeof(ftdi_in_buf));

if (size)
{
i = 0;

nbtosend = 0;

// Set the first TMS/DOUT
if (str_out[i] & JTAG_STR_TMS)
if ( str_out[wr_bit_index] & JTAG_STR_TMS )
{
if( str_in )
opcode = ( OP_WR_TMS | OP_LSB_FIRST | OP_BIT_MODE | OP_FEDGE_WR | OP_RD_TDO ); // with TDO read back
else
opcode = ( OP_WR_TMS | OP_LSB_FIRST | OP_BIT_MODE | OP_FEDGE_WR );

nbtosend = 0;

ftdi_out_buf[nbtosend++] = opcode;
ftdi_out_buf[nbtosend++] = 0x00; // Size field : 1 Bit

data = 0x00;

if (str_out[i] & JTAG_STR_DOUT)
if (str_out[wr_bit_index] & JTAG_STR_DOUT)
data = 0x80; // Bit 7: TDI/DO pin state

if (str_out[i] & JTAG_STR_TMS)
if (str_out[wr_bit_index] & JTAG_STR_TMS)
data |= 0x3F; // TMS state

wr_bit_index++;

ftdi_out_buf[nbtosend++] = data; // Data field

status = pFT_Write(ftdih, ftdi_out_buf, nbtosend, &nbtosend);
Expand All @@ -744,64 +746,58 @@ int drv_FTDI_TDOTDI_xfer(jtag_core * jc, unsigned char * str_out, unsigned char

status = pFT_Read(ftdih, &ftdi_in_buf, nbRead, &nbRead);

for (l = 0; l < 1; l++)
if ( ftdi_in_buf[0] & 0x01 )
{
if (ftdi_in_buf[l >> 3] & (0x01 << (l & 7)))
{
str_in[read_ptr] = JTAG_STR_DOUT;
}
else
{
str_in[read_ptr] = 0x00;
}
read_ptr++;
str_in[rd_bit_index++] = JTAG_STR_DOUT;
}
else
{
str_in[rd_bit_index++] = 0x00;
}
}

i++;
}

nbtosend = 0;

if( str_in )
opcode = ( OP_WR_TDI | OP_LSB_FIRST | OP_FEDGE_WR | OP_RD_TDO );
else
opcode = ( OP_WR_TDI | OP_LSB_FIRST | OP_FEDGE_WR );
if( wr_bit_index >= size )
return 0;

ftdi_out_buf[nbtosend++] = opcode;
ftdi_out_buf[nbtosend++] = 0x00; // (Size-1) Low byte
ftdi_out_buf[nbtosend++] = 0x00; // (Size-1) High byte
rounded_size = (size - wr_bit_index) & ~(0x7);
if( rounded_size )
{
// byte(s) buffer transmission/reception

ftdi_out_buf[nbtosend] = 0x00;
if( str_in )
opcode = ( OP_WR_TDI | OP_LSB_FIRST | OP_FEDGE_WR | OP_RD_TDO );
else
opcode = ( OP_WR_TDI | OP_LSB_FIRST | OP_FEDGE_WR );

rounded_size = (size - i) & ~(0x7);
nbtosend = 0;

j = 0;
payloadsize = 0;
while (payloadsize < rounded_size)
{
if (str_out[i] & JTAG_STR_DOUT)
{
ftdi_out_buf[nbtosend] |= (0x01 << (j & 0x7));
}
ftdi_out_buf[nbtosend++] = opcode;
ftdi_out_buf[nbtosend++] = ( ( (rounded_size>>3)-1 ) & 0xff ); // (Size-1) Low byte
ftdi_out_buf[nbtosend++] = ( ( (rounded_size>>3)-1 ) >> 8 ); // (Size-1) High byte

j++;
ftdi_out_buf[nbtosend] = 0x00;

if (!(j & 0x7))
j = 0;
payloadsize = 0;
while (payloadsize < rounded_size)
{
nbtosend++;
ftdi_out_buf[nbtosend] = 0x00;
}
if (str_out[wr_bit_index] & JTAG_STR_DOUT)
{
ftdi_out_buf[nbtosend] |= (0x01 << (j & 0x7));
}

payloadsize++;
i++;
}
j++;

if (payloadsize)
{
// update size
ftdi_out_buf[1] = ( ( (payloadsize>>3)-1 ) & 0xff);
ftdi_out_buf[2] = ( ( (payloadsize>>3)-1 ) >> 8);
if (!(j & 0x7))
{
nbtosend++;
ftdi_out_buf[nbtosend] = 0x00;
}

payloadsize++;
wr_bit_index++;
}

status = pFT_Write(ftdih, ftdi_out_buf, nbtosend, &nbtosend);

Expand All @@ -811,64 +807,58 @@ int drv_FTDI_TDOTDI_xfer(jtag_core * jc, unsigned char * str_out, unsigned char
{
Sleep(3);
status = pFT_GetQueueStatus(ftdih, &nbRead);
} while (nbRead < (unsigned long)(payloadsize >> 3) && (status == FT_OK ));
} while (nbRead < (unsigned long)(rounded_size >> 3) && (status == FT_OK ));

status = pFT_Read(ftdih, &ftdi_in_buf, nbRead, &nbRead);

for (l = 0; l < payloadsize; l++)
for (l = 0; l < rounded_size; l++)
{
if (ftdi_in_buf[l >> 3] & (0x01 << (l & 7)))
{
str_in[read_ptr] = JTAG_STR_DOUT;
str_in[rd_bit_index++] = JTAG_STR_DOUT;
}
else
{
str_in[read_ptr] = 0x00;
str_in[rd_bit_index++] = 0x00;
}
read_ptr++;
}
}
}

// Send the remaining bits...
nbtosend = 0;

if( str_in )
opcode = ( OP_WR_TDI | OP_LSB_FIRST | OP_BIT_MODE | OP_FEDGE_WR | OP_RD_TDO ); //bit mode with TDO read back
else
opcode = ( OP_WR_TDI | OP_LSB_FIRST | OP_BIT_MODE | OP_FEDGE_WR ); //bit mode
if( wr_bit_index < size )
{
// Send the remaining bits...

ftdi_out_buf[nbtosend++] = opcode;
if( str_in )
opcode = ( OP_WR_TDI | OP_LSB_FIRST | OP_BIT_MODE | OP_FEDGE_WR | OP_RD_TDO ); //bit mode with TDO read back
else
opcode = ( OP_WR_TDI | OP_LSB_FIRST | OP_BIT_MODE | OP_FEDGE_WR ); //bit mode

ftdi_out_buf[nbtosend++] = 0x00; // Size field
nbtosend = 0;

ftdi_out_buf[nbtosend] = 0x00; // Data field
ftdi_out_buf[nbtosend++] = opcode;
ftdi_out_buf[nbtosend++] = (((size - wr_bit_index)-1) & 0x7); // Size field
ftdi_out_buf[nbtosend] = 0x00; // Data field

j = 0;
payloadsize = 0;
while (i < size) // Should left less than 8 bits.
{
if (str_out[i] & JTAG_STR_DOUT)
j = 0;
payloadsize = 0;
while (wr_bit_index < size) // Should left less than 8 bits.
{
ftdi_out_buf[nbtosend] |= (0x01 << (j & 0x7));
}

j++;
if (str_out[wr_bit_index++] & JTAG_STR_DOUT)
{
ftdi_out_buf[nbtosend] |= (0x01 << (j & 0x7));
}

payloadsize++;
i++;
}
j++;

nbtosend++;
payloadsize++;
}

if (payloadsize)
{
// Update the size field
ftdi_out_buf[1] = ((payloadsize - 1) & 0x7);
nbtosend++;

status = pFT_Write(ftdih, ftdi_out_buf, nbtosend, &nbtosend);

if (str_in)
if ( opcode & OP_RD_TDO )
{
do
{
Expand All @@ -882,13 +872,12 @@ int drv_FTDI_TDOTDI_xfer(jtag_core * jc, unsigned char * str_out, unsigned char
{
if (ftdi_in_buf[l >> 3] & (0x01 << (l & 7)))
{
str_in[read_ptr] = JTAG_STR_DOUT;
str_in[rd_bit_index++] = JTAG_STR_DOUT;
}
else
{
str_in[read_ptr] = 0x00;
str_in[rd_bit_index++] = 0x00;
}
read_ptr++;
}
}
}
Expand Down

0 comments on commit 89159e2

Please sign in to comment.