spi: rspi: Extract rspi_wait_for_{tx_empty,rx_full}()
Signed-off-by: Geert Uytterhoeven <geert+renesas@glider.be> Signed-off-by: Mark Brown <broonie@linaro.org>hifive-unleashed-5.1
parent
3beb61dbfc
commit
5f684c34fc
|
@ -405,11 +405,22 @@ static int rspi_wait_for_interrupt(struct rspi_data *rspi, u8 wait_mask,
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static inline int rspi_wait_for_tx_empty(struct rspi_data *rspi)
|
||||||
|
{
|
||||||
|
return rspi_wait_for_interrupt(rspi, SPSR_SPTEF, SPCR_SPTIE);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline int rspi_wait_for_rx_full(struct rspi_data *rspi)
|
||||||
|
{
|
||||||
|
return rspi_wait_for_interrupt(rspi, SPSR_SPRF, SPCR_SPRIE);
|
||||||
|
}
|
||||||
|
|
||||||
static int rspi_data_out(struct rspi_data *rspi, u8 data)
|
static int rspi_data_out(struct rspi_data *rspi, u8 data)
|
||||||
{
|
{
|
||||||
if (rspi_wait_for_interrupt(rspi, SPSR_SPTEF, SPCR_SPTIE) < 0) {
|
int error = rspi_wait_for_tx_empty(rspi);
|
||||||
|
if (error < 0) {
|
||||||
dev_err(&rspi->master->dev, "transmit timeout\n");
|
dev_err(&rspi->master->dev, "transmit timeout\n");
|
||||||
return -ETIMEDOUT;
|
return error;
|
||||||
}
|
}
|
||||||
rspi_write_data(rspi, data);
|
rspi_write_data(rspi, data);
|
||||||
return 0;
|
return 0;
|
||||||
|
@ -417,11 +428,13 @@ static int rspi_data_out(struct rspi_data *rspi, u8 data)
|
||||||
|
|
||||||
static int rspi_data_in(struct rspi_data *rspi)
|
static int rspi_data_in(struct rspi_data *rspi)
|
||||||
{
|
{
|
||||||
|
int error;
|
||||||
u8 data;
|
u8 data;
|
||||||
|
|
||||||
if (rspi_wait_for_interrupt(rspi, SPSR_SPRF, SPCR_SPRIE) < 0) {
|
error = rspi_wait_for_rx_full(rspi);
|
||||||
|
if (error < 0) {
|
||||||
dev_err(&rspi->master->dev, "receive timeout\n");
|
dev_err(&rspi->master->dev, "receive timeout\n");
|
||||||
return -ETIMEDOUT;
|
return error;
|
||||||
}
|
}
|
||||||
data = rspi_read_data(rspi);
|
data = rspi_read_data(rspi);
|
||||||
return data;
|
return data;
|
||||||
|
@ -737,7 +750,7 @@ static int rspi_transfer_out_in(struct rspi_data *rspi,
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Wait for the last transmission */
|
/* Wait for the last transmission */
|
||||||
rspi_wait_for_interrupt(rspi, SPSR_SPTEF, SPCR_SPTIE);
|
rspi_wait_for_tx_empty(rspi);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
@ -783,7 +796,7 @@ static int rspi_rz_transfer_out_in(struct rspi_data *rspi,
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Wait for the last transmission */
|
/* Wait for the last transmission */
|
||||||
rspi_wait_for_interrupt(rspi, SPSR_SPTEF, SPCR_SPTIE);
|
rspi_wait_for_tx_empty(rspi);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
@ -818,7 +831,7 @@ static int qspi_transfer_out_in(struct rspi_data *rspi,
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Wait for the last transmission */
|
/* Wait for the last transmission */
|
||||||
rspi_wait_for_interrupt(rspi, SPSR_SPTEF, SPCR_SPTIE);
|
rspi_wait_for_tx_empty(rspi);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
@ -836,7 +849,7 @@ static int qspi_transfer_out(struct rspi_data *rspi, struct spi_transfer *xfer)
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Wait for the last transmission */
|
/* Wait for the last transmission */
|
||||||
rspi_wait_for_interrupt(rspi, SPSR_SPTEF, SPCR_SPTIE);
|
rspi_wait_for_tx_empty(rspi);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue