@@ -98,6 +98,7 @@ struct fsl_espi {
const void *tx;
void *rx;
+ bool swab;
unsigned int rx_len;
unsigned int tx_len;
unsigned int rxskip;
@@ -140,14 +141,14 @@ static void fsl_espi_memcpy_swab(void *to, const void *from,
struct spi_message *m,
struct spi_transfer *t)
{
+ struct fsl_espi *espi = spi_master_get_devdata(m->spi->master);
unsigned int len = t->len;
- if (!(m->spi->mode & SPI_LSB_FIRST) || t->bits_per_word <= 8) {
+ if (!espi->swab) {
memcpy(to, from, len);
return;
}
- /* In case of LSB-first and bits_per_word > 8 byte-swap all words */
while (len)
if (len >= 4) {
*(u32 *)to = swahb32p(from);
@@ -384,6 +385,9 @@ static int fsl_espi_trans(struct spi_message *m, struct spi_transfer *trans)
struct spi_device *spi = m->spi;
int ret;
+ /* In case of LSB-first and bits_per_word > 8 byte-swap all words */
+ espi->swab = spi->mode & SPI_LSB_FIRST && trans->bits_per_word > 8;
+
espi->rxskip = fsl_espi_check_rxskip_mode(m);
if (trans->rx_nbits == SPI_NBITS_DUAL && !espi->rxskip) {
dev_err(espi->dev, "Dual output mode requires RXSKIP mode!\n");