Commit 17c49e53 authored by Mark Brown's avatar Mark Brown

Merge remote-tracking branches 'spi/topic/pxa', 'spi/topic/pxa2xx',...

Merge remote-tracking branches 'spi/topic/pxa', 'spi/topic/pxa2xx', 'spi/topic/qup', 'spi/topic/rockchip' and 'spi/topic/sh' into spi-next
...@@ -6,6 +6,7 @@ and display controllers using the SPI communication interface. ...@@ -6,6 +6,7 @@ and display controllers using the SPI communication interface.
Required Properties: Required Properties:
- compatible: should be one of the following. - compatible: should be one of the following.
"rockchip,rv1108-spi" for rv1108 SoCs.
"rockchip,rk3036-spi" for rk3036 SoCS. "rockchip,rk3036-spi" for rk3036 SoCS.
"rockchip,rk3066-spi" for rk3066 SoCs. "rockchip,rk3066-spi" for rk3066 SoCs.
"rockchip,rk3188-spi" for rk3188 SoCs. "rockchip,rk3188-spi" for rk3188 SoCs.
......
...@@ -517,8 +517,8 @@ config SPI_PPC4xx ...@@ -517,8 +517,8 @@ config SPI_PPC4xx
config SPI_PXA2XX config SPI_PXA2XX
tristate "PXA2xx SSP SPI master" tristate "PXA2xx SSP SPI master"
depends on (ARCH_PXA || PCI || ACPI) depends on (ARCH_PXA || ARCH_MMP || PCI || ACPI)
select PXA_SSP if ARCH_PXA select PXA_SSP if ARCH_PXA || ARCH_MMP
help help
This enables using a PXA2xx or Sodaville SSP port as a SPI master This enables using a PXA2xx or Sodaville SSP port as a SPI master
controller. The driver can be configured to use any SSP port and controller. The driver can be configured to use any SSP port and
......
...@@ -402,8 +402,8 @@ static void cs_assert(struct driver_data *drv_data) ...@@ -402,8 +402,8 @@ static void cs_assert(struct driver_data *drv_data)
return; return;
} }
if (gpio_is_valid(chip->gpio_cs)) { if (chip->gpiod_cs) {
gpio_set_value(chip->gpio_cs, chip->gpio_cs_inverted); gpiod_set_value(chip->gpiod_cs, chip->gpio_cs_inverted);
return; return;
} }
...@@ -424,8 +424,8 @@ static void cs_deassert(struct driver_data *drv_data) ...@@ -424,8 +424,8 @@ static void cs_deassert(struct driver_data *drv_data)
return; return;
} }
if (gpio_is_valid(chip->gpio_cs)) { if (chip->gpiod_cs) {
gpio_set_value(chip->gpio_cs, !chip->gpio_cs_inverted); gpiod_set_value(chip->gpiod_cs, !chip->gpio_cs_inverted);
return; return;
} }
...@@ -1213,17 +1213,16 @@ static int setup_cs(struct spi_device *spi, struct chip_data *chip, ...@@ -1213,17 +1213,16 @@ static int setup_cs(struct spi_device *spi, struct chip_data *chip,
struct pxa2xx_spi_chip *chip_info) struct pxa2xx_spi_chip *chip_info)
{ {
struct driver_data *drv_data = spi_master_get_devdata(spi->master); struct driver_data *drv_data = spi_master_get_devdata(spi->master);
struct gpio_desc *gpiod;
int err = 0; int err = 0;
if (chip == NULL) if (chip == NULL)
return 0; return 0;
if (drv_data->cs_gpiods) { if (drv_data->cs_gpiods) {
struct gpio_desc *gpiod;
gpiod = drv_data->cs_gpiods[spi->chip_select]; gpiod = drv_data->cs_gpiods[spi->chip_select];
if (gpiod) { if (gpiod) {
chip->gpio_cs = desc_to_gpio(gpiod); chip->gpiod_cs = gpiod;
chip->gpio_cs_inverted = spi->mode & SPI_CS_HIGH; chip->gpio_cs_inverted = spi->mode & SPI_CS_HIGH;
gpiod_set_value(gpiod, chip->gpio_cs_inverted); gpiod_set_value(gpiod, chip->gpio_cs_inverted);
} }
...@@ -1237,8 +1236,10 @@ static int setup_cs(struct spi_device *spi, struct chip_data *chip, ...@@ -1237,8 +1236,10 @@ static int setup_cs(struct spi_device *spi, struct chip_data *chip,
/* NOTE: setup() can be called multiple times, possibly with /* NOTE: setup() can be called multiple times, possibly with
* different chip_info, release previously requested GPIO * different chip_info, release previously requested GPIO
*/ */
if (gpio_is_valid(chip->gpio_cs)) if (chip->gpiod_cs) {
gpio_free(chip->gpio_cs); gpio_free(desc_to_gpio(chip->gpiod_cs));
chip->gpiod_cs = NULL;
}
/* If (*cs_control) is provided, ignore GPIO chip select */ /* If (*cs_control) is provided, ignore GPIO chip select */
if (chip_info->cs_control) { if (chip_info->cs_control) {
...@@ -1254,11 +1255,11 @@ static int setup_cs(struct spi_device *spi, struct chip_data *chip, ...@@ -1254,11 +1255,11 @@ static int setup_cs(struct spi_device *spi, struct chip_data *chip,
return err; return err;
} }
chip->gpio_cs = chip_info->gpio_cs; gpiod = gpio_to_desc(chip_info->gpio_cs);
chip->gpiod_cs = gpiod;
chip->gpio_cs_inverted = spi->mode & SPI_CS_HIGH; chip->gpio_cs_inverted = spi->mode & SPI_CS_HIGH;
err = gpio_direction_output(chip->gpio_cs, err = gpiod_direction_output(gpiod, !chip->gpio_cs_inverted);
!chip->gpio_cs_inverted);
} }
return err; return err;
...@@ -1317,8 +1318,7 @@ static int setup(struct spi_device *spi) ...@@ -1317,8 +1318,7 @@ static int setup(struct spi_device *spi)
} }
chip->frm = spi->chip_select; chip->frm = spi->chip_select;
} else }
chip->gpio_cs = -1;
chip->enable_dma = drv_data->master_info->enable_dma; chip->enable_dma = drv_data->master_info->enable_dma;
chip->timeout = TIMOUT_DFLT; chip->timeout = TIMOUT_DFLT;
} }
...@@ -1416,8 +1416,8 @@ static void cleanup(struct spi_device *spi) ...@@ -1416,8 +1416,8 @@ static void cleanup(struct spi_device *spi)
return; return;
if (drv_data->ssp_type != CE4100_SSP && !drv_data->cs_gpiods && if (drv_data->ssp_type != CE4100_SSP && !drv_data->cs_gpiods &&
gpio_is_valid(chip->gpio_cs)) chip->gpiod_cs)
gpio_free(chip->gpio_cs); gpio_free(desc_to_gpio(chip->gpiod_cs));
kfree(chip); kfree(chip);
} }
...@@ -1769,8 +1769,7 @@ static int pxa2xx_spi_probe(struct platform_device *pdev) ...@@ -1769,8 +1769,7 @@ static int pxa2xx_spi_probe(struct platform_device *pdev)
for (i = 0; i < master->num_chipselect; i++) { for (i = 0; i < master->num_chipselect; i++) {
struct gpio_desc *gpiod; struct gpio_desc *gpiod;
gpiod = devm_gpiod_get_index(dev, "cs", i, gpiod = devm_gpiod_get_index(dev, "cs", i, GPIOD_ASIS);
GPIOD_OUT_HIGH);
if (IS_ERR(gpiod)) { if (IS_ERR(gpiod)) {
/* Means use native chip select */ /* Means use native chip select */
if (PTR_ERR(gpiod) == -ENOENT) if (PTR_ERR(gpiod) == -ENOENT)
......
...@@ -83,7 +83,7 @@ struct chip_data { ...@@ -83,7 +83,7 @@ struct chip_data {
u16 lpss_tx_threshold; u16 lpss_tx_threshold;
u8 enable_dma; u8 enable_dma;
union { union {
int gpio_cs; struct gpio_desc *gpiod_cs;
unsigned int frm; unsigned int frm;
}; };
int gpio_cs_inverted; int gpio_cs_inverted;
......
...@@ -19,6 +19,7 @@ ...@@ -19,6 +19,7 @@
#include <linux/list.h> #include <linux/list.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/of.h> #include <linux/of.h>
#include <linux/of_device.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/pm_runtime.h> #include <linux/pm_runtime.h>
#include <linux/spi/spi.h> #include <linux/spi/spi.h>
...@@ -82,6 +83,8 @@ ...@@ -82,6 +83,8 @@
#define QUP_IO_M_MODE_BAM 3 #define QUP_IO_M_MODE_BAM 3
/* QUP_OPERATIONAL fields */ /* QUP_OPERATIONAL fields */
#define QUP_OP_IN_BLOCK_READ_REQ BIT(13)
#define QUP_OP_OUT_BLOCK_WRITE_REQ BIT(12)
#define QUP_OP_MAX_INPUT_DONE_FLAG BIT(11) #define QUP_OP_MAX_INPUT_DONE_FLAG BIT(11)
#define QUP_OP_MAX_OUTPUT_DONE_FLAG BIT(10) #define QUP_OP_MAX_OUTPUT_DONE_FLAG BIT(10)
#define QUP_OP_IN_SERVICE_FLAG BIT(9) #define QUP_OP_IN_SERVICE_FLAG BIT(9)
...@@ -118,7 +121,7 @@ ...@@ -118,7 +121,7 @@
#define SPI_NUM_CHIPSELECTS 4 #define SPI_NUM_CHIPSELECTS 4
#define SPI_MAX_DMA_XFER (SZ_64K - 64) #define SPI_MAX_XFER (SZ_64K - 64)
/* high speed mode is when bus rate is greater then 26MHz */ /* high speed mode is when bus rate is greater then 26MHz */
#define SPI_HS_MIN_RATE 26000000 #define SPI_HS_MIN_RATE 26000000
...@@ -147,13 +150,37 @@ struct spi_qup { ...@@ -147,13 +150,37 @@ struct spi_qup {
int n_words; int n_words;
int tx_bytes; int tx_bytes;
int rx_bytes; int rx_bytes;
const u8 *tx_buf;
u8 *rx_buf;
int qup_v1; int qup_v1;
int use_dma; int mode;
struct dma_slave_config rx_conf; struct dma_slave_config rx_conf;
struct dma_slave_config tx_conf; struct dma_slave_config tx_conf;
}; };
static int spi_qup_io_config(struct spi_device *spi, struct spi_transfer *xfer);
static inline bool spi_qup_is_flag_set(struct spi_qup *controller, u32 flag)
{
u32 opflag = readl_relaxed(controller->base + QUP_OPERATIONAL);
return (opflag & flag) != 0;
}
static inline bool spi_qup_is_dma_xfer(int mode)
{
if (mode == QUP_IO_M_MODE_DMOV || mode == QUP_IO_M_MODE_BAM)
return true;
return false;
}
/* get's the transaction size length */
static inline unsigned int spi_qup_len(struct spi_qup *controller)
{
return controller->n_words * controller->w_size;
}
static inline bool spi_qup_is_valid_state(struct spi_qup *controller) static inline bool spi_qup_is_valid_state(struct spi_qup *controller)
{ {
...@@ -207,29 +234,26 @@ static int spi_qup_set_state(struct spi_qup *controller, u32 state) ...@@ -207,29 +234,26 @@ static int spi_qup_set_state(struct spi_qup *controller, u32 state)
return 0; return 0;
} }
static void spi_qup_fifo_read(struct spi_qup *controller, static void spi_qup_read_from_fifo(struct spi_qup *controller, u32 num_words)
struct spi_transfer *xfer)
{ {
u8 *rx_buf = xfer->rx_buf; u8 *rx_buf = controller->rx_buf;
u32 word, state; int i, shift, num_bytes;
int idx, shift, w_size; u32 word;
w_size = controller->w_size;
while (controller->rx_bytes < xfer->len) { for (; num_words; num_words--) {
state = readl_relaxed(controller->base + QUP_OPERATIONAL);
if (0 == (state & QUP_OP_IN_FIFO_NOT_EMPTY))
break;
word = readl_relaxed(controller->base + QUP_INPUT_FIFO); word = readl_relaxed(controller->base + QUP_INPUT_FIFO);
num_bytes = min_t(int, spi_qup_len(controller) -
controller->rx_bytes,
controller->w_size);
if (!rx_buf) { if (!rx_buf) {
controller->rx_bytes += w_size; controller->rx_bytes += num_bytes;
continue; continue;
} }
for (idx = 0; idx < w_size; idx++, controller->rx_bytes++) { for (i = 0; i < num_bytes; i++, controller->rx_bytes++) {
/* /*
* The data format depends on bytes per SPI word: * The data format depends on bytes per SPI word:
* 4 bytes: 0x12345678 * 4 bytes: 0x12345678
...@@ -237,38 +261,81 @@ static void spi_qup_fifo_read(struct spi_qup *controller, ...@@ -237,38 +261,81 @@ static void spi_qup_fifo_read(struct spi_qup *controller,
* 1 byte : 0x00000012 * 1 byte : 0x00000012
*/ */
shift = BITS_PER_BYTE; shift = BITS_PER_BYTE;
shift *= (w_size - idx - 1); shift *= (controller->w_size - i - 1);
rx_buf[controller->rx_bytes] = word >> shift; rx_buf[controller->rx_bytes] = word >> shift;
} }
} }
} }
static void spi_qup_fifo_write(struct spi_qup *controller, static void spi_qup_read(struct spi_qup *controller, u32 *opflags)
struct spi_transfer *xfer)
{ {
const u8 *tx_buf = xfer->tx_buf; u32 remainder, words_per_block, num_words;
u32 word, state, data; bool is_block_mode = controller->mode == QUP_IO_M_MODE_BLOCK;
int idx, w_size;
remainder = DIV_ROUND_UP(spi_qup_len(controller) - controller->rx_bytes,
controller->w_size);
words_per_block = controller->in_blk_sz >> 2;
do {
/* ACK by clearing service flag */
writel_relaxed(QUP_OP_IN_SERVICE_FLAG,
controller->base + QUP_OPERATIONAL);
if (is_block_mode) {
num_words = (remainder > words_per_block) ?
words_per_block : remainder;
} else {
if (!spi_qup_is_flag_set(controller,
QUP_OP_IN_FIFO_NOT_EMPTY))
break;
w_size = controller->w_size; num_words = 1;
}
while (controller->tx_bytes < xfer->len) { /* read up to the maximum transfer size available */
spi_qup_read_from_fifo(controller, num_words);
state = readl_relaxed(controller->base + QUP_OPERATIONAL); remainder -= num_words;
if (state & QUP_OP_OUT_FIFO_FULL)
/* if block mode, check to see if next block is available */
if (is_block_mode && !spi_qup_is_flag_set(controller,
QUP_OP_IN_BLOCK_READ_REQ))
break; break;
} while (remainder);
/*
* Due to extra stickiness of the QUP_OP_IN_SERVICE_FLAG during block
* reads, it has to be cleared again at the very end. However, be sure
* to refresh opflags value because MAX_INPUT_DONE_FLAG may now be
* present and this is used to determine if transaction is complete
*/
*opflags = readl_relaxed(controller->base + QUP_OPERATIONAL);
if (is_block_mode && *opflags & QUP_OP_MAX_INPUT_DONE_FLAG)
writel_relaxed(QUP_OP_IN_SERVICE_FLAG,
controller->base + QUP_OPERATIONAL);
}
static void spi_qup_write_to_fifo(struct spi_qup *controller, u32 num_words)
{
const u8 *tx_buf = controller->tx_buf;
int i, num_bytes;
u32 word, data;
for (; num_words; num_words--) {
word = 0; word = 0;
for (idx = 0; idx < w_size; idx++, controller->tx_bytes++) {
if (!tx_buf) { num_bytes = min_t(int, spi_qup_len(controller) -
controller->tx_bytes += w_size; controller->tx_bytes,
break; controller->w_size);
if (tx_buf)
for (i = 0; i < num_bytes; i++) {
data = tx_buf[controller->tx_bytes + i];
word |= data << (BITS_PER_BYTE * (3 - i));
} }
data = tx_buf[controller->tx_bytes]; controller->tx_bytes += num_bytes;
word |= data << (BITS_PER_BYTE * (3 - idx));
}
writel_relaxed(word, controller->base + QUP_OUTPUT_FIFO); writel_relaxed(word, controller->base + QUP_OUTPUT_FIFO);
} }
...@@ -281,31 +348,61 @@ static void spi_qup_dma_done(void *data) ...@@ -281,31 +348,61 @@ static void spi_qup_dma_done(void *data)
complete(&qup->done); complete(&qup->done);
} }
static int spi_qup_prep_sg(struct spi_master *master, struct spi_transfer *xfer, static void spi_qup_write(struct spi_qup *controller)
enum dma_transfer_direction dir, {
bool is_block_mode = controller->mode == QUP_IO_M_MODE_BLOCK;
u32 remainder, words_per_block, num_words;
remainder = DIV_ROUND_UP(spi_qup_len(controller) - controller->tx_bytes,
controller->w_size);
words_per_block = controller->out_blk_sz >> 2;
do {
/* ACK by clearing service flag */
writel_relaxed(QUP_OP_OUT_SERVICE_FLAG,
controller->base + QUP_OPERATIONAL);
if (is_block_mode) {
num_words = (remainder > words_per_block) ?
words_per_block : remainder;
} else {
if (spi_qup_is_flag_set(controller,
QUP_OP_OUT_FIFO_FULL))
break;
num_words = 1;
}
spi_qup_write_to_fifo(controller, num_words);
remainder -= num_words;
/* if block mode, check to see if next block is available */
if (is_block_mode && !spi_qup_is_flag_set(controller,
QUP_OP_OUT_BLOCK_WRITE_REQ))
break;
} while (remainder);
}
static int spi_qup_prep_sg(struct spi_master *master, struct scatterlist *sgl,
unsigned int nents, enum dma_transfer_direction dir,
dma_async_tx_callback callback) dma_async_tx_callback callback)
{ {
struct spi_qup *qup = spi_master_get_devdata(master); struct spi_qup *qup = spi_master_get_devdata(master);
unsigned long flags = DMA_PREP_INTERRUPT | DMA_PREP_FENCE; unsigned long flags = DMA_PREP_INTERRUPT | DMA_PREP_FENCE;
struct dma_async_tx_descriptor *desc; struct dma_async_tx_descriptor *desc;
struct scatterlist *sgl;
struct dma_chan *chan; struct dma_chan *chan;
dma_cookie_t cookie; dma_cookie_t cookie;
unsigned int nents;
if (dir == DMA_MEM_TO_DEV) { if (dir == DMA_MEM_TO_DEV)
chan = master->dma_tx; chan = master->dma_tx;
nents = xfer->tx_sg.nents; else
sgl = xfer->tx_sg.sgl;
} else {
chan = master->dma_rx; chan = master->dma_rx;
nents = xfer->rx_sg.nents;
sgl = xfer->rx_sg.sgl;
}
desc = dmaengine_prep_slave_sg(chan, sgl, nents, dir, flags); desc = dmaengine_prep_slave_sg(chan, sgl, nents, dir, flags);
if (!desc) if (IS_ERR_OR_NULL(desc))
return -EINVAL; return desc ? PTR_ERR(desc) : -EINVAL;
desc->callback = callback; desc->callback = callback;
desc->callback_param = qup; desc->callback_param = qup;
...@@ -324,9 +421,33 @@ static void spi_qup_dma_terminate(struct spi_master *master, ...@@ -324,9 +421,33 @@ static void spi_qup_dma_terminate(struct spi_master *master,
dmaengine_terminate_all(master->dma_rx); dmaengine_terminate_all(master->dma_rx);
} }
static int spi_qup_do_dma(struct spi_master *master, struct spi_transfer *xfer) static u32 spi_qup_sgl_get_nents_len(struct scatterlist *sgl, u32 max,
u32 *nents)
{
struct scatterlist *sg;
u32 total = 0;
for (sg = sgl; sg; sg = sg_next(sg)) {
unsigned int len = sg_dma_len(sg);
/* check for overflow as well as limit */
if (((total + len) < total) || ((total + len) > max))
break;
total += len;
(*nents)++;
}
return total;
}
static int spi_qup_do_dma(struct spi_device *spi, struct spi_transfer *xfer,
unsigned long timeout)
{ {
dma_async_tx_callback rx_done = NULL, tx_done = NULL; dma_async_tx_callback rx_done = NULL, tx_done = NULL;
struct spi_master *master = spi->master;
struct spi_qup *qup = spi_master_get_devdata(master);
struct scatterlist *tx_sgl, *rx_sgl;
int ret; int ret;
if (xfer->rx_buf) if (xfer->rx_buf)
...@@ -334,43 +455,122 @@ static int spi_qup_do_dma(struct spi_master *master, struct spi_transfer *xfer) ...@@ -334,43 +455,122 @@ static int spi_qup_do_dma(struct spi_master *master, struct spi_transfer *xfer)
else if (xfer->tx_buf) else if (xfer->tx_buf)
tx_done = spi_qup_dma_done; tx_done = spi_qup_dma_done;
if (xfer->rx_buf) { rx_sgl = xfer->rx_sg.sgl;
ret = spi_qup_prep_sg(master, xfer, DMA_DEV_TO_MEM, rx_done); tx_sgl = xfer->tx_sg.sgl;
if (ret)
return ret;
dma_async_issue_pending(master->dma_rx); do {
} u32 rx_nents = 0, tx_nents = 0;
if (xfer->tx_buf) { if (rx_sgl)
ret = spi_qup_prep_sg(master, xfer, DMA_MEM_TO_DEV, tx_done); qup->n_words = spi_qup_sgl_get_nents_len(rx_sgl,
SPI_MAX_XFER, &rx_nents) / qup->w_size;
if (tx_sgl)
qup->n_words = spi_qup_sgl_get_nents_len(tx_sgl,
SPI_MAX_XFER, &tx_nents) / qup->w_size;
if (!qup->n_words)
return -EIO;
ret = spi_qup_io_config(spi, xfer);
if (ret) if (ret)
return ret; return ret;
dma_async_issue_pending(master->dma_tx); /* before issuing the descriptors, set the QUP to run */
} ret = spi_qup_set_state(qup, QUP_STATE_RUN);
if (ret) {
dev_warn(qup->dev, "cannot set RUN state\n");
return ret;
}
if (rx_sgl) {
ret = spi_qup_prep_sg(master, rx_sgl, rx_nents,
DMA_DEV_TO_MEM, rx_done);
if (ret)
return ret;
dma_async_issue_pending(master->dma_rx);
}
if (tx_sgl) {
ret = spi_qup_prep_sg(master, tx_sgl, tx_nents,
DMA_MEM_TO_DEV, tx_done);
if (ret)
return ret;
dma_async_issue_pending(master->dma_tx);
}
if (!wait_for_completion_timeout(&qup->done, timeout))
return -ETIMEDOUT;
for (; rx_sgl && rx_nents--; rx_sgl = sg_next(rx_sgl))
;
for (; tx_sgl && tx_nents--; tx_sgl = sg_next(tx_sgl))
;
} while (rx_sgl || tx_sgl);
return 0; return 0;
} }
static int spi_qup_do_pio(struct spi_master *master, struct spi_transfer *xfer) static int spi_qup_do_pio(struct spi_device *spi, struct spi_transfer *xfer,
unsigned long timeout)
{ {
struct spi_master *master = spi->master;
struct spi_qup *qup = spi_master_get_devdata(master); struct spi_qup *qup = spi_master_get_devdata(master);
int ret; int ret, n_words, iterations, offset = 0;
ret = spi_qup_set_state(qup, QUP_STATE_RUN); n_words = qup->n_words;
if (ret) { iterations = n_words / SPI_MAX_XFER; /* round down */
dev_warn(qup->dev, "cannot set RUN state\n"); qup->rx_buf = xfer->rx_buf;
return ret; qup->tx_buf = xfer->tx_buf;
}
ret = spi_qup_set_state(qup, QUP_STATE_PAUSE); do {
if (ret) { if (iterations)
dev_warn(qup->dev, "cannot set PAUSE state\n"); qup->n_words = SPI_MAX_XFER;
return ret; else
} qup->n_words = n_words % SPI_MAX_XFER;
if (qup->tx_buf && offset)
qup->tx_buf = xfer->tx_buf + offset * SPI_MAX_XFER;
if (qup->rx_buf && offset)
qup->rx_buf = xfer->rx_buf + offset * SPI_MAX_XFER;
/*
* if the transaction is small enough, we need
* to fallback to FIFO mode
*/
if (qup->n_words <= (qup->in_fifo_sz / sizeof(u32)))
qup->mode = QUP_IO_M_MODE_FIFO;
spi_qup_fifo_write(qup, xfer); ret = spi_qup_io_config(spi, xfer);
if (ret)
return ret;
ret = spi_qup_set_state(qup, QUP_STATE_RUN);
if (ret) {
dev_warn(qup->dev, "cannot set RUN state\n");
return ret;
}
ret = spi_qup_set_state(qup, QUP_STATE_PAUSE);
if (ret) {
dev_warn(qup->dev, "cannot set PAUSE state\n");
return ret;
}
if (qup->mode == QUP_IO_M_MODE_FIFO)
spi_qup_write(qup);
ret = spi_qup_set_state(qup, QUP_STATE_RUN);
if (ret) {
dev_warn(qup->dev, "cannot set RUN state\n");
return ret;
}
if (!wait_for_completion_timeout(&qup->done, timeout))
return -ETIMEDOUT;
offset++;
} while (iterations--);
return 0; return 0;
} }
...@@ -378,29 +578,15 @@ static int spi_qup_do_pio(struct spi_master *master, struct spi_transfer *xfer) ...@@ -378,29 +578,15 @@ static int spi_qup_do_pio(struct spi_master *master, struct spi_transfer *xfer)
static irqreturn_t spi_qup_qup_irq(int irq, void *dev_id) static irqreturn_t spi_qup_qup_irq(int irq, void *dev_id)
{ {
struct spi_qup *controller = dev_id; struct spi_qup *controller = dev_id;
struct spi_transfer *xfer;
u32 opflags, qup_err, spi_err; u32 opflags, qup_err, spi_err;
unsigned long flags;
int error = 0; int error = 0;
spin_lock_irqsave(&controller->lock, flags);
xfer = controller->xfer;
controller->xfer = NULL;
spin_unlock_irqrestore(&controller->lock, flags);
qup_err = readl_relaxed(controller->base + QUP_ERROR_FLAGS); qup_err = readl_relaxed(controller->base + QUP_ERROR_FLAGS);
spi_err = readl_relaxed(controller->base + SPI_ERROR_FLAGS); spi_err = readl_relaxed(controller->base + SPI_ERROR_FLAGS);
opflags = readl_relaxed(controller->base + QUP_OPERATIONAL); opflags = readl_relaxed(controller->base + QUP_OPERATIONAL);
writel_relaxed(qup_err, controller->base + QUP_ERROR_FLAGS); writel_relaxed(qup_err, controller->base + QUP_ERROR_FLAGS);
writel_relaxed(spi_err, controller->base + SPI_ERROR_FLAGS); writel_relaxed(spi_err, controller->base + SPI_ERROR_FLAGS);
writel_relaxed(opflags, controller->base + QUP_OPERATIONAL);
if (!xfer) {
dev_err_ratelimited(controller->dev, "unexpected irq %08x %08x %08x\n",
qup_err, spi_err, opflags);
return IRQ_HANDLED;
}
if (qup_err) { if (qup_err) {
if (qup_err & QUP_ERROR_OUTPUT_OVER_RUN) if (qup_err & QUP_ERROR_OUTPUT_OVER_RUN)
...@@ -424,54 +610,27 @@ static irqreturn_t spi_qup_qup_irq(int irq, void *dev_id) ...@@ -424,54 +610,27 @@ static irqreturn_t spi_qup_qup_irq(int irq, void *dev_id)
error = -EIO; error = -EIO;
} }
if (!controller->use_dma) { if (spi_qup_is_dma_xfer(controller->mode)) {
writel_relaxed(opflags, controller->base + QUP_OPERATIONAL);
} else {
if (opflags & QUP_OP_IN_SERVICE_FLAG) if (opflags & QUP_OP_IN_SERVICE_FLAG)
spi_qup_fifo_read(controller, xfer); spi_qup_read(controller, &opflags);
if (opflags & QUP_OP_OUT_SERVICE_FLAG) if (opflags & QUP_OP_OUT_SERVICE_FLAG)
spi_qup_fifo_write(controller, xfer); spi_qup_write(controller);
} }
spin_lock_irqsave(&controller->lock, flags); if ((opflags & QUP_OP_MAX_INPUT_DONE_FLAG) || error)
controller->error = error;
controller->xfer = xfer;
spin_unlock_irqrestore(&controller->lock, flags);
if (controller->rx_bytes == xfer->len || error)
complete(&controller->done); complete(&controller->done);
return IRQ_HANDLED; return IRQ_HANDLED;
} }
static u32 /* set clock freq ... bits per word, determine mode */
spi_qup_get_mode(struct spi_master *master, struct spi_transfer *xfer) static int spi_qup_io_prep(struct spi_device *spi, struct spi_transfer *xfer)
{
struct spi_qup *qup = spi_master_get_devdata(master);
u32 mode;
qup->w_size = 4;
if (xfer->bits_per_word <= 8)
qup->w_size = 1;
else if (xfer->bits_per_word <= 16)
qup->w_size = 2;
qup->n_words = xfer->len / qup->w_size;
if (qup->n_words <= (qup->in_fifo_sz / sizeof(u32)))
mode = QUP_IO_M_MODE_FIFO;
else
mode = QUP_IO_M_MODE_BLOCK;
return mode;
}
/* set clock freq ... bits per word */
static int spi_qup_io_config(struct spi_device *spi, struct spi_transfer *xfer)
{ {
struct spi_qup *controller = spi_master_get_devdata(spi->master); struct spi_qup *controller = spi_master_get_devdata(spi->master);
u32 config, iomode, mode, control; int ret;
int ret, n_words;
if (spi->mode & SPI_LOOP && xfer->len > controller->in_fifo_sz) { if (spi->mode & SPI_LOOP && xfer->len > controller->in_fifo_sz) {
dev_err(controller->dev, "too big size for loopback %d > %d\n", dev_err(controller->dev, "too big size for loopback %d > %d\n",
...@@ -486,30 +645,59 @@ static int spi_qup_io_config(struct spi_device *spi, struct spi_transfer *xfer) ...@@ -486,30 +645,59 @@ static int spi_qup_io_config(struct spi_device *spi, struct spi_transfer *xfer)
return -EIO; return -EIO;
} }
controller->w_size = DIV_ROUND_UP(xfer->bits_per_word, 8);
controller->n_words = xfer->len / controller->w_size;
if (controller->n_words <= (controller->in_fifo_sz / sizeof(u32)))
controller->mode = QUP_IO_M_MODE_FIFO;
else if (spi->master->can_dma &&
spi->master->can_dma(spi->master, spi, xfer) &&
spi->master->cur_msg_mapped)
controller->mode = QUP_IO_M_MODE_BAM;
else
controller->mode = QUP_IO_M_MODE_BLOCK;
return 0;
}
/* prep qup for another spi transaction of specific type */
static int spi_qup_io_config(struct spi_device *spi, struct spi_transfer *xfer)
{
struct spi_qup *controller = spi_master_get_devdata(spi->master);
u32 config, iomode, control;
unsigned long flags;
spin_lock_irqsave(&controller->lock, flags);
controller->xfer = xfer;
controller->error = 0;
controller->rx_bytes = 0;
controller->tx_bytes = 0;
spin_unlock_irqrestore(&controller->lock, flags);
if (spi_qup_set_state(controller, QUP_STATE_RESET)) { if (spi_qup_set_state(controller, QUP_STATE_RESET)) {
dev_err(controller->dev, "cannot set RESET state\n"); dev_err(controller->dev, "cannot set RESET state\n");
return -EIO; return -EIO;
} }
mode = spi_qup_get_mode(spi->master, xfer); switch (controller->mode) {
n_words = controller->n_words; case QUP_IO_M_MODE_FIFO:
writel_relaxed(controller->n_words,
if (mode == QUP_IO_M_MODE_FIFO) { controller->base + QUP_MX_READ_CNT);
writel_relaxed(n_words, controller->base + QUP_MX_READ_CNT); writel_relaxed(controller->n_words,
writel_relaxed(n_words, controller->base + QUP_MX_WRITE_CNT); controller->base + QUP_MX_WRITE_CNT);
/* must be zero for FIFO */ /* must be zero for FIFO */
writel_relaxed(0, controller->base + QUP_MX_INPUT_CNT); writel_relaxed(0, controller->base + QUP_MX_INPUT_CNT);
writel_relaxed(0, controller->base + QUP_MX_OUTPUT_CNT); writel_relaxed(0, controller->base + QUP_MX_OUTPUT_CNT);
} else if (!controller->use_dma) { break;
writel_relaxed(n_words, controller->base + QUP_MX_INPUT_CNT); case QUP_IO_M_MODE_BAM:
writel_relaxed(n_words, controller->base + QUP_MX_OUTPUT_CNT); writel_relaxed(controller->n_words,
controller->base + QUP_MX_INPUT_CNT);
writel_relaxed(controller->n_words,
controller->base + QUP_MX_OUTPUT_CNT);
/* must be zero for BLOCK and BAM */ /* must be zero for BLOCK and BAM */
writel_relaxed(0, controller->base + QUP_MX_READ_CNT); writel_relaxed(0, controller->base + QUP_MX_READ_CNT);
writel_relaxed(0, controller->base + QUP_MX_WRITE_CNT); writel_relaxed(0, controller->base + QUP_MX_WRITE_CNT);
} else {
mode = QUP_IO_M_MODE_BAM;
writel_relaxed(0, controller->base + QUP_MX_READ_CNT);
writel_relaxed(0, controller->base + QUP_MX_WRITE_CNT);
if (!controller->qup_v1) { if (!controller->qup_v1) {
void __iomem *input_cnt; void __iomem *input_cnt;
...@@ -524,23 +712,38 @@ static int spi_qup_io_config(struct spi_device *spi, struct spi_transfer *xfer) ...@@ -524,23 +712,38 @@ static int spi_qup_io_config(struct spi_device *spi, struct spi_transfer *xfer)
if (xfer->tx_buf) if (xfer->tx_buf)
writel_relaxed(0, input_cnt); writel_relaxed(0, input_cnt);
else else
writel_relaxed(n_words, input_cnt); writel_relaxed(controller->n_words, input_cnt);
writel_relaxed(0, controller->base + QUP_MX_OUTPUT_CNT); writel_relaxed(0, controller->base + QUP_MX_OUTPUT_CNT);
} }
break;
case QUP_IO_M_MODE_BLOCK:
reinit_completion(&controller->done);
writel_relaxed(controller->n_words,
controller->base + QUP_MX_INPUT_CNT);
writel_relaxed(controller->n_words,
controller->base + QUP_MX_OUTPUT_CNT);
/* must be zero for BLOCK and BAM */
writel_relaxed(0, controller->base + QUP_MX_READ_CNT);
writel_relaxed(0, controller->base + QUP_MX_WRITE_CNT);
break;
default:
dev_err(controller->dev, "unknown mode = %d\n",
controller->mode);
return -EIO;
} }
iomode = readl_relaxed(controller->base + QUP_IO_M_MODES); iomode = readl_relaxed(controller->base + QUP_IO_M_MODES);
/* Set input and output transfer mode */ /* Set input and output transfer mode */
iomode &= ~(QUP_IO_M_INPUT_MODE_MASK | QUP_IO_M_OUTPUT_MODE_MASK); iomode &= ~(QUP_IO_M_INPUT_MODE_MASK | QUP_IO_M_OUTPUT_MODE_MASK);
if (!controller->use_dma) if (!spi_qup_is_dma_xfer(controller->mode))
iomode &= ~(QUP_IO_M_PACK_EN | QUP_IO_M_UNPACK_EN); iomode &= ~(QUP_IO_M_PACK_EN | QUP_IO_M_UNPACK_EN);
else else
iomode |= QUP_IO_M_PACK_EN | QUP_IO_M_UNPACK_EN; iomode |= QUP_IO_M_PACK_EN | QUP_IO_M_UNPACK_EN;
iomode |= (mode << QUP_IO_M_OUTPUT_MODE_MASK_SHIFT); iomode |= (controller->mode << QUP_IO_M_OUTPUT_MODE_MASK_SHIFT);
iomode |= (mode << QUP_IO_M_INPUT_MODE_MASK_SHIFT); iomode |= (controller->mode << QUP_IO_M_INPUT_MODE_MASK_SHIFT);
writel_relaxed(iomode, controller->base + QUP_IO_M_MODES); writel_relaxed(iomode, controller->base + QUP_IO_M_MODES);
...@@ -581,7 +784,7 @@ static int spi_qup_io_config(struct spi_device *spi, struct spi_transfer *xfer) ...@@ -581,7 +784,7 @@ static int spi_qup_io_config(struct spi_device *spi, struct spi_transfer *xfer)
config |= xfer->bits_per_word - 1; config |= xfer->bits_per_word - 1;
config |= QUP_CONFIG_SPI_MODE; config |= QUP_CONFIG_SPI_MODE;
if (controller->use_dma) { if (spi_qup_is_dma_xfer(controller->mode)) {
if (!xfer->tx_buf) if (!xfer->tx_buf)
config |= QUP_CONFIG_NO_OUTPUT; config |= QUP_CONFIG_NO_OUTPUT;
if (!xfer->rx_buf) if (!xfer->rx_buf)
...@@ -599,7 +802,7 @@ static int spi_qup_io_config(struct spi_device *spi, struct spi_transfer *xfer) ...@@ -599,7 +802,7 @@ static int spi_qup_io_config(struct spi_device *spi, struct spi_transfer *xfer)
* status change in BAM mode * status change in BAM mode
*/ */
if (mode == QUP_IO_M_MODE_BAM) if (spi_qup_is_dma_xfer(controller->mode))
mask = QUP_OP_IN_SERVICE_FLAG | QUP_OP_OUT_SERVICE_FLAG; mask = QUP_OP_IN_SERVICE_FLAG | QUP_OP_OUT_SERVICE_FLAG;
writel_relaxed(mask, controller->base + QUP_OPERATIONAL_MASK); writel_relaxed(mask, controller->base + QUP_OPERATIONAL_MASK);
...@@ -616,12 +819,13 @@ static int spi_qup_transfer_one(struct spi_master *master, ...@@ -616,12 +819,13 @@ static int spi_qup_transfer_one(struct spi_master *master,
unsigned long timeout, flags; unsigned long timeout, flags;
int ret = -EIO; int ret = -EIO;
ret = spi_qup_io_config(spi, xfer); ret = spi_qup_io_prep(spi, xfer);
if (ret) if (ret)
return ret; return ret;
timeout = DIV_ROUND_UP(xfer->speed_hz, MSEC_PER_SEC); timeout = DIV_ROUND_UP(xfer->speed_hz, MSEC_PER_SEC);
timeout = DIV_ROUND_UP(xfer->len * 8, timeout); timeout = DIV_ROUND_UP(min_t(unsigned long, SPI_MAX_XFER,
xfer->len) * 8, timeout);
timeout = 100 * msecs_to_jiffies(timeout); timeout = 100 * msecs_to_jiffies(timeout);
reinit_completion(&controller->done); reinit_completion(&controller->done);
...@@ -633,31 +837,22 @@ static int spi_qup_transfer_one(struct spi_master *master, ...@@ -633,31 +837,22 @@ static int spi_qup_transfer_one(struct spi_master *master,
controller->tx_bytes = 0; controller->tx_bytes = 0;
spin_unlock_irqrestore(&controller->lock, flags); spin_unlock_irqrestore(&controller->lock, flags);
if (controller->use_dma) if (spi_qup_is_dma_xfer(controller->mode))
ret = spi_qup_do_dma(master, xfer); ret = spi_qup_do_dma(spi, xfer, timeout);
else else
ret = spi_qup_do_pio(master, xfer); ret = spi_qup_do_pio(spi, xfer, timeout);
if (ret) if (ret)
goto exit; goto exit;
if (spi_qup_set_state(controller, QUP_STATE_RUN)) {
dev_warn(controller->dev, "cannot set EXECUTE state\n");
goto exit;
}
if (!wait_for_completion_timeout(&controller->done, timeout))
ret = -ETIMEDOUT;
exit: exit:
spi_qup_set_state(controller, QUP_STATE_RESET); spi_qup_set_state(controller, QUP_STATE_RESET);
spin_lock_irqsave(&controller->lock, flags); spin_lock_irqsave(&controller->lock, flags);
controller->xfer = NULL;
if (!ret) if (!ret)
ret = controller->error; ret = controller->error;
spin_unlock_irqrestore(&controller->lock, flags); spin_unlock_irqrestore(&controller->lock, flags);
if (ret && controller->use_dma) if (ret && spi_qup_is_dma_xfer(controller->mode))
spi_qup_dma_terminate(master, xfer); spi_qup_dma_terminate(master, xfer);
return ret; return ret;
...@@ -668,26 +863,28 @@ static bool spi_qup_can_dma(struct spi_master *master, struct spi_device *spi, ...@@ -668,26 +863,28 @@ static bool spi_qup_can_dma(struct spi_master *master, struct spi_device *spi,
{ {
struct spi_qup *qup = spi_master_get_devdata(master); struct spi_qup *qup = spi_master_get_devdata(master);
size_t dma_align = dma_get_cache_alignment(); size_t dma_align = dma_get_cache_alignment();
u32 mode; int n_words;
qup->use_dma = 0;
if (xfer->rx_buf && (xfer->len % qup->in_blk_sz || if (xfer->rx_buf) {
IS_ERR_OR_NULL(master->dma_rx) || if (!IS_ALIGNED((size_t)xfer->rx_buf, dma_align) ||
!IS_ALIGNED((size_t)xfer->rx_buf, dma_align))) IS_ERR_OR_NULL(master->dma_rx))
return false; return false;
if (qup->qup_v1 && (xfer->len % qup->in_blk_sz))
return false;
}
if (xfer->tx_buf && (xfer->len % qup->out_blk_sz || if (xfer->tx_buf) {
IS_ERR_OR_NULL(master->dma_tx) || if (!IS_ALIGNED((size_t)xfer->tx_buf, dma_align) ||
!IS_ALIGNED((size_t)xfer->tx_buf, dma_align))) IS_ERR_OR_NULL(master->dma_tx))
return false; return false;
if (qup->qup_v1 && (xfer->len % qup->out_blk_sz))
return false;
}
mode = spi_qup_get_mode(master, xfer); n_words = xfer->len / DIV_ROUND_UP(xfer->bits_per_word, 8);
if (mode == QUP_IO_M_MODE_FIFO) if (n_words <= (qup->in_fifo_sz / sizeof(u32)))
return false; return false;
qup->use_dma = 1;
return true; return true;
} }
...@@ -750,6 +947,24 @@ static int spi_qup_init_dma(struct spi_master *master, resource_size_t base) ...@@ -750,6 +947,24 @@ static int spi_qup_init_dma(struct spi_master *master, resource_size_t base)
return ret; return ret;
} }
static void spi_qup_set_cs(struct spi_device *spi, bool val)
{
struct spi_qup *controller;
u32 spi_ioc;
u32 spi_ioc_orig;
controller = spi_master_get_devdata(spi->master);
spi_ioc = readl_relaxed(controller->base + SPI_IO_CONTROL);
spi_ioc_orig = spi_ioc;
if (!val)
spi_ioc |= SPI_IO_C_FORCE_CS;
else
spi_ioc &= ~SPI_IO_C_FORCE_CS;
if (spi_ioc != spi_ioc_orig)
writel_relaxed(spi_ioc, controller->base + SPI_IO_CONTROL);
}
static int spi_qup_probe(struct platform_device *pdev) static int spi_qup_probe(struct platform_device *pdev)
{ {
struct spi_master *master; struct spi_master *master;
...@@ -824,7 +1039,7 @@ static int spi_qup_probe(struct platform_device *pdev) ...@@ -824,7 +1039,7 @@ static int spi_qup_probe(struct platform_device *pdev)
master->dev.of_node = pdev->dev.of_node; master->dev.of_node = pdev->dev.of_node;
master->auto_runtime_pm = true; master->auto_runtime_pm = true;
master->dma_alignment = dma_get_cache_alignment(); master->dma_alignment = dma_get_cache_alignment();
master->max_dma_len = SPI_MAX_DMA_XFER; master->max_dma_len = SPI_MAX_XFER;
platform_set_drvdata(pdev, master); platform_set_drvdata(pdev, master);
...@@ -842,9 +1057,10 @@ static int spi_qup_probe(struct platform_device *pdev) ...@@ -842,9 +1057,10 @@ static int spi_qup_probe(struct platform_device *pdev)
else if (!ret) else if (!ret)
master->can_dma = spi_qup_can_dma; master->can_dma = spi_qup_can_dma;
/* set v1 flag if device is version 1 */ controller->qup_v1 = (uintptr_t)of_device_get_match_data(dev);
if (of_device_is_compatible(dev->of_node, "qcom,spi-qup-v1.1.1"))
controller->qup_v1 = 1; if (!controller->qup_v1)
master->set_cs = spi_qup_set_cs;
spin_lock_init(&controller->lock); spin_lock_init(&controller->lock);
init_completion(&controller->done); init_completion(&controller->done);
...@@ -1037,7 +1253,7 @@ static int spi_qup_remove(struct platform_device *pdev) ...@@ -1037,7 +1253,7 @@ static int spi_qup_remove(struct platform_device *pdev)
} }
static const struct of_device_id spi_qup_dt_match[] = { static const struct of_device_id spi_qup_dt_match[] = {
{ .compatible = "qcom,spi-qup-v1.1.1", }, { .compatible = "qcom,spi-qup-v1.1.1", .data = (void *)1, },
{ .compatible = "qcom,spi-qup-v2.1.1", }, { .compatible = "qcom,spi-qup-v2.1.1", },
{ .compatible = "qcom,spi-qup-v2.2.1", }, { .compatible = "qcom,spi-qup-v2.2.1", },
{ } { }
......
...@@ -568,7 +568,13 @@ static void rockchip_spi_config(struct rockchip_spi *rs) ...@@ -568,7 +568,13 @@ static void rockchip_spi_config(struct rockchip_spi *rs)
writel_relaxed(cr0, rs->regs + ROCKCHIP_SPI_CTRLR0); writel_relaxed(cr0, rs->regs + ROCKCHIP_SPI_CTRLR0);
writel_relaxed(rs->len - 1, rs->regs + ROCKCHIP_SPI_CTRLR1); if (rs->n_bytes == 1)
writel_relaxed(rs->len - 1, rs->regs + ROCKCHIP_SPI_CTRLR1);
else if (rs->n_bytes == 2)
writel_relaxed((rs->len / 2) - 1, rs->regs + ROCKCHIP_SPI_CTRLR1);
else
writel_relaxed((rs->len * 2) - 1, rs->regs + ROCKCHIP_SPI_CTRLR1);
writel_relaxed(rs->fifo_len / 2 - 1, rs->regs + ROCKCHIP_SPI_TXFTLR); writel_relaxed(rs->fifo_len / 2 - 1, rs->regs + ROCKCHIP_SPI_TXFTLR);
writel_relaxed(rs->fifo_len / 2 - 1, rs->regs + ROCKCHIP_SPI_RXFTLR); writel_relaxed(rs->fifo_len / 2 - 1, rs->regs + ROCKCHIP_SPI_RXFTLR);
...@@ -666,7 +672,7 @@ static bool rockchip_spi_can_dma(struct spi_master *master, ...@@ -666,7 +672,7 @@ static bool rockchip_spi_can_dma(struct spi_master *master,
static int rockchip_spi_probe(struct platform_device *pdev) static int rockchip_spi_probe(struct platform_device *pdev)
{ {
int ret = 0; int ret;
struct rockchip_spi *rs; struct rockchip_spi *rs;
struct spi_master *master; struct spi_master *master;
struct resource *mem; struct resource *mem;
...@@ -703,13 +709,13 @@ static int rockchip_spi_probe(struct platform_device *pdev) ...@@ -703,13 +709,13 @@ static int rockchip_spi_probe(struct platform_device *pdev)
} }
ret = clk_prepare_enable(rs->apb_pclk); ret = clk_prepare_enable(rs->apb_pclk);
if (ret) { if (ret < 0) {
dev_err(&pdev->dev, "Failed to enable apb_pclk\n"); dev_err(&pdev->dev, "Failed to enable apb_pclk\n");
goto err_put_master; goto err_put_master;
} }
ret = clk_prepare_enable(rs->spiclk); ret = clk_prepare_enable(rs->spiclk);
if (ret) { if (ret < 0) {
dev_err(&pdev->dev, "Failed to enable spi_clk\n"); dev_err(&pdev->dev, "Failed to enable spi_clk\n");
goto err_disable_apbclk; goto err_disable_apbclk;
} }
...@@ -786,7 +792,7 @@ static int rockchip_spi_probe(struct platform_device *pdev) ...@@ -786,7 +792,7 @@ static int rockchip_spi_probe(struct platform_device *pdev)
} }
ret = devm_spi_register_master(&pdev->dev, master); ret = devm_spi_register_master(&pdev->dev, master);
if (ret) { if (ret < 0) {
dev_err(&pdev->dev, "Failed to register master\n"); dev_err(&pdev->dev, "Failed to register master\n");
goto err_free_dma_rx; goto err_free_dma_rx;
} }
...@@ -816,11 +822,15 @@ static int rockchip_spi_remove(struct platform_device *pdev) ...@@ -816,11 +822,15 @@ static int rockchip_spi_remove(struct platform_device *pdev)
struct spi_master *master = spi_master_get(platform_get_drvdata(pdev)); struct spi_master *master = spi_master_get(platform_get_drvdata(pdev));
struct rockchip_spi *rs = spi_master_get_devdata(master); struct rockchip_spi *rs = spi_master_get_devdata(master);
pm_runtime_disable(&pdev->dev); pm_runtime_get_sync(&pdev->dev);
clk_disable_unprepare(rs->spiclk); clk_disable_unprepare(rs->spiclk);
clk_disable_unprepare(rs->apb_pclk); clk_disable_unprepare(rs->apb_pclk);
pm_runtime_put_noidle(&pdev->dev);
pm_runtime_disable(&pdev->dev);
pm_runtime_set_suspended(&pdev->dev);
if (rs->dma_tx.ch) if (rs->dma_tx.ch)
dma_release_channel(rs->dma_tx.ch); dma_release_channel(rs->dma_tx.ch);
if (rs->dma_rx.ch) if (rs->dma_rx.ch)
...@@ -834,43 +844,34 @@ static int rockchip_spi_remove(struct platform_device *pdev) ...@@ -834,43 +844,34 @@ static int rockchip_spi_remove(struct platform_device *pdev)
#ifdef CONFIG_PM_SLEEP #ifdef CONFIG_PM_SLEEP
static int rockchip_spi_suspend(struct device *dev) static int rockchip_spi_suspend(struct device *dev)
{ {
int ret = 0; int ret;
struct spi_master *master = dev_get_drvdata(dev); struct spi_master *master = dev_get_drvdata(dev);
struct rockchip_spi *rs = spi_master_get_devdata(master); struct rockchip_spi *rs = spi_master_get_devdata(master);
ret = spi_master_suspend(rs->master); ret = spi_master_suspend(rs->master);
if (ret) if (ret < 0)
return ret; return ret;
if (!pm_runtime_suspended(dev)) { ret = pm_runtime_force_suspend(dev);
clk_disable_unprepare(rs->spiclk); if (ret < 0)
clk_disable_unprepare(rs->apb_pclk); return ret;
}
pinctrl_pm_select_sleep_state(dev); pinctrl_pm_select_sleep_state(dev);
return ret; return 0;
} }
static int rockchip_spi_resume(struct device *dev) static int rockchip_spi_resume(struct device *dev)
{ {
int ret = 0; int ret;
struct spi_master *master = dev_get_drvdata(dev); struct spi_master *master = dev_get_drvdata(dev);
struct rockchip_spi *rs = spi_master_get_devdata(master); struct rockchip_spi *rs = spi_master_get_devdata(master);
pinctrl_pm_select_default_state(dev); pinctrl_pm_select_default_state(dev);
if (!pm_runtime_suspended(dev)) { ret = pm_runtime_force_resume(dev);
ret = clk_prepare_enable(rs->apb_pclk); if (ret < 0)
if (ret < 0) return ret;
return ret;
ret = clk_prepare_enable(rs->spiclk);
if (ret < 0) {
clk_disable_unprepare(rs->apb_pclk);
return ret;
}
}
ret = spi_master_resume(rs->master); ret = spi_master_resume(rs->master);
if (ret < 0) { if (ret < 0) {
...@@ -878,7 +879,7 @@ static int rockchip_spi_resume(struct device *dev) ...@@ -878,7 +879,7 @@ static int rockchip_spi_resume(struct device *dev)
clk_disable_unprepare(rs->apb_pclk); clk_disable_unprepare(rs->apb_pclk);
} }
return ret; return 0;
} }
#endif /* CONFIG_PM_SLEEP */ #endif /* CONFIG_PM_SLEEP */
...@@ -901,14 +902,14 @@ static int rockchip_spi_runtime_resume(struct device *dev) ...@@ -901,14 +902,14 @@ static int rockchip_spi_runtime_resume(struct device *dev)
struct rockchip_spi *rs = spi_master_get_devdata(master); struct rockchip_spi *rs = spi_master_get_devdata(master);
ret = clk_prepare_enable(rs->apb_pclk); ret = clk_prepare_enable(rs->apb_pclk);
if (ret) if (ret < 0)
return ret; return ret;
ret = clk_prepare_enable(rs->spiclk); ret = clk_prepare_enable(rs->spiclk);
if (ret) if (ret < 0)
clk_disable_unprepare(rs->apb_pclk); clk_disable_unprepare(rs->apb_pclk);
return ret; return 0;
} }
#endif /* CONFIG_PM */ #endif /* CONFIG_PM */
...@@ -919,6 +920,7 @@ static const struct dev_pm_ops rockchip_spi_pm = { ...@@ -919,6 +920,7 @@ static const struct dev_pm_ops rockchip_spi_pm = {
}; };
static const struct of_device_id rockchip_spi_dt_match[] = { static const struct of_device_id rockchip_spi_dt_match[] = {
{ .compatible = "rockchip,rv1108-spi", },
{ .compatible = "rockchip,rk3036-spi", }, { .compatible = "rockchip,rk3036-spi", },
{ .compatible = "rockchip,rk3066-spi", }, { .compatible = "rockchip,rk3066-spi", },
{ .compatible = "rockchip,rk3188-spi", }, { .compatible = "rockchip,rk3188-spi", },
......
...@@ -446,8 +446,8 @@ static int spi_sh_probe(struct platform_device *pdev) ...@@ -446,8 +446,8 @@ static int spi_sh_probe(struct platform_device *pdev)
irq = platform_get_irq(pdev, 0); irq = platform_get_irq(pdev, 0);
if (irq < 0) { if (irq < 0) {
dev_err(&pdev->dev, "platform_get_irq error\n"); dev_err(&pdev->dev, "platform_get_irq error: %d\n", irq);
return -ENODEV; return irq;
} }
master = spi_alloc_master(&pdev->dev, sizeof(struct spi_sh_data)); master = spi_alloc_master(&pdev->dev, sizeof(struct spi_sh_data));
......
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