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/clk.h>
  17 #include <linux/dmaengine.h>
  18 #include <linux/module.h>
  19 #include <linux/of.h>
  20 #include <linux/pinctrl/consumer.h>
  21 #include <linux/platform_device.h>
  22 #include <linux/spi/spi.h>
  23 #include <linux/pm_runtime.h>
  24 #include <linux/scatterlist.h>
  25
  26 #define DRIVER_NAME "rockchip-spi"
  27
  28 #define ROCKCHIP_SPI_CLR_BITS(reg, bits) \
  29                 writel_relaxed(readl_relaxed(reg) & ~(bits), reg)
  30 #define ROCKCHIP_SPI_SET_BITS(reg, bits) \
  31                 writel_relaxed(readl_relaxed(reg) | (bits), reg)
  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 /* sclk_out: spi master internal logic in rk3x can support 50Mhz */
 149 #define MAX_SCLK_OUT            50000000
 150
 151 /*
 152  * SPI_CTRLR1 is 16-bits, so we should support lengths of 0xffff + 1. However,
 153  * the controller seems to hang when given 0x10000, so stick with this for now.
 154  */
 155 #define ROCKCHIP_SPI_MAX_TRANLEN                0xffff
 156
 157 #define ROCKCHIP_SPI_MAX_CS_NUM                 2
 158
 159 enum rockchip_ssi_type {
 160         SSI_MOTO_SPI = 0,
 161         SSI_TI_SSP,
 162         SSI_NS_MICROWIRE,
 163 };
 164
 165 struct rockchip_spi_dma_data {
 166         struct dma_chan *ch;
 167         enum dma_transfer_direction direction;
 168         dma_addr_t addr;
 169 };
 170
 171 struct rockchip_spi {
 172         struct device *dev;
 173         struct spi_master *master;
 174
 175         struct clk *spiclk;
 176         struct clk *apb_pclk;
 177
 178         void __iomem *regs;
 179         /*depth of the FIFO buffer */
 180         u32 fifo_len;
 181         /* max bus freq supported */
 182         u32 max_freq;
 183         /* supported slave numbers */
 184         enum rockchip_ssi_type type;
 185
 186         u16 mode;
 187         u8 tmode;
 188         u8 bpw;
 189         u8 n_bytes;
 190         u32 rsd_nsecs;
 191         unsigned len;
 192         u32 speed;
 193
 194         const void *tx;
 195         const void *tx_end;
 196         void *rx;
 197         void *rx_end;
 198
 199         u32 state;
 200         /* protect state */
 201         spinlock_t lock;
 202
 203         bool cs_asserted[ROCKCHIP_SPI_MAX_CS_NUM];
 204
 205         u32 use_dma;
 206         struct sg_table tx_sg;
 207         struct sg_table rx_sg;
 208         struct rockchip_spi_dma_data dma_rx;
 209         struct rockchip_spi_dma_data dma_tx;
 210         struct dma_slave_caps dma_caps;
 211 };
 212
 213 static inline void spi_enable_chip(struct rockchip_spi *rs, int enable)
 214 {
 215         writel_relaxed((enable ? 1 : 0), rs->regs + ROCKCHIP_SPI_SSIENR);
 216 }
 217
 218 static inline void spi_set_clk(struct rockchip_spi *rs, u16 div)
 219 {
 220         writel_relaxed(div, rs->regs + ROCKCHIP_SPI_BAUDR);
 221 }
 222
 223 static inline void flush_fifo(struct rockchip_spi *rs)
 224 {
 225         while (readl_relaxed(rs->regs + ROCKCHIP_SPI_RXFLR))
 226                 readl_relaxed(rs->regs + ROCKCHIP_SPI_RXDR);
 227 }
 228
 229 static inline void wait_for_idle(struct rockchip_spi *rs)
 230 {
 231         unsigned long timeout = jiffies + msecs_to_jiffies(5);
 232
 233         do {
 234                 if (!(readl_relaxed(rs->regs + ROCKCHIP_SPI_SR) & SR_BUSY))
 235                         return;
 236         } while (!time_after(jiffies, timeout));
 237
 238         dev_warn(rs->dev, "spi controller is in busy state!\n");
 239 }
 240
 241 static u32 get_fifo_len(struct rockchip_spi *rs)
 242 {
 243         u32 fifo;
 244
 245         for (fifo = 2; fifo < 32; fifo++) {
 246                 writel_relaxed(fifo, rs->regs + ROCKCHIP_SPI_TXFTLR);
 247                 if (fifo != readl_relaxed(rs->regs + ROCKCHIP_SPI_TXFTLR))
 248                         break;
 249         }
 250
 251         writel_relaxed(0, rs->regs + ROCKCHIP_SPI_TXFTLR);
 252
 253         return (fifo == 31) ? 0 : fifo;
 254 }
 255
 256 static inline u32 tx_max(struct rockchip_spi *rs)
 257 {
 258         u32 tx_left, tx_room;
 259
 260         tx_left = (rs->tx_end - rs->tx) / rs->n_bytes;
 261         tx_room = rs->fifo_len - readl_relaxed(rs->regs + ROCKCHIP_SPI_TXFLR);
 262
 263         return min(tx_left, tx_room);
 264 }
 265
 266 static inline u32 rx_max(struct rockchip_spi *rs)
 267 {
 268         u32 rx_left = (rs->rx_end - rs->rx) / rs->n_bytes;
 269         u32 rx_room = (u32)readl_relaxed(rs->regs + ROCKCHIP_SPI_RXFLR);
 270
 271         return min(rx_left, rx_room);
 272 }
 273
 274 static void rockchip_spi_set_cs(struct spi_device *spi, bool enable)
 275 {
 276         struct spi_master *master = spi->master;
 277         struct rockchip_spi *rs = spi_master_get_devdata(master);
 278         bool cs_asserted = !enable;
 279
 280         /* Return immediately for no-op */
 281         if (cs_asserted == rs->cs_asserted[spi->chip_select])
 282                 return;
 283
 284         if (cs_asserted) {
 285                 /* Keep things powered as long as CS is asserted */
 286                 pm_runtime_get_sync(rs->dev);
 287
 288                 ROCKCHIP_SPI_SET_BITS(rs->regs + ROCKCHIP_SPI_SER,
 289                                       BIT(spi->chip_select));
 290         } else {
 291                 ROCKCHIP_SPI_CLR_BITS(rs->regs + ROCKCHIP_SPI_SER,
 292                                       BIT(spi->chip_select));
 293
 294                 /* Drop reference from when we first asserted CS */
 295                 pm_runtime_put(rs->dev);
 296         }
 297
 298         rs->cs_asserted[spi->chip_select] = cs_asserted;
 299 }
 300
 301 static int rockchip_spi_prepare_message(struct spi_master *master,
 302                                         struct spi_message *msg)
 303 {
 304         struct rockchip_spi *rs = spi_master_get_devdata(master);
 305         struct spi_device *spi = msg->spi;
 306
 307         rs->mode = spi->mode;
 308
 309         return 0;
 310 }
 311
 312 static void rockchip_spi_handle_err(struct spi_master *master,
 313                                     struct spi_message *msg)
 314 {
 315         unsigned long flags;
 316         struct rockchip_spi *rs = spi_master_get_devdata(master);
 317
 318         spin_lock_irqsave(&rs->lock, flags);
 319
 320         /*
 321          * For DMA mode, we need terminate DMA channel and flush
 322          * fifo for the next transfer if DMA thansfer timeout.
 323          * handle_err() was called by core if transfer failed.
 324          * Maybe it is reasonable for error handling here.
 325          */
 326         if (rs->use_dma) {
 327                 if (rs->state & RXBUSY) {
 328                         dmaengine_terminate_async(rs->dma_rx.ch);
 329                         flush_fifo(rs);
 330                 }
 331
 332                 if (rs->state & TXBUSY)
 333                         dmaengine_terminate_async(rs->dma_tx.ch);
 334         }
 335
 336         spin_unlock_irqrestore(&rs->lock, flags);
 337 }
 338
 339 static int rockchip_spi_unprepare_message(struct spi_master *master,
 340                                           struct spi_message *msg)
 341 {
 342         struct rockchip_spi *rs = spi_master_get_devdata(master);
 343
 344         spi_enable_chip(rs, 0);
 345
 346         return 0;
 347 }
 348
 349 static void rockchip_spi_pio_writer(struct rockchip_spi *rs)
 350 {
 351         u32 max = tx_max(rs);
 352         u32 txw = 0;
 353
 354         while (max--) {
 355                 if (rs->n_bytes == 1)
 356                         txw = *(u8 *)(rs->tx);
 357                 else
 358                         txw = *(u16 *)(rs->tx);
 359
 360                 writel_relaxed(txw, rs->regs + ROCKCHIP_SPI_TXDR);
 361                 rs->tx += rs->n_bytes;
 362         }
 363 }
 364
 365 static void rockchip_spi_pio_reader(struct rockchip_spi *rs)
 366 {
 367         u32 max = rx_max(rs);
 368         u32 rxw;
 369
 370         while (max--) {
 371                 rxw = readl_relaxed(rs->regs + ROCKCHIP_SPI_RXDR);
 372                 if (rs->n_bytes == 1)
 373                         *(u8 *)(rs->rx) = (u8)rxw;
 374                 else
 375                         *(u16 *)(rs->rx) = (u16)rxw;
 376                 rs->rx += rs->n_bytes;
 377         }
 378 }
 379
 380 static int rockchip_spi_pio_transfer(struct rockchip_spi *rs)
 381 {
 382         int remain = 0;
 383
 384         do {
 385                 if (rs->tx) {
 386                         remain = rs->tx_end - rs->tx;
 387                         rockchip_spi_pio_writer(rs);
 388                 }
 389
 390                 if (rs->rx) {
 391                         remain = rs->rx_end - rs->rx;
 392                         rockchip_spi_pio_reader(rs);
 393                 }
 394
 395                 cpu_relax();
 396         } while (remain);
 397
 398         /* If tx, wait until the FIFO data completely. */
 399         if (rs->tx)
 400                 wait_for_idle(rs);
 401
 402         spi_enable_chip(rs, 0);
 403
 404         return 0;
 405 }
 406
 407 static void rockchip_spi_dma_rxcb(void *data)
 408 {
 409         unsigned long flags;
 410         struct rockchip_spi *rs = data;
 411
 412         spin_lock_irqsave(&rs->lock, flags);
 413
 414         rs->state &= ~RXBUSY;
 415         if (!(rs->state & TXBUSY)) {
 416                 spi_enable_chip(rs, 0);
 417                 spi_finalize_current_transfer(rs->master);
 418         }
 419
 420         spin_unlock_irqrestore(&rs->lock, flags);
 421 }
 422
 423 static void rockchip_spi_dma_txcb(void *data)
 424 {
 425         unsigned long flags;
 426         struct rockchip_spi *rs = data;
 427
 428         /* Wait until the FIFO data completely. */
 429         wait_for_idle(rs);
 430
 431         spin_lock_irqsave(&rs->lock, flags);
 432
 433         rs->state &= ~TXBUSY;
 434         if (!(rs->state & RXBUSY)) {
 435                 spi_enable_chip(rs, 0);
 436                 spi_finalize_current_transfer(rs->master);
 437         }
 438
 439         spin_unlock_irqrestore(&rs->lock, flags);
 440 }
 441
 442 static int rockchip_spi_prepare_dma(struct rockchip_spi *rs)
 443 {
 444         unsigned long flags;
 445         struct dma_slave_config rxconf, txconf;
 446         struct dma_async_tx_descriptor *rxdesc, *txdesc;
 447
 448         spin_lock_irqsave(&rs->lock, flags);
 449         rs->state &= ~RXBUSY;
 450         rs->state &= ~TXBUSY;
 451         spin_unlock_irqrestore(&rs->lock, flags);
 452
 453         rxdesc = NULL;
 454         if (rs->rx) {
 455                 rxconf.direction = rs->dma_rx.direction;
 456                 rxconf.src_addr = rs->dma_rx.addr;
 457                 rxconf.src_addr_width = rs->n_bytes;
 458                 if (rs->dma_caps.max_burst > 4)
 459                         rxconf.src_maxburst = 4;
 460                 else
 461                         rxconf.src_maxburst = 1;
 462                 dmaengine_slave_config(rs->dma_rx.ch, &rxconf);
 463
 464                 rxdesc = dmaengine_prep_slave_sg(
 465                                 rs->dma_rx.ch,
 466                                 rs->rx_sg.sgl, rs->rx_sg.nents,
 467                                 rs->dma_rx.direction, DMA_PREP_INTERRUPT);
 468                 if (!rxdesc)
 469                         return -EINVAL;
 470
 471                 rxdesc->callback = rockchip_spi_dma_rxcb;
 472                 rxdesc->callback_param = rs;
 473         }
 474
 475         txdesc = NULL;
 476         if (rs->tx) {
 477                 txconf.direction = rs->dma_tx.direction;
 478                 txconf.dst_addr = rs->dma_tx.addr;
 479                 txconf.dst_addr_width = rs->n_bytes;
 480                 if (rs->dma_caps.max_burst > 4)
 481                         txconf.dst_maxburst = 4;
 482                 else
 483                         txconf.dst_maxburst = 1;
 484                 dmaengine_slave_config(rs->dma_tx.ch, &txconf);
 485
 486                 txdesc = dmaengine_prep_slave_sg(
 487                                 rs->dma_tx.ch,
 488                                 rs->tx_sg.sgl, rs->tx_sg.nents,
 489                                 rs->dma_tx.direction, DMA_PREP_INTERRUPT);
 490                 if (!txdesc) {
 491                         if (rxdesc)
 492                                 dmaengine_terminate_sync(rs->dma_rx.ch);
 493                         return -EINVAL;
 494                 }
 495
 496                 txdesc->callback = rockchip_spi_dma_txcb;
 497                 txdesc->callback_param = rs;
 498         }
 499
 500         /* rx must be started before tx due to spi instinct */
 501         if (rxdesc) {
 502                 spin_lock_irqsave(&rs->lock, flags);
 503                 rs->state |= RXBUSY;
 504                 spin_unlock_irqrestore(&rs->lock, flags);
 505                 dmaengine_submit(rxdesc);
 506                 dma_async_issue_pending(rs->dma_rx.ch);
 507         }
 508
 509         if (txdesc) {
 510                 spin_lock_irqsave(&rs->lock, flags);
 511                 rs->state |= TXBUSY;
 512                 spin_unlock_irqrestore(&rs->lock, flags);
 513                 dmaengine_submit(txdesc);
 514                 dma_async_issue_pending(rs->dma_tx.ch);
 515         }
 516
 517         return 0;
 518 }
 519
 520 static void rockchip_spi_config(struct rockchip_spi *rs)
 521 {
 522         u32 div = 0;
 523         u32 dmacr = 0;
 524         int rsd = 0;
 525
 526         u32 cr0 = (CR0_BHT_8BIT << CR0_BHT_OFFSET)
 527                 | (CR0_SSD_ONE << CR0_SSD_OFFSET)
 528                 | (CR0_EM_BIG << CR0_EM_OFFSET);
 529
 530         cr0 |= (rs->n_bytes << CR0_DFS_OFFSET);
 531         cr0 |= ((rs->mode & 0x3) << CR0_SCPH_OFFSET);
 532         cr0 |= (rs->tmode << CR0_XFM_OFFSET);
 533         cr0 |= (rs->type << CR0_FRF_OFFSET);
 534
 535         if (rs->use_dma) {
 536                 if (rs->tx)
 537                         dmacr |= TF_DMA_EN;
 538                 if (rs->rx)
 539                         dmacr |= RF_DMA_EN;
 540         }
 541
 542         if (WARN_ON(rs->speed > MAX_SCLK_OUT))
 543                 rs->speed = MAX_SCLK_OUT;
 544
 545         /* the minimum divisor is 2 */
 546         if (rs->max_freq < 2 * rs->speed) {
 547                 clk_set_rate(rs->spiclk, 2 * rs->speed);
 548                 rs->max_freq = clk_get_rate(rs->spiclk);
 549         }
 550
 551         /* div doesn't support odd number */
 552         div = DIV_ROUND_UP(rs->max_freq, rs->speed);
 553         div = (div + 1) & 0xfffe;
 554
 555         /* Rx sample delay is expressed in parent clock cycles (max 3) */
 556         rsd = DIV_ROUND_CLOSEST(rs->rsd_nsecs * (rs->max_freq >> 8),
 557                                 1000000000 >> 8);
 558         if (!rsd && rs->rsd_nsecs) {
 559                 pr_warn_once("rockchip-spi: %u Hz are too slow to express %u ns delay\n",
 560                              rs->max_freq, rs->rsd_nsecs);
 561         } else if (rsd > 3) {
 562                 rsd = 3;
 563                 pr_warn_once("rockchip-spi: %u Hz are too fast to express %u ns delay, clamping at %u ns\n",
 564                              rs->max_freq, rs->rsd_nsecs,
 565                              rsd * 1000000000U / rs->max_freq);
 566         }
 567         cr0 |= rsd << CR0_RSD_OFFSET;
 568
 569         writel_relaxed(cr0, rs->regs + ROCKCHIP_SPI_CTRLR0);
 570
 571         writel_relaxed(rs->len - 1, rs->regs + ROCKCHIP_SPI_CTRLR1);
 572         writel_relaxed(rs->fifo_len / 2 - 1, rs->regs + ROCKCHIP_SPI_TXFTLR);
 573         writel_relaxed(rs->fifo_len / 2 - 1, rs->regs + ROCKCHIP_SPI_RXFTLR);
 574
 575         writel_relaxed(0, rs->regs + ROCKCHIP_SPI_DMATDLR);
 576         writel_relaxed(0, rs->regs + ROCKCHIP_SPI_DMARDLR);
 577         writel_relaxed(dmacr, rs->regs + ROCKCHIP_SPI_DMACR);
 578
 579         spi_set_clk(rs, div);
 580
 581         dev_dbg(rs->dev, "cr0 0x%x, div %d\n", cr0, div);
 582 }
 583
 584 static size_t rockchip_spi_max_transfer_size(struct spi_device *spi)
 585 {
 586         return ROCKCHIP_SPI_MAX_TRANLEN;
 587 }
 588
 589 static int rockchip_spi_transfer_one(
 590                 struct spi_master *master,
 591                 struct spi_device *spi,
 592                 struct spi_transfer *xfer)
 593 {
 594         int ret = 0;
 595         struct rockchip_spi *rs = spi_master_get_devdata(master);
 596
 597         WARN_ON(readl_relaxed(rs->regs + ROCKCHIP_SPI_SSIENR) &&
 598                 (readl_relaxed(rs->regs + ROCKCHIP_SPI_SR) & SR_BUSY));
 599
 600         if (!xfer->tx_buf && !xfer->rx_buf) {
 601                 dev_err(rs->dev, "No buffer for transfer\n");
 602                 return -EINVAL;
 603         }
 604
 605         if (xfer->len > ROCKCHIP_SPI_MAX_TRANLEN) {
 606                 dev_err(rs->dev, "Transfer is too long (%d)\n", xfer->len);
 607                 return -EINVAL;
 608         }
 609
 610         rs->speed = xfer->speed_hz;
 611         rs->bpw = xfer->bits_per_word;
 612         rs->n_bytes = rs->bpw >> 3;
 613
 614         rs->tx = xfer->tx_buf;
 615         rs->tx_end = rs->tx + xfer->len;
 616         rs->rx = xfer->rx_buf;
 617         rs->rx_end = rs->rx + xfer->len;
 618         rs->len = xfer->len;
 619
 620         rs->tx_sg = xfer->tx_sg;
 621         rs->rx_sg = xfer->rx_sg;
 622
 623         if (rs->tx && rs->rx)
 624                 rs->tmode = CR0_XFM_TR;
 625         else if (rs->tx)
 626                 rs->tmode = CR0_XFM_TO;
 627         else if (rs->rx)
 628                 rs->tmode = CR0_XFM_RO;
 629
 630         /* we need prepare dma before spi was enabled */
 631         if (master->can_dma && master->can_dma(master, spi, xfer))
 632                 rs->use_dma = 1;
 633         else
 634                 rs->use_dma = 0;
 635
 636         rockchip_spi_config(rs);
 637
 638         if (rs->use_dma) {
 639                 if (rs->tmode == CR0_XFM_RO) {
 640                         /* rx: dma must be prepared first */
 641                         ret = rockchip_spi_prepare_dma(rs);
 642                         spi_enable_chip(rs, 1);
 643                 } else {
 644                         /* tx or tr: spi must be enabled first */
 645                         spi_enable_chip(rs, 1);
 646                         ret = rockchip_spi_prepare_dma(rs);
 647                 }
 648                 /* successful DMA prepare means the transfer is in progress */
 649                 ret = ret ? ret : 1;
 650         } else {
 651                 spi_enable_chip(rs, 1);
 652                 ret = rockchip_spi_pio_transfer(rs);
 653         }
 654
 655         return ret;
 656 }
 657
 658 static bool rockchip_spi_can_dma(struct spi_master *master,
 659                                  struct spi_device *spi,
 660                                  struct spi_transfer *xfer)
 661 {
 662         struct rockchip_spi *rs = spi_master_get_devdata(master);
 663
 664         return (xfer->len > rs->fifo_len);
 665 }
 666
 667 static int rockchip_spi_probe(struct platform_device *pdev)
 668 {
 669         int ret = 0;
 670         struct rockchip_spi *rs;
 671         struct spi_master *master;
 672         struct resource *mem;
 673         u32 rsd_nsecs;
 674
 675         master = spi_alloc_master(&pdev->dev, sizeof(struct rockchip_spi));
 676         if (!master)
 677                 return -ENOMEM;
 678
 679         platform_set_drvdata(pdev, master);
 680
 681         rs = spi_master_get_devdata(master);
 682
 683         /* Get basic io resource and map it */
 684         mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 685         rs->regs = devm_ioremap_resource(&pdev->dev, mem);
 686         if (IS_ERR(rs->regs)) {
 687                 ret =  PTR_ERR(rs->regs);
 688                 goto err_put_master;
 689         }
 690
 691         rs->apb_pclk = devm_clk_get(&pdev->dev, "apb_pclk");
 692         if (IS_ERR(rs->apb_pclk)) {
 693                 dev_err(&pdev->dev, "Failed to get apb_pclk\n");
 694                 ret = PTR_ERR(rs->apb_pclk);
 695                 goto err_put_master;
 696         }
 697
 698         rs->spiclk = devm_clk_get(&pdev->dev, "spiclk");
 699         if (IS_ERR(rs->spiclk)) {
 700                 dev_err(&pdev->dev, "Failed to get spi_pclk\n");
 701                 ret = PTR_ERR(rs->spiclk);
 702                 goto err_put_master;
 703         }
 704
 705         ret = clk_prepare_enable(rs->apb_pclk);
 706         if (ret) {
 707                 dev_err(&pdev->dev, "Failed to enable apb_pclk\n");
 708                 goto err_put_master;
 709         }
 710
 711         ret = clk_prepare_enable(rs->spiclk);
 712         if (ret) {
 713                 dev_err(&pdev->dev, "Failed to enable spi_clk\n");
 714                 goto err_disable_apbclk;
 715         }
 716
 717         spi_enable_chip(rs, 0);
 718
 719         rs->type = SSI_MOTO_SPI;
 720         rs->master = master;
 721         rs->dev = &pdev->dev;
 722         rs->max_freq = clk_get_rate(rs->spiclk);
 723
 724         if (!of_property_read_u32(pdev->dev.of_node, "rx-sample-delay-ns",
 725                                   &rsd_nsecs))
 726                 rs->rsd_nsecs = rsd_nsecs;
 727
 728         rs->fifo_len = get_fifo_len(rs);
 729         if (!rs->fifo_len) {
 730                 dev_err(&pdev->dev, "Failed to get fifo length\n");
 731                 ret = -EINVAL;
 732                 goto err_disable_spiclk;
 733         }
 734
 735         spin_lock_init(&rs->lock);
 736
 737         pm_runtime_set_active(&pdev->dev);
 738         pm_runtime_enable(&pdev->dev);
 739
 740         master->auto_runtime_pm = true;
 741         master->bus_num = pdev->id;
 742         master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_LOOP;
 743         master->num_chipselect = ROCKCHIP_SPI_MAX_CS_NUM;
 744         master->dev.of_node = pdev->dev.of_node;
 745         master->bits_per_word_mask = SPI_BPW_MASK(16) | SPI_BPW_MASK(8);
 746
 747         master->set_cs = rockchip_spi_set_cs;
 748         master->prepare_message = rockchip_spi_prepare_message;
 749         master->unprepare_message = rockchip_spi_unprepare_message;
 750         master->transfer_one = rockchip_spi_transfer_one;
 751         master->max_transfer_size = rockchip_spi_max_transfer_size;
 752         master->handle_err = rockchip_spi_handle_err;
 753         master->flags = SPI_MASTER_GPIO_SS;
 754
 755         rs->dma_tx.ch = dma_request_chan(rs->dev, "tx");
 756         if (IS_ERR(rs->dma_tx.ch)) {
 757                 /* Check tx to see if we need defer probing driver */
 758                 if (PTR_ERR(rs->dma_tx.ch) == -EPROBE_DEFER) {
 759                         ret = -EPROBE_DEFER;
 760                         goto err_disable_pm_runtime;
 761                 }
 762                 dev_warn(rs->dev, "Failed to request TX DMA channel\n");
 763                 rs->dma_tx.ch = NULL;
 764         }
 765
 766         rs->dma_rx.ch = dma_request_chan(rs->dev, "rx");
 767         if (IS_ERR(rs->dma_rx.ch)) {
 768                 if (PTR_ERR(rs->dma_rx.ch) == -EPROBE_DEFER) {
 769                         ret = -EPROBE_DEFER;
 770                         goto err_free_dma_tx;
 771                 }
 772                 dev_warn(rs->dev, "Failed to request RX DMA channel\n");
 773                 rs->dma_rx.ch = NULL;
 774         }
 775
 776         if (rs->dma_tx.ch && rs->dma_rx.ch) {
 777                 dma_get_slave_caps(rs->dma_rx.ch, &(rs->dma_caps));
 778                 rs->dma_tx.addr = (dma_addr_t)(mem->start + ROCKCHIP_SPI_TXDR);
 779                 rs->dma_rx.addr = (dma_addr_t)(mem->start + ROCKCHIP_SPI_RXDR);
 780                 rs->dma_tx.direction = DMA_MEM_TO_DEV;
 781                 rs->dma_rx.direction = DMA_DEV_TO_MEM;
 782
 783                 master->can_dma = rockchip_spi_can_dma;
 784                 master->dma_tx = rs->dma_tx.ch;
 785                 master->dma_rx = rs->dma_rx.ch;
 786         }
 787
 788         ret = devm_spi_register_master(&pdev->dev, master);
 789         if (ret) {
 790                 dev_err(&pdev->dev, "Failed to register master\n");
 791                 goto err_free_dma_rx;
 792         }
 793
 794         return 0;
 795
 796 err_free_dma_rx:
 797         if (rs->dma_rx.ch)
 798                 dma_release_channel(rs->dma_rx.ch);
 799 err_free_dma_tx:
 800         if (rs->dma_tx.ch)
 801                 dma_release_channel(rs->dma_tx.ch);
 802 err_disable_pm_runtime:
 803         pm_runtime_disable(&pdev->dev);
 804 err_disable_spiclk:
 805         clk_disable_unprepare(rs->spiclk);
 806 err_disable_apbclk:
 807         clk_disable_unprepare(rs->apb_pclk);
 808 err_put_master:
 809         spi_master_put(master);
 810
 811         return ret;
 812 }
 813
 814 static int rockchip_spi_remove(struct platform_device *pdev)
 815 {
 816         struct spi_master *master = spi_master_get(platform_get_drvdata(pdev));
 817         struct rockchip_spi *rs = spi_master_get_devdata(master);
 818
 819         pm_runtime_disable(&pdev->dev);
 820
 821         clk_disable_unprepare(rs->spiclk);
 822         clk_disable_unprepare(rs->apb_pclk);
 823
 824         if (rs->dma_tx.ch)
 825                 dma_release_channel(rs->dma_tx.ch);
 826         if (rs->dma_rx.ch)
 827                 dma_release_channel(rs->dma_rx.ch);
 828
 829         spi_master_put(master);
 830
 831         return 0;
 832 }
 833
 834 #ifdef CONFIG_PM_SLEEP
 835 static int rockchip_spi_suspend(struct device *dev)
 836 {
 837         int ret = 0;
 838         struct spi_master *master = dev_get_drvdata(dev);
 839         struct rockchip_spi *rs = spi_master_get_devdata(master);
 840
 841         ret = spi_master_suspend(rs->master);
 842         if (ret)
 843                 return ret;
 844
 845         if (!pm_runtime_suspended(dev)) {
 846                 clk_disable_unprepare(rs->spiclk);
 847                 clk_disable_unprepare(rs->apb_pclk);
 848         }
 849
 850         pinctrl_pm_select_sleep_state(dev);
 851
 852         return ret;
 853 }
 854
 855 static int rockchip_spi_resume(struct device *dev)
 856 {
 857         int ret = 0;
 858         struct spi_master *master = dev_get_drvdata(dev);
 859         struct rockchip_spi *rs = spi_master_get_devdata(master);
 860
 861         pinctrl_pm_select_default_state(dev);
 862
 863         if (!pm_runtime_suspended(dev)) {
 864                 ret = clk_prepare_enable(rs->apb_pclk);
 865                 if (ret < 0)
 866                         return ret;
 867
 868                 ret = clk_prepare_enable(rs->spiclk);
 869                 if (ret < 0) {
 870                         clk_disable_unprepare(rs->apb_pclk);
 871                         return ret;
 872                 }
 873         }
 874
 875         ret = spi_master_resume(rs->master);
 876         if (ret < 0) {
 877                 clk_disable_unprepare(rs->spiclk);
 878                 clk_disable_unprepare(rs->apb_pclk);
 879         }
 880
 881         return ret;
 882 }
 883 #endif /* CONFIG_PM_SLEEP */
 884
 885 #ifdef CONFIG_PM
 886 static int rockchip_spi_runtime_suspend(struct device *dev)
 887 {
 888         struct spi_master *master = dev_get_drvdata(dev);
 889         struct rockchip_spi *rs = spi_master_get_devdata(master);
 890
 891         clk_disable_unprepare(rs->spiclk);
 892         clk_disable_unprepare(rs->apb_pclk);
 893
 894         return 0;
 895 }
 896
 897 static int rockchip_spi_runtime_resume(struct device *dev)
 898 {
 899         int ret;
 900         struct spi_master *master = dev_get_drvdata(dev);
 901         struct rockchip_spi *rs = spi_master_get_devdata(master);
 902
 903         ret = clk_prepare_enable(rs->apb_pclk);
 904         if (ret)
 905                 return ret;
 906
 907         ret = clk_prepare_enable(rs->spiclk);
 908         if (ret)
 909                 clk_disable_unprepare(rs->apb_pclk);
 910
 911         return ret;
 912 }
 913 #endif /* CONFIG_PM */
 914
 915 static const struct dev_pm_ops rockchip_spi_pm = {
 916         SET_SYSTEM_SLEEP_PM_OPS(rockchip_spi_suspend, rockchip_spi_resume)
 917         SET_RUNTIME_PM_OPS(rockchip_spi_runtime_suspend,
 918                            rockchip_spi_runtime_resume, NULL)
 919 };
 920
 921 static const struct of_device_id rockchip_spi_dt_match[] = {
 922         { .compatible = "rockchip,rk3036-spi", },
 923         { .compatible = "rockchip,rk3066-spi", },
 924         { .compatible = "rockchip,rk3188-spi", },
 925         { .compatible = "rockchip,rk3228-spi", },
 926         { .compatible = "rockchip,rk3288-spi", },
 927         { .compatible = "rockchip,rk3368-spi", },
 928         { .compatible = "rockchip,rk3399-spi", },
 929         { },
 930 };
 931 MODULE_DEVICE_TABLE(of, rockchip_spi_dt_match);
 932
 933 static struct platform_driver rockchip_spi_driver = {
 934         .driver = {
 935                 .name   = DRIVER_NAME,
 936                 .pm = &rockchip_spi_pm,
 937                 .of_match_table = of_match_ptr(rockchip_spi_dt_match),
 938         },
 939         .probe = rockchip_spi_probe,
 940         .remove = rockchip_spi_remove,
 941 };
 942
 943 module_platform_driver(rockchip_spi_driver);
 944
 945 MODULE_AUTHOR("Addy Ke <addy.ke@rock-chips.com>");
 946 MODULE_DESCRIPTION("ROCKCHIP SPI Controller Driver");
 947 MODULE_LICENSE("GPL v2");