Commit c8b35042 authored by Mark Brown's avatar Mark Brown

Merge remote-tracking branches 'spi/fix/fsl-cpm', 'spi/fix/fsl-dspi' and...

Merge remote-tracking branches 'spi/fix/fsl-cpm', 'spi/fix/fsl-dspi' and 'spi/fix/fsl-espi' into spi-linus
...@@ -303,7 +303,7 @@ config SPI_FSL_SPI ...@@ -303,7 +303,7 @@ config SPI_FSL_SPI
config SPI_FSL_DSPI config SPI_FSL_DSPI
tristate "Freescale DSPI controller" tristate "Freescale DSPI controller"
select REGMAP_MMIO select REGMAP_MMIO
depends on SOC_VF610 || COMPILE_TEST depends on SOC_VF610 || SOC_LS1021A || COMPILE_TEST
help help
This enables support for the Freescale DSPI controller in master This enables support for the Freescale DSPI controller in master
mode. VF610 platform uses the controller. mode. VF610 platform uses the controller.
......
...@@ -310,10 +310,15 @@ int fsl_spi_cpm_init(struct mpc8xxx_spi *mspi) ...@@ -310,10 +310,15 @@ int fsl_spi_cpm_init(struct mpc8xxx_spi *mspi)
if (mspi->flags & SPI_CPM1) { if (mspi->flags & SPI_CPM1) {
struct resource *res; struct resource *res;
void *pram;
res = platform_get_resource(to_platform_device(dev), res = platform_get_resource(to_platform_device(dev),
IORESOURCE_MEM, 1); IORESOURCE_MEM, 1);
mspi->pram = devm_ioremap_resource(dev, res); pram = devm_ioremap_resource(dev, res);
if (IS_ERR(pram))
mspi->pram = NULL;
else
mspi->pram = pram;
} else { } else {
unsigned long pram_ofs = fsl_spi_cpm_get_pram(mspi); unsigned long pram_ofs = fsl_spi_cpm_get_pram(mspi);
......
...@@ -359,14 +359,16 @@ static void fsl_espi_rw_trans(struct spi_message *m, ...@@ -359,14 +359,16 @@ static void fsl_espi_rw_trans(struct spi_message *m,
struct fsl_espi_transfer *trans, u8 *rx_buff) struct fsl_espi_transfer *trans, u8 *rx_buff)
{ {
struct fsl_espi_transfer *espi_trans = trans; struct fsl_espi_transfer *espi_trans = trans;
unsigned int n_tx = espi_trans->n_tx; unsigned int total_len = espi_trans->len;
unsigned int n_rx = espi_trans->n_rx;
struct spi_transfer *t; struct spi_transfer *t;
u8 *local_buf; u8 *local_buf;
u8 *rx_buf = rx_buff; u8 *rx_buf = rx_buff;
unsigned int trans_len; unsigned int trans_len;
unsigned int addr; unsigned int addr;
int i, pos, loop; unsigned int tx_only;
unsigned int rx_pos = 0;
unsigned int pos;
int i, loop;
local_buf = kzalloc(SPCOM_TRANLEN_MAX, GFP_KERNEL); local_buf = kzalloc(SPCOM_TRANLEN_MAX, GFP_KERNEL);
if (!local_buf) { if (!local_buf) {
...@@ -374,36 +376,48 @@ static void fsl_espi_rw_trans(struct spi_message *m, ...@@ -374,36 +376,48 @@ static void fsl_espi_rw_trans(struct spi_message *m,
return; return;
} }
for (pos = 0, loop = 0; pos < n_rx; pos += trans_len, loop++) { for (pos = 0, loop = 0; pos < total_len; pos += trans_len, loop++) {
trans_len = n_rx - pos; trans_len = total_len - pos;
if (trans_len > SPCOM_TRANLEN_MAX - n_tx)
trans_len = SPCOM_TRANLEN_MAX - n_tx;
i = 0; i = 0;
tx_only = 0;
list_for_each_entry(t, &m->transfers, transfer_list) { list_for_each_entry(t, &m->transfers, transfer_list) {
if (t->tx_buf) { if (t->tx_buf) {
memcpy(local_buf + i, t->tx_buf, t->len); memcpy(local_buf + i, t->tx_buf, t->len);
i += t->len; i += t->len;
if (!t->rx_buf)
tx_only += t->len;
} }
} }
/* Add additional TX bytes to compensate SPCOM_TRANLEN_MAX */
if (loop > 0)
trans_len += tx_only;
if (trans_len > SPCOM_TRANLEN_MAX)
trans_len = SPCOM_TRANLEN_MAX;
/* Update device offset */
if (pos > 0) { if (pos > 0) {
addr = fsl_espi_cmd2addr(local_buf); addr = fsl_espi_cmd2addr(local_buf);
addr += pos; addr += rx_pos;
fsl_espi_addr2cmd(addr, local_buf); fsl_espi_addr2cmd(addr, local_buf);
} }
espi_trans->n_tx = n_tx; espi_trans->len = trans_len;
espi_trans->n_rx = trans_len;
espi_trans->len = trans_len + n_tx;
espi_trans->tx_buf = local_buf; espi_trans->tx_buf = local_buf;
espi_trans->rx_buf = local_buf; espi_trans->rx_buf = local_buf;
fsl_espi_do_trans(m, espi_trans); fsl_espi_do_trans(m, espi_trans);
memcpy(rx_buf + pos, espi_trans->rx_buf + n_tx, trans_len); /* If there is at least one RX byte then copy it to rx_buf */
if (tx_only < SPCOM_TRANLEN_MAX)
memcpy(rx_buf + rx_pos, espi_trans->rx_buf + tx_only,
trans_len - tx_only);
rx_pos += trans_len - tx_only;
if (loop > 0) if (loop > 0)
espi_trans->actual_length += espi_trans->len - n_tx; espi_trans->actual_length += espi_trans->len - tx_only;
else else
espi_trans->actual_length += espi_trans->len; espi_trans->actual_length += espi_trans->len;
} }
...@@ -418,6 +432,7 @@ static int fsl_espi_do_one_msg(struct spi_master *master, ...@@ -418,6 +432,7 @@ static int fsl_espi_do_one_msg(struct spi_master *master,
u8 *rx_buf = NULL; u8 *rx_buf = NULL;
unsigned int n_tx = 0; unsigned int n_tx = 0;
unsigned int n_rx = 0; unsigned int n_rx = 0;
unsigned int xfer_len = 0;
struct fsl_espi_transfer espi_trans; struct fsl_espi_transfer espi_trans;
list_for_each_entry(t, &m->transfers, transfer_list) { list_for_each_entry(t, &m->transfers, transfer_list) {
...@@ -427,11 +442,13 @@ static int fsl_espi_do_one_msg(struct spi_master *master, ...@@ -427,11 +442,13 @@ static int fsl_espi_do_one_msg(struct spi_master *master,
n_rx += t->len; n_rx += t->len;
rx_buf = t->rx_buf; rx_buf = t->rx_buf;
} }
if ((t->tx_buf) || (t->rx_buf))
xfer_len += t->len;
} }
espi_trans.n_tx = n_tx; espi_trans.n_tx = n_tx;
espi_trans.n_rx = n_rx; espi_trans.n_rx = n_rx;
espi_trans.len = n_tx + n_rx; espi_trans.len = xfer_len;
espi_trans.actual_length = 0; espi_trans.actual_length = 0;
espi_trans.status = 0; espi_trans.status = 0;
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment