UPSTREAM: spi: fsl_qspi: Copy 16 byte aligned data in TX FIFO
In some of the QSPI controller version, there must be atleast 128bit data available in TX FIFO for any pop operation otherwise error bit will be set. The code will not make any behavior change for previous controller as the transfer data size in ipcr register is still the same. Patch is tested on LS1046A which do not require 16 bytes aligned and LS1088A which require 16 bytes aligned data in TX FIFO Change-Id: I87e05aa2d038997a6681d664605c0de9ca6d51bd Signed-off-by: Suresh Gupta <suresh.gupta@nxp.com> Signed-off-by: Anupam Kumar <anupam.kumar_1@nxp.com> Reviewed-by: Jagan Teki <jagan@openedev.com> Signed-off-by: Jon Lin <jon.lin@rock-chips.com> (cherry picked from commit 10509987285515b0a969c39ef7374fea3545851b)
This commit is contained in:
parent
f0d9665a88
commit
a668abfcdb
|
|
@ -664,22 +664,20 @@ static void qspi_op_write(struct fsl_qspi_priv *priv, u8 *txbuf, u32 len)
|
|||
tx_size = (len > TX_BUFFER_SIZE) ?
|
||||
TX_BUFFER_SIZE : len;
|
||||
|
||||
size = tx_size / 4;
|
||||
for (i = 0; i < size; i++) {
|
||||
size = tx_size / 16;
|
||||
/*
|
||||
* There must be atleast 128bit data
|
||||
* available in TX FIFO for any pop operation
|
||||
*/
|
||||
if (tx_size % 16)
|
||||
size++;
|
||||
for (i = 0; i < size * 4; i++) {
|
||||
memcpy(&data, txbuf, 4);
|
||||
data = qspi_endian_xchg(data);
|
||||
qspi_write32(priv->flags, ®s->tbdr, data);
|
||||
txbuf += 4;
|
||||
}
|
||||
|
||||
size = tx_size % 4;
|
||||
if (size) {
|
||||
data = 0;
|
||||
memcpy(&data, txbuf, size);
|
||||
data = qspi_endian_xchg(data);
|
||||
qspi_write32(priv->flags, ®s->tbdr, data);
|
||||
}
|
||||
|
||||
qspi_write32(priv->flags, ®s->ipcr,
|
||||
(seqid << QSPI_IPCR_SEQID_SHIFT) | tx_size);
|
||||
while (qspi_read32(priv->flags, ®s->sr) & QSPI_SR_BUSY_MASK)
|
||||
|
|
|
|||
Loading…
Reference in New Issue