drivers/spi/spi-rockchip.c

   1 /*
   2  * Copyright (c) 2014, Fuzhou Rockchip Electronics Co., Ltd
   3  * Author: Addy Ke <addy.ke@rock-chips.com>
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms and conditions of the GNU General Public License,
   7  * version 2, as published by the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  12  * more details.
  13  *
  14  */
  15
  16 #include <linux/init.h>
  17 #include <linux/module.h>
  18 #include <linux/clk.h>
  19 #include <linux/err.h>
  20 #include <linux/delay.h>
  21 #include <linux/interrupt.h>
  22 #include <linux/platform_device.h>
  23 #include <linux/slab.h>
  24 #include <linux/spi/spi.h>
  25 #include <linux/scatterlist.h>
  26 #include <linux/of.h>
  27 #include <linux/pm_runtime.h>
  28 #include <linux/io.h>
  29 #include <linux/dmaengine.h>
  30
  31 #define DRIVER_NAME "rockchip-spi"
  32
  33 /* SPI register offsets */
  34 #define ROCKCHIP_SPI_CTRLR0                     0x0000
  35 #define ROCKCHIP_SPI_CTRLR1                     0x0004
  36 #define ROCKCHIP_SPI_SSIENR                     0x0008
  37 #define ROCKCHIP_SPI_SER                        0x000c
  38 #define ROCKCHIP_SPI_BAUDR                      0x0010
  39 #define ROCKCHIP_SPI_TXFTLR                     0x0014
  40 #define ROCKCHIP_SPI_RXFTLR                     0x0018
  41 #define ROCKCHIP_SPI_TXFLR                      0x001c
  42 #define ROCKCHIP_SPI_RXFLR                      0x0020
  43 #define ROCKCHIP_SPI_SR                         0x0024
  44 #define ROCKCHIP_SPI_IPR                        0x0028
  45 #define ROCKCHIP_SPI_IMR                        0x002c
  46 #define ROCKCHIP_SPI_ISR                        0x0030
  47 #define ROCKCHIP_SPI_RISR                       0x0034
  48 #define ROCKCHIP_SPI_ICR                        0x0038
  49 #define ROCKCHIP_SPI_DMACR                      0x003c
  50 #define ROCKCHIP_SPI_DMATDLR            0x0040
  51 #define ROCKCHIP_SPI_DMARDLR            0x0044
  52 #define ROCKCHIP_SPI_TXDR                       0x0400
  53 #define ROCKCHIP_SPI_RXDR                       0x0800
  54
  55 /* Bit fields in CTRLR0 */
  56 #define CR0_DFS_OFFSET                          0
  57
  58 #define CR0_CFS_OFFSET                          2
  59
  60 #define CR0_SCPH_OFFSET                         6
  61
  62 #define CR0_SCPOL_OFFSET                        7
  63
  64 #define CR0_CSM_OFFSET                          8
  65 #define CR0_CSM_KEEP                            0x0
  66 /* ss_n be high for half sclk_out cycles */
  67 #define CR0_CSM_HALF                            0X1
  68 /* ss_n be high for one sclk_out cycle */
  69 #define CR0_CSM_ONE                                     0x2
  70
  71 /* ss_n to sclk_out delay */
  72 #define CR0_SSD_OFFSET                          10
  73 /*
  74  * The period between ss_n active and
  75  * sclk_out active is half sclk_out cycles
  76  */
  77 #define CR0_SSD_HALF                            0x0
  78 /*
  79  * The period between ss_n active and
  80  * sclk_out active is one sclk_out cycle
  81  */
  82 #define CR0_SSD_ONE                                     0x1
  83
  84 #define CR0_EM_OFFSET                           11
  85 #define CR0_EM_LITTLE                           0x0
  86 #define CR0_EM_BIG                                      0x1
  87
  88 #define CR0_FBM_OFFSET                          12
  89 #define CR0_FBM_MSB                                     0x0
  90 #define CR0_FBM_LSB                                     0x1
  91
  92 #define CR0_BHT_OFFSET                          13
  93 #define CR0_BHT_16BIT                           0x0
  94 #define CR0_BHT_8BIT                            0x1
  95
  96 #define CR0_RSD_OFFSET                          14
  97
  98 #define CR0_FRF_OFFSET                          16
  99 #define CR0_FRF_SPI                                     0x0
 100 #define CR0_FRF_SSP                                     0x1
 101 #define CR0_FRF_MICROWIRE                       0x2
 102
 103 #define CR0_XFM_OFFSET                          18
 104 #define CR0_XFM_MASK                            (0x03 << SPI_XFM_OFFSET)
 105 #define CR0_XFM_TR                                      0x0
 106 #define CR0_XFM_TO                                      0x1
 107 #define CR0_XFM_RO                                      0x2
 108
 109 #define CR0_OPM_OFFSET                          20
 110 #define CR0_OPM_MASTER                          0x0
 111 #define CR0_OPM_SLAVE                           0x1
 112
 113 #define CR0_MTM_OFFSET                          0x21
 114
 115 /* Bit fields in SER, 2bit */
 116 #define SER_MASK                                        0x3
 117
 118 /* Bit fields in SR, 5bit */
 119 #define SR_MASK                                         0x1f
 120 #define SR_BUSY                                         (1 << 0)
 121 #define SR_TF_FULL                                      (1 << 1)
 122 #define SR_TF_EMPTY                                     (1 << 2)
 123 #define SR_RF_EMPTY                                     (1 << 3)
 124 #define SR_RF_FULL                                      (1 << 4)
 125
 126 /* Bit fields in ISR, IMR, ISR, RISR, 5bit */
 127 #define INT_MASK                                        0x1f
 128 #define INT_TF_EMPTY                            (1 << 0)
 129 #define INT_TF_OVERFLOW                         (1 << 1)
 130 #define INT_RF_UNDERFLOW                        (1 << 2)
 131 #define INT_RF_OVERFLOW                         (1 << 3)
 132 #define INT_RF_FULL                                     (1 << 4)
 133
 134 /* Bit fields in ICR, 4bit */
 135 #define ICR_MASK                                        0x0f
 136 #define ICR_ALL                                         (1 << 0)
 137 #define ICR_RF_UNDERFLOW                        (1 << 1)
 138 #define ICR_RF_OVERFLOW                         (1 << 2)
 139 #define ICR_TF_OVERFLOW                         (1 << 3)
 140
 141 /* Bit fields in DMACR */
 142 #define RF_DMA_EN                                       (1 << 0)
 143 #define TF_DMA_EN                                       (1 << 1)
 144
 145 #define RXBUSY                                          (1 << 0)
 146 #define TXBUSY                                          (1 << 1)
 147
 148 enum rockchip_ssi_type {
 149         SSI_MOTO_SPI = 0,
 150         SSI_TI_SSP,
 151         SSI_NS_MICROWIRE,
 152 };
 153
 154 struct rockchip_spi_dma_data {
 155         struct dma_chan *ch;
 156         enum dma_transfer_direction direction;
 157         dma_addr_t addr;
 158 };
 159
 160 struct rockchip_spi {
 161         struct device *dev;
 162         struct spi_master *master;
 163
 164         struct clk *spiclk;
 165         struct clk *apb_pclk;
 166
 167         void __iomem *regs;
 168         /*depth of the FIFO buffer */
 169         u32 fifo_len;
 170         /* max bus freq supported */
 171         u32 max_freq;
 172         /* supported slave numbers */
 173         enum rockchip_ssi_type type;
 174
 175         u16 mode;
 176         u8 tmode;
 177         u8 bpw;
 178         u8 n_bytes;
 179         unsigned len;
 180         u32 speed;
 181
 182         const void *tx;
 183         const void *tx_end;
 184         void *rx;
 185         void *rx_end;
 186
 187         u32 state;
 188         /* protect state */
 189         spinlock_t lock;
 190
 191         struct completion xfer_completion;
 192
 193         u32 use_dma;
 194         struct sg_table tx_sg;
 195         struct sg_table rx_sg;
 196         struct rockchip_spi_dma_data dma_rx;
 197         struct rockchip_spi_dma_data dma_tx;
 198 };
 199
 200 static inline void spi_enable_chip(struct rockchip_spi *rs, int enable)
 201 {
 202         writel_relaxed((enable ? 1 : 0), rs->regs + ROCKCHIP_SPI_SSIENR);
 203 }
 204
 205 static inline void spi_set_clk(struct rockchip_spi *rs, u16 div)
 206 {
 207         writel_relaxed(div, rs->regs + ROCKCHIP_SPI_BAUDR);
 208 }
 209
 210 static inline void flush_fifo(struct rockchip_spi *rs)
 211 {
 212         while (readl_relaxed(rs->regs + ROCKCHIP_SPI_RXFLR))
 213                 readl_relaxed(rs->regs + ROCKCHIP_SPI_RXDR);
 214 }
 215
 216 static inline void wait_for_idle(struct rockchip_spi *rs)
 217 {
 218         unsigned long timeout = jiffies + msecs_to_jiffies(5);
 219
 220         do {
 221                 if (!(readl_relaxed(rs->regs + ROCKCHIP_SPI_SR) & SR_BUSY))
 222                         return;
 223         } while (!time_after(jiffies, timeout));
 224
 225         dev_warn(rs->dev, "spi controller is in busy state!\n");
 226 }
 227
 228 static u32 get_fifo_len(struct rockchip_spi *rs)
 229 {
 230         u32 fifo;
 231
 232         for (fifo = 2; fifo < 32; fifo++) {
 233                 writel_relaxed(fifo, rs->regs + ROCKCHIP_SPI_TXFTLR);
 234                 if (fifo != readl_relaxed(rs->regs + ROCKCHIP_SPI_TXFTLR))
 235                         break;
 236         }
 237
 238         writel_relaxed(0, rs->regs + ROCKCHIP_SPI_TXFTLR);
 239
 240         return (fifo == 31) ? 0 : fifo;
 241 }
 242
 243 static inline u32 tx_max(struct rockchip_spi *rs)
 244 {
 245         u32 tx_left, tx_room;
 246
 247         tx_left = (rs->tx_end - rs->tx) / rs->n_bytes;
 248         tx_room = rs->fifo_len - readl_relaxed(rs->regs + ROCKCHIP_SPI_TXFLR);
 249
 250         return min(tx_left, tx_room);
 251 }
 252
 253 static inline u32 rx_max(struct rockchip_spi *rs)
 254 {
 255         u32 rx_left = (rs->rx_end - rs->rx) / rs->n_bytes;
 256         u32 rx_room = (u32)readl_relaxed(rs->regs + ROCKCHIP_SPI_RXFLR);
 257
 258         return min(rx_left, rx_room);
 259 }
 260
 261 static void rockchip_spi_set_cs(struct spi_device *spi, bool enable)
 262 {
 263         u32 ser;
 264         struct rockchip_spi *rs = spi_master_get_devdata(spi->master);
 265
 266         ser = readl_relaxed(rs->regs + ROCKCHIP_SPI_SER) & SER_MASK;
 267
 268         /*
 269          * drivers/spi/spi.c:
 270          * static void spi_set_cs(struct spi_device *spi, bool enable)
 271          * {
 272          *              if (spi->mode & SPI_CS_HIGH)
 273          *                      enable = !enable;
 274          *
 275          *              if (spi->cs_gpio >= 0)
 276          *                      gpio_set_value(spi->cs_gpio, !enable);
 277          *              else if (spi->master->set_cs)
 278          *              spi->master->set_cs(spi, !enable);
 279          * }
 280          *
 281          * Note: enable(rockchip_spi_set_cs) = !enable(spi_set_cs)
 282          */
 283         if (!enable)
 284                 ser |= 1 << spi->chip_select;
 285         else
 286                 ser &= ~(1 << spi->chip_select);
 287
 288         writel_relaxed(ser, rs->regs + ROCKCHIP_SPI_SER);
 289 }
 290
 291 static int rockchip_spi_prepare_message(struct spi_master *master,
 292                                         struct spi_message *msg)
 293 {
 294         struct rockchip_spi *rs = spi_master_get_devdata(master);
 295         struct spi_device *spi = msg->spi;
 296
 297         rs->mode = spi->mode;
 298
 299         return 0;
 300 }
 301
 302 static int rockchip_spi_unprepare_message(struct spi_master *master,
 303                                           struct spi_message *msg)
 304 {
 305         unsigned long flags;
 306         struct rockchip_spi *rs = spi_master_get_devdata(master);
 307
 308         spin_lock_irqsave(&rs->lock, flags);
 309
 310         /*
 311          * For DMA mode, we need terminate DMA channel and flush
 312          * fifo for the next transfer if DMA thansfer timeout.
 313          * unprepare_message() was called by core if transfer complete
 314          * or timeout. Maybe it is reasonable for error handling here.
 315          */
 316         if (rs->use_dma) {
 317                 if (rs->state & RXBUSY) {
 318                         dmaengine_terminate_all(rs->dma_rx.ch);
 319                         flush_fifo(rs);
 320                 }
 321
 322                 if (rs->state & TXBUSY)
 323                         dmaengine_terminate_all(rs->dma_tx.ch);
 324         }
 325
 326         spin_unlock_irqrestore(&rs->lock, flags);
 327
 328         return 0;
 329 }
 330
 331 static void rockchip_spi_pio_writer(struct rockchip_spi *rs)
 332 {
 333         u32 max = tx_max(rs);
 334         u32 txw = 0;
 335
 336         while (max--) {
 337                 if (rs->n_bytes == 1)
 338                         txw = *(u8 *)(rs->tx);
 339                 else
 340                         txw = *(u16 *)(rs->tx);
 341
 342                 writel_relaxed(txw, rs->regs + ROCKCHIP_SPI_TXDR);
 343                 rs->tx += rs->n_bytes;
 344         }
 345 }
 346
 347 static void rockchip_spi_pio_reader(struct rockchip_spi *rs)
 348 {
 349         u32 max = rx_max(rs);
 350         u32 rxw;
 351
 352         while (max--) {
 353                 rxw = readl_relaxed(rs->regs + ROCKCHIP_SPI_RXDR);
 354                 if (rs->n_bytes == 1)
 355                         *(u8 *)(rs->rx) = (u8)rxw;
 356                 else
 357                         *(u16 *)(rs->rx) = (u16)rxw;
 358                 rs->rx += rs->n_bytes;
 359         }
 360 }
 361
 362 static int rockchip_spi_pio_transfer(struct rockchip_spi *rs)
 363 {
 364         int remain = 0;
 365
 366         do {
 367                 if (rs->tx) {
 368                         remain = rs->tx_end - rs->tx;
 369                         rockchip_spi_pio_writer(rs);
 370                 }
 371
 372                 if (rs->rx) {
 373                         remain = rs->rx_end - rs->rx;
 374                         rockchip_spi_pio_reader(rs);
 375                 }
 376
 377                 cpu_relax();
 378         } while (remain);
 379
 380         /* If tx, wait until the FIFO data completely. */
 381         if (rs->tx)
 382                 wait_for_idle(rs);
 383
 384         return 0;
 385 }
 386
 387 static void rockchip_spi_dma_rxcb(void *data)
 388 {
 389         unsigned long flags;
 390         struct rockchip_spi *rs = data;
 391
 392         spin_lock_irqsave(&rs->lock, flags);
 393
 394         rs->state &= ~RXBUSY;
 395         if (!(rs->state & TXBUSY))
 396                 spi_finalize_current_transfer(rs->master);
 397
 398         spin_unlock_irqrestore(&rs->lock, flags);
 399 }
 400
 401 static void rockchip_spi_dma_txcb(void *data)
 402 {
 403         unsigned long flags;
 404         struct rockchip_spi *rs = data;
 405
 406         /* Wait until the FIFO data completely. */
 407         wait_for_idle(rs);
 408
 409         spin_lock_irqsave(&rs->lock, flags);
 410
 411         rs->state &= ~TXBUSY;
 412         if (!(rs->state & RXBUSY))
 413                 spi_finalize_current_transfer(rs->master);
 414
 415         spin_unlock_irqrestore(&rs->lock, flags);
 416 }
 417
 418 static int rockchip_spi_dma_transfer(struct rockchip_spi *rs)
 419 {
 420         unsigned long flags;
 421         struct dma_slave_config rxconf, txconf;
 422         struct dma_async_tx_descriptor *rxdesc, *txdesc;
 423
 424         spin_lock_irqsave(&rs->lock, flags);
 425         rs->state &= ~RXBUSY;
 426         rs->state &= ~TXBUSY;
 427         spin_unlock_irqrestore(&rs->lock, flags);
 428
 429         if (rs->rx) {
 430                 rxconf.direction = rs->dma_rx.direction;
 431                 rxconf.src_addr = rs->dma_rx.addr;
 432                 rxconf.src_addr_width = rs->n_bytes;
 433                 rxconf.src_maxburst = rs->n_bytes;
 434                 dmaengine_slave_config(rs->dma_rx.ch, &rxconf);
 435
 436                 rxdesc = dmaengine_prep_slave_sg(
 437                                 rs->dma_rx.ch,
 438                                 rs->rx_sg.sgl, rs->rx_sg.nents,
 439                                 rs->dma_rx.direction, DMA_PREP_INTERRUPT);
 440
 441                 rxdesc->callback = rockchip_spi_dma_rxcb;
 442                 rxdesc->callback_param = rs;
 443         }
 444
 445         if (rs->tx) {
 446                 txconf.direction = rs->dma_tx.direction;
 447                 txconf.dst_addr = rs->dma_tx.addr;
 448                 txconf.dst_addr_width = rs->n_bytes;
 449                 txconf.dst_maxburst = rs->n_bytes;
 450                 dmaengine_slave_config(rs->dma_tx.ch, &txconf);
 451
 452                 txdesc = dmaengine_prep_slave_sg(
 453                                 rs->dma_tx.ch,
 454                                 rs->tx_sg.sgl, rs->tx_sg.nents,
 455                                 rs->dma_tx.direction, DMA_PREP_INTERRUPT);
 456
 457                 txdesc->callback = rockchip_spi_dma_txcb;
 458                 txdesc->callback_param = rs;
 459         }
 460
 461         /* rx must be started before tx due to spi instinct */
 462         if (rs->rx) {
 463                 spin_lock_irqsave(&rs->lock, flags);
 464                 rs->state |= RXBUSY;
 465                 spin_unlock_irqrestore(&rs->lock, flags);
 466                 dmaengine_submit(rxdesc);
 467                 dma_async_issue_pending(rs->dma_rx.ch);
 468         }
 469
 470         if (rs->tx) {
 471                 spin_lock_irqsave(&rs->lock, flags);
 472                 rs->state |= TXBUSY;
 473                 spin_unlock_irqrestore(&rs->lock, flags);
 474                 dmaengine_submit(txdesc);
 475                 dma_async_issue_pending(rs->dma_tx.ch);
 476         }
 477
 478         return 1;
 479 }
 480
 481 static void rockchip_spi_config(struct rockchip_spi *rs)
 482 {
 483         u32 div = 0;
 484         u32 dmacr = 0;
 485
 486         u32 cr0 = (CR0_BHT_8BIT << CR0_BHT_OFFSET)
 487                 | (CR0_SSD_ONE << CR0_SSD_OFFSET);
 488
 489         cr0 |= (rs->n_bytes << CR0_DFS_OFFSET);
 490         cr0 |= ((rs->mode & 0x3) << CR0_SCPH_OFFSET);
 491         cr0 |= (rs->tmode << CR0_XFM_OFFSET);
 492         cr0 |= (rs->type << CR0_FRF_OFFSET);
 493
 494         if (rs->use_dma) {
 495                 if (rs->tx)
 496                         dmacr |= TF_DMA_EN;
 497                 if (rs->rx)
 498                         dmacr |= RF_DMA_EN;
 499         }
 500
 501         /* div doesn't support odd number */
 502         div = max_t(u32, rs->max_freq / rs->speed, 1);
 503         div = (div + 1) & 0xfffe;
 504
 505         spi_enable_chip(rs, 0);
 506
 507         writel_relaxed(cr0, rs->regs + ROCKCHIP_SPI_CTRLR0);
 508
 509         writel_relaxed(rs->len - 1, rs->regs + ROCKCHIP_SPI_CTRLR1);
 510         writel_relaxed(rs->fifo_len / 2 - 1, rs->regs + ROCKCHIP_SPI_TXFTLR);
 511         writel_relaxed(rs->fifo_len / 2 - 1, rs->regs + ROCKCHIP_SPI_RXFTLR);
 512
 513         writel_relaxed(0, rs->regs + ROCKCHIP_SPI_DMATDLR);
 514         writel_relaxed(0, rs->regs + ROCKCHIP_SPI_DMARDLR);
 515         writel_relaxed(dmacr, rs->regs + ROCKCHIP_SPI_DMACR);
 516
 517         spi_set_clk(rs, div);
 518
 519         dev_dbg(rs->dev, "cr0 0x%x, div %d\n", cr0, div);
 520
 521         spi_enable_chip(rs, 1);
 522 }
 523
 524 static int rockchip_spi_transfer_one(
 525                 struct spi_master *master,
 526                 struct spi_device *spi,
 527                 struct spi_transfer *xfer)
 528 {
 529         int ret = 0;
 530         struct rockchip_spi *rs = spi_master_get_devdata(master);
 531
 532         WARN_ON(readl_relaxed(rs->regs + ROCKCHIP_SPI_SSIENR) &&
 533                 (readl_relaxed(rs->regs + ROCKCHIP_SPI_SR) & SR_BUSY));
 534
 535         if (!xfer->tx_buf && !xfer->rx_buf) {
 536                 dev_err(rs->dev, "No buffer for transfer\n");
 537                 return -EINVAL;
 538         }
 539
 540         rs->speed = xfer->speed_hz;
 541         rs->bpw = xfer->bits_per_word;
 542         rs->n_bytes = rs->bpw >> 3;
 543
 544         rs->tx = xfer->tx_buf;
 545         rs->tx_end = rs->tx + xfer->len;
 546         rs->rx = xfer->rx_buf;
 547         rs->rx_end = rs->rx + xfer->len;
 548         rs->len = xfer->len;
 549
 550         rs->tx_sg = xfer->tx_sg;
 551         rs->rx_sg = xfer->rx_sg;
 552
 553         if (rs->tx && rs->rx)
 554                 rs->tmode = CR0_XFM_TR;
 555         else if (rs->tx)
 556                 rs->tmode = CR0_XFM_TO;
 557         else if (rs->rx)
 558                 rs->tmode = CR0_XFM_RO;
 559
 560         if (master->can_dma && master->can_dma(master, spi, xfer))
 561                 rs->use_dma = 1;
 562         else
 563                 rs->use_dma = 0;
 564
 565         rockchip_spi_config(rs);
 566
 567         if (rs->use_dma)
 568                 ret = rockchip_spi_dma_transfer(rs);
 569         else
 570                 ret = rockchip_spi_pio_transfer(rs);
 571
 572         return ret;
 573 }
 574
 575 static bool rockchip_spi_can_dma(struct spi_master *master,
 576                                  struct spi_device *spi,
 577                                  struct spi_transfer *xfer)
 578 {
 579         struct rockchip_spi *rs = spi_master_get_devdata(master);
 580
 581         return (xfer->len > rs->fifo_len);
 582 }
 583
 584 static int rockchip_spi_probe(struct platform_device *pdev)
 585 {
 586         int ret = 0;
 587         struct rockchip_spi *rs;
 588         struct spi_master *master;
 589         struct resource *mem;
 590
 591         master = spi_alloc_master(&pdev->dev, sizeof(struct rockchip_spi));
 592         if (!master)
 593                 return -ENOMEM;
 594
 595         platform_set_drvdata(pdev, master);
 596
 597         rs = spi_master_get_devdata(master);
 598         memset(rs, 0, sizeof(struct rockchip_spi));
 599
 600         /* Get basic io resource and map it */
 601         mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 602         rs->regs = devm_ioremap_resource(&pdev->dev, mem);
 603         if (IS_ERR(rs->regs)) {
 604                 ret =  PTR_ERR(rs->regs);
 605                 goto err_ioremap_resource;
 606         }
 607
 608         rs->apb_pclk = devm_clk_get(&pdev->dev, "apb_pclk");
 609         if (IS_ERR(rs->apb_pclk)) {
 610                 dev_err(&pdev->dev, "Failed to get apb_pclk\n");
 611                 ret = PTR_ERR(rs->apb_pclk);
 612                 goto err_ioremap_resource;
 613         }
 614
 615         rs->spiclk = devm_clk_get(&pdev->dev, "spiclk");
 616         if (IS_ERR(rs->spiclk)) {
 617                 dev_err(&pdev->dev, "Failed to get spi_pclk\n");
 618                 ret = PTR_ERR(rs->spiclk);
 619                 goto err_ioremap_resource;
 620         }
 621
 622         ret = clk_prepare_enable(rs->apb_pclk);
 623         if (ret) {
 624                 dev_err(&pdev->dev, "Failed to enable apb_pclk\n");
 625                 goto err_ioremap_resource;
 626         }
 627
 628         ret = clk_prepare_enable(rs->spiclk);
 629         if (ret) {
 630                 dev_err(&pdev->dev, "Failed to enable spi_clk\n");
 631                 goto err_spiclk_enable;
 632         }
 633
 634         spi_enable_chip(rs, 0);
 635
 636         rs->type = SSI_MOTO_SPI;
 637         rs->master = master;
 638         rs->dev = &pdev->dev;
 639         rs->max_freq = clk_get_rate(rs->spiclk);
 640
 641         rs->fifo_len = get_fifo_len(rs);
 642         if (!rs->fifo_len) {
 643                 dev_err(&pdev->dev, "Failed to get fifo length\n");
 644                 ret = -EINVAL;
 645                 goto err_get_fifo_len;
 646         }
 647
 648         spin_lock_init(&rs->lock);
 649
 650         pm_runtime_set_active(&pdev->dev);
 651         pm_runtime_enable(&pdev->dev);
 652
 653         master->auto_runtime_pm = true;
 654         master->bus_num = pdev->id;
 655         master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_LOOP;
 656         master->num_chipselect = 2;
 657         master->dev.of_node = pdev->dev.of_node;
 658         master->bits_per_word_mask = SPI_BPW_MASK(16) | SPI_BPW_MASK(8);
 659
 660         master->set_cs = rockchip_spi_set_cs;
 661         master->prepare_message = rockchip_spi_prepare_message;
 662         master->unprepare_message = rockchip_spi_unprepare_message;
 663         master->transfer_one = rockchip_spi_transfer_one;
 664
 665         rs->dma_tx.ch = dma_request_slave_channel(rs->dev, "tx");
 666         if (!rs->dma_tx.ch)
 667                 dev_warn(rs->dev, "Failed to request TX DMA channel\n");
 668
 669         rs->dma_rx.ch = dma_request_slave_channel(rs->dev, "rx");
 670         if (!rs->dma_rx.ch) {
 671                 if (rs->dma_tx.ch) {
 672                         dma_release_channel(rs->dma_tx.ch);
 673                         rs->dma_tx.ch = NULL;
 674                 }
 675                 dev_warn(rs->dev, "Failed to request RX DMA channel\n");
 676         }
 677
 678         if (rs->dma_tx.ch && rs->dma_rx.ch) {
 679                 rs->dma_tx.addr = (dma_addr_t)(mem->start + ROCKCHIP_SPI_TXDR);
 680                 rs->dma_rx.addr = (dma_addr_t)(mem->start + ROCKCHIP_SPI_RXDR);
 681                 rs->dma_tx.direction = DMA_MEM_TO_DEV;
 682                 rs->dma_rx.direction = DMA_DEV_TO_MEM;
 683
 684                 master->can_dma = rockchip_spi_can_dma;
 685                 master->dma_tx = rs->dma_tx.ch;
 686                 master->dma_rx = rs->dma_rx.ch;
 687         }
 688
 689         ret = devm_spi_register_master(&pdev->dev, master);
 690         if (ret) {
 691                 dev_err(&pdev->dev, "Failed to register master\n");
 692                 goto err_register_master;
 693         }
 694
 695         return 0;
 696
 697 err_register_master:
 698         if (rs->dma_tx.ch)
 699                 dma_release_channel(rs->dma_tx.ch);
 700         if (rs->dma_rx.ch)
 701                 dma_release_channel(rs->dma_rx.ch);
 702 err_get_fifo_len:
 703         clk_disable_unprepare(rs->spiclk);
 704 err_spiclk_enable:
 705         clk_disable_unprepare(rs->apb_pclk);
 706 err_ioremap_resource:
 707         spi_master_put(master);
 708
 709         return ret;
 710 }
 711
 712 static int rockchip_spi_remove(struct platform_device *pdev)
 713 {
 714         struct spi_master *master = spi_master_get(platform_get_drvdata(pdev));
 715         struct rockchip_spi *rs = spi_master_get_devdata(master);
 716
 717         pm_runtime_disable(&pdev->dev);
 718
 719         clk_disable_unprepare(rs->spiclk);
 720         clk_disable_unprepare(rs->apb_pclk);
 721
 722         if (rs->dma_tx.ch)
 723                 dma_release_channel(rs->dma_tx.ch);
 724         if (rs->dma_rx.ch)
 725                 dma_release_channel(rs->dma_rx.ch);
 726
 727         spi_master_put(master);
 728
 729         return 0;
 730 }
 731
 732 #ifdef CONFIG_PM_SLEEP
 733 static int rockchip_spi_suspend(struct device *dev)
 734 {
 735         int ret = 0;
 736         struct spi_master *master = dev_get_drvdata(dev);
 737         struct rockchip_spi *rs = spi_master_get_devdata(master);
 738
 739         ret = spi_master_suspend(rs->master);
 740         if (ret)
 741                 return ret;
 742
 743         if (!pm_runtime_suspended(dev)) {
 744                 clk_disable_unprepare(rs->spiclk);
 745                 clk_disable_unprepare(rs->apb_pclk);
 746         }
 747
 748         return ret;
 749 }
 750
 751 static int rockchip_spi_resume(struct device *dev)
 752 {
 753         int ret = 0;
 754         struct spi_master *master = dev_get_drvdata(dev);
 755         struct rockchip_spi *rs = spi_master_get_devdata(master);
 756
 757         if (!pm_runtime_suspended(dev)) {
 758                 ret = clk_prepare_enable(rs->apb_pclk);
 759                 if (ret < 0)
 760                         return ret;
 761
 762                 ret = clk_prepare_enable(rs->spiclk);
 763                 if (ret < 0) {
 764                         clk_disable_unprepare(rs->apb_pclk);
 765                         return ret;
 766                 }
 767         }
 768
 769         ret = spi_master_resume(rs->master);
 770         if (ret < 0) {
 771                 clk_disable_unprepare(rs->spiclk);
 772                 clk_disable_unprepare(rs->apb_pclk);
 773         }
 774
 775         return ret;
 776 }
 777 #endif /* CONFIG_PM_SLEEP */
 778
 779 #ifdef CONFIG_PM_RUNTIME
 780 static int rockchip_spi_runtime_suspend(struct device *dev)
 781 {
 782         struct spi_master *master = dev_get_drvdata(dev);
 783         struct rockchip_spi *rs = spi_master_get_devdata(master);
 784
 785         clk_disable_unprepare(rs->spiclk);
 786         clk_disable_unprepare(rs->apb_pclk);
 787
 788         return 0;
 789 }
 790
 791 static int rockchip_spi_runtime_resume(struct device *dev)
 792 {
 793         int ret;
 794         struct spi_master *master = dev_get_drvdata(dev);
 795         struct rockchip_spi *rs = spi_master_get_devdata(master);
 796
 797         ret = clk_prepare_enable(rs->apb_pclk);
 798         if (ret)
 799                 return ret;
 800
 801         ret = clk_prepare_enable(rs->spiclk);
 802         if (ret)
 803                 clk_disable_unprepare(rs->apb_pclk);
 804
 805         return ret;
 806 }
 807 #endif /* CONFIG_PM_RUNTIME */
 808
 809 static const struct dev_pm_ops rockchip_spi_pm = {
 810         SET_SYSTEM_SLEEP_PM_OPS(rockchip_spi_suspend, rockchip_spi_resume)
 811         SET_RUNTIME_PM_OPS(rockchip_spi_runtime_suspend,
 812                            rockchip_spi_runtime_resume, NULL)
 813 };
 814
 815 static const struct of_device_id rockchip_spi_dt_match[] = {
 816         { .compatible = "rockchip,rk3066-spi", },
 817         { .compatible = "rockchip,rk3188-spi", },
 818         { .compatible = "rockchip,rk3288-spi", },
 819         { },
 820 };
 821 MODULE_DEVICE_TABLE(of, rockchip_spi_dt_match);
 822
 823 static struct platform_driver rockchip_spi_driver = {
 824         .driver = {
 825                 .name   = DRIVER_NAME,
 826                 .owner = THIS_MODULE,
 827                 .pm = &rockchip_spi_pm,
 828                 .of_match_table = of_match_ptr(rockchip_spi_dt_match),
 829         },
 830         .probe = rockchip_spi_probe,
 831         .remove = rockchip_spi_remove,
 832 };
 833
 834 module_platform_driver(rockchip_spi_driver);
 835
 836 MODULE_AUTHOR("Addy Ke <addy.ke@rock-chips.com>");
 837 MODULE_DESCRIPTION("ROCKCHIP SPI Controller Driver");
 838 MODULE_LICENSE("GPL v2");