d/numam-dpdk
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

raw/ifpga/base: align send buffer for SPI

Browse Source 
The length of send buffer of SPI bus should be 4bytes align.

Signed-off-by: Tianfei Zhang <tianfei.zhang@intel.com>
Signed-off-by: Andy Pei <andy.pei@intel.com>
This commit is contained in:
Tianfei Zhang 2019-11-14 17:02:54 +08:00 committed by Ferruh Yigit
parent e1defba4cf
commit ec2613b746
1 changed files with 36 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

40
drivers/raw/ifpga/base/opae_spi_transaction.c
View File

@ -109,6 +109,34 @@ static int resp_find_sop_eop(unsigned char *resp, unsigned int len,
return ret; return ret;
} }
static void phy_tx_pad(unsigned char *phy_buf, unsigned int phy_buf_len,
unsigned int *aligned_len)
{
unsigned char *p = &phy_buf[phy_buf_len - 1], *dst_p;
*aligned_len = IFPGA_ALIGN(phy_buf_len, 4);
if (*aligned_len == phy_buf_len)
return;
dst_p = &phy_buf[*aligned_len - 1];
/* move EOP and bytes after EOP to the end of aligned size */
while (p > phy_buf) {
*dst_p = *p;
if (*p == SPI_PACKET_EOP)
break;
p--;
dst_p--;
}
/* fill the hole with PHY_IDLE */
while (p < dst_p)
*p++ = SPI_BYTE_IDLE;
}
static int byte_to_core_convert(struct spi_transaction_dev *dev, static int byte_to_core_convert(struct spi_transaction_dev *dev,
unsigned int send_len, unsigned char *send_data, unsigned int send_len, unsigned char *send_data,
unsigned int resp_len, unsigned char *resp_data, unsigned int resp_len, unsigned char *resp_data,
@ -149,15 +177,19 @@ static int byte_to_core_convert(struct spi_transaction_dev *dev,
} }
} }
print_buffer("before spi:", send_packet, p-send_packet); tx_len = p - send_packet;
reorder_phy_data(32, send_packet, p - send_packet); print_buffer("before spi:", send_packet, tx_len);
print_buffer("after order to spi:", send_packet, p-send_packet); phy_tx_pad(send_packet, tx_len, &tx_len);
print_buffer("after pad:", send_packet, tx_len);
reorder_phy_data(32, send_packet, tx_len);
print_buffer("after order to spi:", send_packet, tx_len);
/* call spi */ /* call spi */
tx_buffer = send_packet; tx_buffer = send_packet;
tx_len = p - send_packet;
rx_buffer = resp_packet; rx_buffer = resp_packet;
rx_len = resp_max_len; rx_len = resp_max_len;
spi_flags = SPI_NOT_FOUND; spi_flags = SPI_NOT_FOUND;