|
@@ -42,7 +42,6 @@ struct fsl_espi_transfer {
|
|
|
void *rx_buf;
|
|
|
unsigned len;
|
|
|
unsigned actual_length;
|
|
|
- int status;
|
|
|
};
|
|
|
|
|
|
/* eSPI Controller mode register definitions */
|
|
@@ -269,14 +268,14 @@ static int fsl_espi_bufs(struct spi_device *spi, struct spi_transfer *t)
|
|
|
return mpc8xxx_spi->count;
|
|
|
}
|
|
|
|
|
|
-static void fsl_espi_do_trans(struct spi_message *m,
|
|
|
- struct fsl_espi_transfer *tr)
|
|
|
+static int fsl_espi_do_trans(struct spi_message *m,
|
|
|
+ struct fsl_espi_transfer *tr)
|
|
|
{
|
|
|
struct spi_device *spi = m->spi;
|
|
|
struct mpc8xxx_spi *mspi = spi_master_get_devdata(spi->master);
|
|
|
struct fsl_espi_transfer *espi_trans = tr;
|
|
|
struct spi_transfer *t, *first, trans;
|
|
|
- int status = 0;
|
|
|
+ int ret = 0;
|
|
|
|
|
|
memset(&trans, 0, sizeof(trans));
|
|
|
|
|
@@ -285,10 +284,9 @@ static void fsl_espi_do_trans(struct spi_message *m,
|
|
|
list_for_each_entry(t, &m->transfers, transfer_list) {
|
|
|
if ((first->bits_per_word != t->bits_per_word) ||
|
|
|
(first->speed_hz != t->speed_hz)) {
|
|
|
- espi_trans->status = -EINVAL;
|
|
|
dev_err(mspi->dev,
|
|
|
"bits_per_word/speed_hz should be same for the same SPI transfer\n");
|
|
|
- return;
|
|
|
+ return -EINVAL;
|
|
|
}
|
|
|
|
|
|
trans.speed_hz = t->speed_hz;
|
|
@@ -303,52 +301,59 @@ static void fsl_espi_do_trans(struct spi_message *m,
|
|
|
fsl_espi_setup_transfer(spi, &trans);
|
|
|
|
|
|
if (trans.len)
|
|
|
- status = fsl_espi_bufs(spi, &trans);
|
|
|
+ ret = fsl_espi_bufs(spi, &trans);
|
|
|
|
|
|
- if (status)
|
|
|
- status = -EMSGSIZE;
|
|
|
+ if (ret)
|
|
|
+ ret = -EMSGSIZE;
|
|
|
|
|
|
if (trans.delay_usecs)
|
|
|
udelay(trans.delay_usecs);
|
|
|
|
|
|
- espi_trans->status = status;
|
|
|
fsl_espi_setup_transfer(spi, NULL);
|
|
|
+
|
|
|
+ return ret;
|
|
|
}
|
|
|
|
|
|
-static void fsl_espi_cmd_trans(struct spi_message *m,
|
|
|
- struct fsl_espi_transfer *trans, u8 *rx_buff)
|
|
|
+static int fsl_espi_cmd_trans(struct spi_message *m,
|
|
|
+ struct fsl_espi_transfer *trans, u8 *rx_buff)
|
|
|
{
|
|
|
struct mpc8xxx_spi *mspi = spi_master_get_devdata(m->spi->master);
|
|
|
struct fsl_espi_transfer *espi_trans = trans;
|
|
|
+ int ret;
|
|
|
|
|
|
fsl_espi_copy_to_buf(m, mspi);
|
|
|
|
|
|
espi_trans->tx_buf = mspi->local_buf;
|
|
|
espi_trans->rx_buf = mspi->local_buf;
|
|
|
- fsl_espi_do_trans(m, espi_trans);
|
|
|
+ ret = fsl_espi_do_trans(m, espi_trans);
|
|
|
|
|
|
espi_trans->actual_length = espi_trans->len;
|
|
|
+
|
|
|
+ return ret;
|
|
|
}
|
|
|
|
|
|
-static void fsl_espi_rw_trans(struct spi_message *m,
|
|
|
- struct fsl_espi_transfer *trans, u8 *rx_buff)
|
|
|
+static int fsl_espi_rw_trans(struct spi_message *m,
|
|
|
+ struct fsl_espi_transfer *trans, u8 *rx_buff)
|
|
|
{
|
|
|
struct mpc8xxx_spi *mspi = spi_master_get_devdata(m->spi->master);
|
|
|
unsigned int tx_only;
|
|
|
+ int ret;
|
|
|
|
|
|
tx_only = fsl_espi_copy_to_buf(m, mspi);
|
|
|
|
|
|
trans->tx_buf = mspi->local_buf;
|
|
|
trans->rx_buf = mspi->local_buf;
|
|
|
- fsl_espi_do_trans(m, trans);
|
|
|
+ ret = fsl_espi_do_trans(m, trans);
|
|
|
|
|
|
- if (!trans->status) {
|
|
|
+ if (!ret) {
|
|
|
/* If there is at least one RX byte then copy it to rx_buff */
|
|
|
if (trans->len > tx_only)
|
|
|
memcpy(rx_buff, trans->rx_buf + tx_only,
|
|
|
trans->len - tx_only);
|
|
|
trans->actual_length += trans->len;
|
|
|
}
|
|
|
+
|
|
|
+ return ret;
|
|
|
}
|
|
|
|
|
|
static int fsl_espi_do_one_msg(struct spi_master *master,
|
|
@@ -358,6 +363,7 @@ static int fsl_espi_do_one_msg(struct spi_master *master,
|
|
|
u8 *rx_buf = NULL;
|
|
|
unsigned int xfer_len = 0;
|
|
|
struct fsl_espi_transfer espi_trans;
|
|
|
+ int ret;
|
|
|
|
|
|
list_for_each_entry(t, &m->transfers, transfer_list) {
|
|
|
if (t->rx_buf)
|
|
@@ -368,15 +374,14 @@ static int fsl_espi_do_one_msg(struct spi_master *master,
|
|
|
|
|
|
espi_trans.len = xfer_len;
|
|
|
espi_trans.actual_length = 0;
|
|
|
- espi_trans.status = 0;
|
|
|
|
|
|
if (!rx_buf)
|
|
|
- fsl_espi_cmd_trans(m, &espi_trans, NULL);
|
|
|
+ ret = fsl_espi_cmd_trans(m, &espi_trans, NULL);
|
|
|
else
|
|
|
- fsl_espi_rw_trans(m, &espi_trans, rx_buf);
|
|
|
+ ret = fsl_espi_rw_trans(m, &espi_trans, rx_buf);
|
|
|
|
|
|
m->actual_length = espi_trans.actual_length;
|
|
|
- m->status = espi_trans.status;
|
|
|
+ m->status = ret;
|
|
|
spi_finalize_current_message(master);
|
|
|
return 0;
|
|
|
}
|