drivers/spi/spi-pic32.c

   1 /*
   2  * Microchip PIC32 SPI controller driver.
   3  *
   4  * Purna Chandra Mandal <purna.mandal@microchip.com>
   5  * Copyright (c) 2016, Microchip Technology Inc.
   6  *
   7  * This program is free software; you can distribute it and/or modify it
   8  * under the terms of the GNU General Public License (Version 2) as
   9  * published by the Free Software Foundation.
  10  *
  11  * This program is distributed in the hope it will be useful, but WITHOUT
  12  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  13  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
  14  * for more details.
  15  */
  16
  17 #include <linux/clk.h>
  18 #include <linux/clkdev.h>
  19 #include <linux/delay.h>
  20 #include <linux/dmaengine.h>
  21 #include <linux/dma-mapping.h>
  22 #include <linux/highmem.h>
  23 #include <linux/module.h>
  24 #include <linux/io.h>
  25 #include <linux/interrupt.h>
  26 #include <linux/of.h>
  27 #include <linux/of_irq.h>
  28 #include <linux/of_gpio.h>
  29 #include <linux/of_address.h>
  30 #include <linux/platform_device.h>
  31 #include <linux/spi/spi.h>
  32
  33 /* SPI controller registers */
  34 struct pic32_spi_regs {
  35         u32 ctrl;
  36         u32 ctrl_clr;
  37         u32 ctrl_set;
  38         u32 ctrl_inv;
  39         u32 status;
  40         u32 status_clr;
  41         u32 status_set;
  42         u32 status_inv;
  43         u32 buf;
  44         u32 dontuse[3];
  45         u32 baud;
  46         u32 dontuse2[3];
  47         u32 ctrl2;
  48         u32 ctrl2_clr;
  49         u32 ctrl2_set;
  50         u32 ctrl2_inv;
  51 };
  52
  53 /* Bit fields of SPI Control Register */
  54 #define CTRL_RX_INT_SHIFT       0  /* Rx interrupt generation */
  55 #define  RX_FIFO_EMPTY          0
  56 #define  RX_FIFO_NOT_EMPTY      1 /* not empty */
  57 #define  RX_FIFO_HALF_FULL      2 /* full by half or more */
  58 #define  RX_FIFO_FULL           3 /* completely full */
  59
  60 #define CTRL_TX_INT_SHIFT       2  /* TX interrupt generation */
  61 #define  TX_FIFO_ALL_EMPTY      0 /* completely empty */
  62 #define  TX_FIFO_EMPTY          1 /* empty */
  63 #define  TX_FIFO_HALF_EMPTY     2 /* empty by half or more */
  64 #define  TX_FIFO_NOT_FULL       3 /* atleast one empty */
  65
  66 #define CTRL_MSTEN      BIT(5) /* enable master mode */
  67 #define CTRL_CKP        BIT(6) /* active low */
  68 #define CTRL_CKE        BIT(8) /* Tx on falling edge */
  69 #define CTRL_SMP        BIT(9) /* Rx at middle or end of tx */
  70 #define CTRL_BPW_MASK   0x03   /* bits per word/sample */
  71 #define CTRL_BPW_SHIFT  10
  72 #define  PIC32_BPW_8    0
  73 #define  PIC32_BPW_16   1
  74 #define  PIC32_BPW_32   2
  75 #define CTRL_SIDL       BIT(13) /* sleep when idle */
  76 #define CTRL_ON         BIT(15) /* enable macro */
  77 #define CTRL_ENHBUF     BIT(16) /* enable enhanced buffering */
  78 #define CTRL_MCLKSEL    BIT(23) /* select clock source */
  79 #define CTRL_MSSEN      BIT(28) /* macro driven /SS */
  80 #define CTRL_FRMEN      BIT(31) /* enable framing mode */
  81
  82 /* Bit fields of SPI Status Register */
  83 #define STAT_RF_EMPTY   BIT(5) /* RX Fifo empty */
  84 #define STAT_RX_OV      BIT(6) /* err, s/w needs to clear */
  85 #define STAT_TX_UR      BIT(8) /* UR in Framed SPI modes */
  86 #define STAT_FRM_ERR    BIT(12) /* Multiple Frame Sync pulse */
  87 #define STAT_TF_LVL_MASK        0x1F
  88 #define STAT_TF_LVL_SHIFT       16
  89 #define STAT_RF_LVL_MASK        0x1F
  90 #define STAT_RF_LVL_SHIFT       24
  91
  92 /* Bit fields of SPI Baud Register */
  93 #define BAUD_MASK               0x1ff
  94
  95 /* Bit fields of SPI Control2 Register */
  96 #define CTRL2_TX_UR_EN          BIT(10) /* Enable int on Tx under-run */
  97 #define CTRL2_RX_OV_EN          BIT(11) /* Enable int on Rx over-run */
  98 #define CTRL2_FRM_ERR_EN        BIT(12) /* Enable frame err int */
  99
 100 /* Minimum DMA transfer size */
 101 #define PIC32_DMA_LEN_MIN       64
 102
 103 struct pic32_spi {
 104         dma_addr_t              dma_base;
 105         struct pic32_spi_regs __iomem *regs;
 106         int                     fault_irq;
 107         int                     rx_irq;
 108         int                     tx_irq;
 109         u32                     fifo_n_byte; /* FIFO depth in bytes */
 110         struct clk              *clk;
 111         struct spi_master       *master;
 112         /* Current controller setting */
 113         u32                     speed_hz; /* spi-clk rate */
 114         u32                     mode;
 115         u32                     bits_per_word;
 116         u32                     fifo_n_elm; /* FIFO depth in words */
 117 #define PIC32F_DMA_PREP         0 /* DMA chnls configured */
 118         unsigned long           flags;
 119         /* Current transfer state */
 120         struct completion       xfer_done;
 121         /* PIO transfer specific */
 122         const void              *tx;
 123         const void              *tx_end;
 124         const void              *rx;
 125         const void              *rx_end;
 126         int                     len;
 127         void (*rx_fifo)(struct pic32_spi *);
 128         void (*tx_fifo)(struct pic32_spi *);
 129 };
 130
 131 static inline void pic32_spi_enable(struct pic32_spi *pic32s)
 132 {
 133         writel(CTRL_ON | CTRL_SIDL, &pic32s->regs->ctrl_set);
 134 }
 135
 136 static inline void pic32_spi_disable(struct pic32_spi *pic32s)
 137 {
 138         writel(CTRL_ON | CTRL_SIDL, &pic32s->regs->ctrl_clr);
 139
 140         /* avoid SPI registers read/write at immediate next CPU clock */
 141         ndelay(20);
 142 }
 143
 144 static void pic32_spi_set_clk_rate(struct pic32_spi *pic32s, u32 spi_ck)
 145 {
 146         u32 div;
 147
 148         /* div = (clk_in / 2 * spi_ck) - 1 */
 149         div = DIV_ROUND_CLOSEST(clk_get_rate(pic32s->clk), 2 * spi_ck) - 1;
 150
 151         writel(div & BAUD_MASK, &pic32s->regs->baud);
 152 }
 153
 154 static inline u32 pic32_rx_fifo_level(struct pic32_spi *pic32s)
 155 {
 156         u32 sr = readl(&pic32s->regs->status);
 157
 158         return (sr >> STAT_RF_LVL_SHIFT) & STAT_RF_LVL_MASK;
 159 }
 160
 161 static inline u32 pic32_tx_fifo_level(struct pic32_spi *pic32s)
 162 {
 163         u32 sr = readl(&pic32s->regs->status);
 164
 165         return (sr >> STAT_TF_LVL_SHIFT) & STAT_TF_LVL_MASK;
 166 }
 167
 168 /* Return the max entries we can fill into tx fifo */
 169 static u32 pic32_tx_max(struct pic32_spi *pic32s, int n_bytes)
 170 {
 171         u32 tx_left, tx_room, rxtx_gap;
 172
 173         tx_left = (pic32s->tx_end - pic32s->tx) / n_bytes;
 174         tx_room = pic32s->fifo_n_elm - pic32_tx_fifo_level(pic32s);
 175
 176         /*
 177          * Another concern is about the tx/rx mismatch, we
 178          * though to use (pic32s->fifo_n_byte - rxfl - txfl) as
 179          * one maximum value for tx, but it doesn't cover the
 180          * data which is out of tx/rx fifo and inside the
 181          * shift registers. So a ctrl from sw point of
 182          * view is taken.
 183          */
 184         rxtx_gap = ((pic32s->rx_end - pic32s->rx) -
 185                     (pic32s->tx_end - pic32s->tx)) / n_bytes;
 186         return min3(tx_left, tx_room, (u32)(pic32s->fifo_n_elm - rxtx_gap));
 187 }
 188
 189 /* Return the max entries we should read out of rx fifo */
 190 static u32 pic32_rx_max(struct pic32_spi *pic32s, int n_bytes)
 191 {
 192         u32 rx_left = (pic32s->rx_end - pic32s->rx) / n_bytes;
 193
 194         return min_t(u32, rx_left, pic32_rx_fifo_level(pic32s));
 195 }
 196
 197 #define BUILD_SPI_FIFO_RW(__name, __type, __bwl)                \
 198 static void pic32_spi_rx_##__name(struct pic32_spi *pic32s)     \
 199 {                                                               \
 200         __type v;                                               \
 201         u32 mx = pic32_rx_max(pic32s, sizeof(__type));          \
 202         for (; mx; mx--) {                                      \
 203                 v = read##__bwl(&pic32s->regs->buf);            \
 204                 if (pic32s->rx_end - pic32s->len)               \
 205                         *(__type *)(pic32s->rx) = v;            \
 206                 pic32s->rx += sizeof(__type);                   \
 207         }                                                       \
 208 }                                                               \
 209                                                                 \
 210 static void pic32_spi_tx_##__name(struct pic32_spi *pic32s)     \
 211 {                                                               \
 212         __type v;                                               \
 213         u32 mx = pic32_tx_max(pic32s, sizeof(__type));          \
 214         for (; mx ; mx--) {                                     \
 215                 v = (__type)~0U;                                \
 216                 if (pic32s->tx_end - pic32s->len)               \
 217                         v = *(__type *)(pic32s->tx);            \
 218                 write##__bwl(v, &pic32s->regs->buf);            \
 219                 pic32s->tx += sizeof(__type);                   \
 220         }                                                       \
 221 }
 222
 223 BUILD_SPI_FIFO_RW(byte, u8, b);
 224 BUILD_SPI_FIFO_RW(word, u16, w);
 225 BUILD_SPI_FIFO_RW(dword, u32, l);
 226
 227 static void pic32_err_stop(struct pic32_spi *pic32s, const char *msg)
 228 {
 229         /* disable all interrupts */
 230         disable_irq_nosync(pic32s->fault_irq);
 231         disable_irq_nosync(pic32s->rx_irq);
 232         disable_irq_nosync(pic32s->tx_irq);
 233
 234         /* Show err message and abort xfer with err */
 235         dev_err(&pic32s->master->dev, "%s\n", msg);
 236         if (pic32s->master->cur_msg)
 237                 pic32s->master->cur_msg->status = -EIO;
 238         complete(&pic32s->xfer_done);
 239 }
 240
 241 static irqreturn_t pic32_spi_fault_irq(int irq, void *dev_id)
 242 {
 243         struct pic32_spi *pic32s = dev_id;
 244         u32 status;
 245
 246         status = readl(&pic32s->regs->status);
 247
 248         /* Error handling */
 249         if (status & (STAT_RX_OV | STAT_TX_UR)) {
 250                 writel(STAT_RX_OV, &pic32s->regs->status_clr);
 251                 writel(STAT_TX_UR, &pic32s->regs->status_clr);
 252                 pic32_err_stop(pic32s, "err_irq: fifo ov/ur-run\n");
 253                 return IRQ_HANDLED;
 254         }
 255
 256         if (status & STAT_FRM_ERR) {
 257                 pic32_err_stop(pic32s, "err_irq: frame error");
 258                 return IRQ_HANDLED;
 259         }
 260
 261         if (!pic32s->master->cur_msg) {
 262                 pic32_err_stop(pic32s, "err_irq: no mesg");
 263                 return IRQ_NONE;
 264         }
 265
 266         return IRQ_NONE;
 267 }
 268
 269 static irqreturn_t pic32_spi_rx_irq(int irq, void *dev_id)
 270 {
 271         struct pic32_spi *pic32s = dev_id;
 272
 273         pic32s->rx_fifo(pic32s);
 274
 275         /* rx complete ? */
 276         if (pic32s->rx_end == pic32s->rx) {
 277                 /* disable all interrupts */
 278                 disable_irq_nosync(pic32s->fault_irq);
 279                 disable_irq_nosync(pic32s->rx_irq);
 280
 281                 /* complete current xfer */
 282                 complete(&pic32s->xfer_done);
 283         }
 284
 285         return IRQ_HANDLED;
 286 }
 287
 288 static irqreturn_t pic32_spi_tx_irq(int irq, void *dev_id)
 289 {
 290         struct pic32_spi *pic32s = dev_id;
 291
 292         pic32s->tx_fifo(pic32s);
 293
 294         /* tx complete? disable tx interrupt */
 295         if (pic32s->tx_end == pic32s->tx)
 296                 disable_irq_nosync(pic32s->tx_irq);
 297
 298         return IRQ_HANDLED;
 299 }
 300
 301 static void pic32_spi_dma_rx_notify(void *data)
 302 {
 303         struct pic32_spi *pic32s = data;
 304
 305         complete(&pic32s->xfer_done);
 306 }
 307
 308 static int pic32_spi_dma_transfer(struct pic32_spi *pic32s,
 309                                   struct spi_transfer *xfer)
 310 {
 311         struct spi_master *master = pic32s->master;
 312         struct dma_async_tx_descriptor *desc_rx;
 313         struct dma_async_tx_descriptor *desc_tx;
 314         dma_cookie_t cookie;
 315         int ret;
 316
 317         if (!master->dma_rx || !master->dma_tx)
 318                 return -ENODEV;
 319
 320         desc_rx = dmaengine_prep_slave_sg(master->dma_rx,
 321                                           xfer->rx_sg.sgl,
 322                                           xfer->rx_sg.nents,
 323                                           DMA_DEV_TO_MEM,
 324                                           DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
 325         if (!desc_rx) {
 326                 ret = -EINVAL;
 327                 goto err_dma;
 328         }
 329
 330         desc_tx = dmaengine_prep_slave_sg(master->dma_tx,
 331                                           xfer->tx_sg.sgl,
 332                                           xfer->tx_sg.nents,
 333                                           DMA_MEM_TO_DEV,
 334                                           DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
 335         if (!desc_tx) {
 336                 ret = -EINVAL;
 337                 goto err_dma;
 338         }
 339
 340         /* Put callback on the RX transfer, that should finish last */
 341         desc_rx->callback = pic32_spi_dma_rx_notify;
 342         desc_rx->callback_param = pic32s;
 343
 344         cookie = dmaengine_submit(desc_rx);
 345         ret = dma_submit_error(cookie);
 346         if (ret)
 347                 goto err_dma;
 348
 349         cookie = dmaengine_submit(desc_tx);
 350         ret = dma_submit_error(cookie);
 351         if (ret)
 352                 goto err_dma_tx;
 353
 354         dma_async_issue_pending(master->dma_rx);
 355         dma_async_issue_pending(master->dma_tx);
 356
 357         return 0;
 358
 359 err_dma_tx:
 360         dmaengine_terminate_all(master->dma_rx);
 361 err_dma:
 362         return ret;
 363 }
 364
 365 static int pic32_spi_dma_config(struct pic32_spi *pic32s, u32 dma_width)
 366 {
 367         int buf_offset = offsetof(struct pic32_spi_regs, buf);
 368         struct spi_master *master = pic32s->master;
 369         struct dma_slave_config cfg;
 370         int ret;
 371
 372         memset(&cfg, 0, sizeof(cfg));
 373         cfg.device_fc = true;
 374         cfg.src_addr = pic32s->dma_base + buf_offset;
 375         cfg.dst_addr = pic32s->dma_base + buf_offset;
 376         cfg.src_maxburst = pic32s->fifo_n_elm / 2; /* fill one-half */
 377         cfg.dst_maxburst = pic32s->fifo_n_elm / 2; /* drain one-half */
 378         cfg.src_addr_width = dma_width;
 379         cfg.dst_addr_width = dma_width;
 380         /* tx channel */
 381         cfg.slave_id = pic32s->tx_irq;
 382         cfg.direction = DMA_MEM_TO_DEV;
 383         ret = dmaengine_slave_config(master->dma_tx, &cfg);
 384         if (ret) {
 385                 dev_err(&master->dev, "tx channel setup failed\n");
 386                 return ret;
 387         }
 388         /* rx channel */
 389         cfg.slave_id = pic32s->rx_irq;
 390         cfg.direction = DMA_DEV_TO_MEM;
 391         ret = dmaengine_slave_config(master->dma_rx, &cfg);
 392         if (ret)
 393                 dev_err(&master->dev, "rx channel setup failed\n");
 394
 395         return ret;
 396 }
 397
 398 static int pic32_spi_set_word_size(struct pic32_spi *pic32s, u8 bits_per_word)
 399 {
 400         enum dma_slave_buswidth dmawidth;
 401         u32 buswidth, v;
 402
 403         switch (bits_per_word) {
 404         case 8:
 405                 pic32s->rx_fifo = pic32_spi_rx_byte;
 406                 pic32s->tx_fifo = pic32_spi_tx_byte;
 407                 buswidth = PIC32_BPW_8;
 408                 dmawidth = DMA_SLAVE_BUSWIDTH_1_BYTE;
 409                 break;
 410         case 16:
 411                 pic32s->rx_fifo = pic32_spi_rx_word;
 412                 pic32s->tx_fifo = pic32_spi_tx_word;
 413                 buswidth = PIC32_BPW_16;
 414                 dmawidth = DMA_SLAVE_BUSWIDTH_2_BYTES;
 415                 break;
 416         case 32:
 417                 pic32s->rx_fifo = pic32_spi_rx_dword;
 418                 pic32s->tx_fifo = pic32_spi_tx_dword;
 419                 buswidth = PIC32_BPW_32;
 420                 dmawidth = DMA_SLAVE_BUSWIDTH_4_BYTES;
 421                 break;
 422         default:
 423                 /* not supported */
 424                 return -EINVAL;
 425         }
 426
 427         /* calculate maximum number of words fifos can hold */
 428         pic32s->fifo_n_elm = DIV_ROUND_UP(pic32s->fifo_n_byte,
 429                                           bits_per_word / 8);
 430         /* set word size */
 431         v = readl(&pic32s->regs->ctrl);
 432         v &= ~(CTRL_BPW_MASK << CTRL_BPW_SHIFT);
 433         v |= buswidth << CTRL_BPW_SHIFT;
 434         writel(v, &pic32s->regs->ctrl);
 435
 436         /* re-configure dma width, if required */
 437         if (test_bit(PIC32F_DMA_PREP, &pic32s->flags))
 438                 pic32_spi_dma_config(pic32s, dmawidth);
 439
 440         return 0;
 441 }
 442
 443 static int pic32_spi_prepare_hardware(struct spi_master *master)
 444 {
 445         struct pic32_spi *pic32s = spi_master_get_devdata(master);
 446
 447         pic32_spi_enable(pic32s);
 448
 449         return 0;
 450 }
 451
 452 static int pic32_spi_prepare_message(struct spi_master *master,
 453                                      struct spi_message *msg)
 454 {
 455         struct pic32_spi *pic32s = spi_master_get_devdata(master);
 456         struct spi_device *spi = msg->spi;
 457         u32 val;
 458
 459         /* set device specific bits_per_word */
 460         if (pic32s->bits_per_word != spi->bits_per_word) {
 461                 pic32_spi_set_word_size(pic32s, spi->bits_per_word);
 462                 pic32s->bits_per_word = spi->bits_per_word;
 463         }
 464
 465         /* device specific speed change */
 466         if (pic32s->speed_hz != spi->max_speed_hz) {
 467                 pic32_spi_set_clk_rate(pic32s, spi->max_speed_hz);
 468                 pic32s->speed_hz = spi->max_speed_hz;
 469         }
 470
 471         /* device specific mode change */
 472         if (pic32s->mode != spi->mode) {
 473                 val = readl(&pic32s->regs->ctrl);
 474                 /* active low */
 475                 if (spi->mode & SPI_CPOL)
 476                         val |= CTRL_CKP;
 477                 else
 478                         val &= ~CTRL_CKP;
 479                 /* tx on rising edge */
 480                 if (spi->mode & SPI_CPHA)
 481                         val &= ~CTRL_CKE;
 482                 else
 483                         val |= CTRL_CKE;
 484
 485                 /* rx at end of tx */
 486                 val |= CTRL_SMP;
 487                 writel(val, &pic32s->regs->ctrl);
 488                 pic32s->mode = spi->mode;
 489         }
 490
 491         return 0;
 492 }
 493
 494 static bool pic32_spi_can_dma(struct spi_master *master,
 495                               struct spi_device *spi,
 496                               struct spi_transfer *xfer)
 497 {
 498         struct pic32_spi *pic32s = spi_master_get_devdata(master);
 499
 500         /* skip using DMA on small size transfer to avoid overhead.*/
 501         return (xfer->len >= PIC32_DMA_LEN_MIN) &&
 502                test_bit(PIC32F_DMA_PREP, &pic32s->flags);
 503 }
 504
 505 static int pic32_spi_one_transfer(struct spi_master *master,
 506                                   struct spi_device *spi,
 507                                   struct spi_transfer *transfer)
 508 {
 509         struct pic32_spi *pic32s;
 510         bool dma_issued = false;
 511         unsigned long timeout;
 512         int ret;
 513
 514         pic32s = spi_master_get_devdata(master);
 515
 516         /* handle transfer specific word size change */
 517         if (transfer->bits_per_word &&
 518             (transfer->bits_per_word != pic32s->bits_per_word)) {
 519                 ret = pic32_spi_set_word_size(pic32s, transfer->bits_per_word);
 520                 if (ret)
 521                         return ret;
 522                 pic32s->bits_per_word = transfer->bits_per_word;
 523         }
 524
 525         /* handle transfer specific speed change */
 526         if (transfer->speed_hz && (transfer->speed_hz != pic32s->speed_hz)) {
 527                 pic32_spi_set_clk_rate(pic32s, transfer->speed_hz);
 528                 pic32s->speed_hz = transfer->speed_hz;
 529         }
 530
 531         reinit_completion(&pic32s->xfer_done);
 532
 533         /* transact by DMA mode */
 534         if (transfer->rx_sg.nents && transfer->tx_sg.nents) {
 535                 ret = pic32_spi_dma_transfer(pic32s, transfer);
 536                 if (ret) {
 537                         dev_err(&spi->dev, "dma submit error\n");
 538                         return ret;
 539                 }
 540
 541                 /* DMA issued */
 542                 dma_issued = true;
 543         } else {
 544                 /* set current transfer information */
 545                 pic32s->tx = (const void *)transfer->tx_buf;
 546                 pic32s->rx = (const void *)transfer->rx_buf;
 547                 pic32s->tx_end = pic32s->tx + transfer->len;
 548                 pic32s->rx_end = pic32s->rx + transfer->len;
 549                 pic32s->len = transfer->len;
 550
 551                 /* transact by interrupt driven PIO */
 552                 enable_irq(pic32s->fault_irq);
 553                 enable_irq(pic32s->rx_irq);
 554                 enable_irq(pic32s->tx_irq);
 555         }
 556
 557         /* wait for completion */
 558         timeout = wait_for_completion_timeout(&pic32s->xfer_done, 2 * HZ);
 559         if (timeout == 0) {
 560                 dev_err(&spi->dev, "wait error/timedout\n");
 561                 if (dma_issued) {
 562                         dmaengine_terminate_all(master->dma_rx);
 563                         dmaengine_terminate_all(master->dma_rx);
 564                 }
 565                 ret = -ETIMEDOUT;
 566         } else {
 567                 ret = 0;
 568         }
 569
 570         return ret;
 571 }
 572
 573 static int pic32_spi_unprepare_message(struct spi_master *master,
 574                                        struct spi_message *msg)
 575 {
 576         /* nothing to do */
 577         return 0;
 578 }
 579
 580 static int pic32_spi_unprepare_hardware(struct spi_master *master)
 581 {
 582         struct pic32_spi *pic32s = spi_master_get_devdata(master);
 583
 584         pic32_spi_disable(pic32s);
 585
 586         return 0;
 587 }
 588
 589 /* This may be called multiple times by same spi dev */
 590 static int pic32_spi_setup(struct spi_device *spi)
 591 {
 592         if (!spi->max_speed_hz) {
 593                 dev_err(&spi->dev, "No max speed HZ parameter\n");
 594                 return -EINVAL;
 595         }
 596
 597         /* PIC32 spi controller can drive /CS during transfer depending
 598          * on tx fifo fill-level. /CS will stay asserted as long as TX
 599          * fifo is non-empty, else will be deasserted indicating
 600          * completion of the ongoing transfer. This might result into
 601          * unreliable/erroneous SPI transactions.
 602          * To avoid that we will always handle /CS by toggling GPIO.
 603          */
 604         if (!gpio_is_valid(spi->cs_gpio))
 605                 return -EINVAL;
 606
 607         gpio_direction_output(spi->cs_gpio, !(spi->mode & SPI_CS_HIGH));
 608
 609         return 0;
 610 }
 611
 612 static void pic32_spi_cleanup(struct spi_device *spi)
 613 {
 614         /* de-activate cs-gpio */
 615         gpio_direction_output(spi->cs_gpio, !(spi->mode & SPI_CS_HIGH));
 616 }
 617
 618 static void pic32_spi_dma_prep(struct pic32_spi *pic32s, struct device *dev)
 619 {
 620         struct spi_master *master = pic32s->master;
 621         dma_cap_mask_t mask;
 622
 623         dma_cap_zero(mask);
 624         dma_cap_set(DMA_SLAVE, mask);
 625
 626         master->dma_rx = dma_request_slave_channel_compat(mask, NULL, NULL,
 627                                                           dev, "spi-rx");
 628         if (!master->dma_rx) {
 629                 dev_warn(dev, "RX channel not found.\n");
 630                 goto out_err;
 631         }
 632
 633         master->dma_tx = dma_request_slave_channel_compat(mask, NULL, NULL,
 634                                                           dev, "spi-tx");
 635         if (!master->dma_tx) {
 636                 dev_warn(dev, "TX channel not found.\n");
 637                 goto out_err;
 638         }
 639
 640         if (pic32_spi_dma_config(pic32s, DMA_SLAVE_BUSWIDTH_1_BYTE))
 641                 goto out_err;
 642
 643         /* DMA chnls allocated and prepared */
 644         set_bit(PIC32F_DMA_PREP, &pic32s->flags);
 645
 646         return;
 647
 648 out_err:
 649         if (master->dma_rx)
 650                 dma_release_channel(master->dma_rx);
 651
 652         if (master->dma_tx)
 653                 dma_release_channel(master->dma_tx);
 654 }
 655
 656 static void pic32_spi_dma_unprep(struct pic32_spi *pic32s)
 657 {
 658         if (!test_bit(PIC32F_DMA_PREP, &pic32s->flags))
 659                 return;
 660
 661         clear_bit(PIC32F_DMA_PREP, &pic32s->flags);
 662         if (pic32s->master->dma_rx)
 663                 dma_release_channel(pic32s->master->dma_rx);
 664
 665         if (pic32s->master->dma_tx)
 666                 dma_release_channel(pic32s->master->dma_tx);
 667 }
 668
 669 static void pic32_spi_hw_init(struct pic32_spi *pic32s)
 670 {
 671         u32 ctrl;
 672
 673         /* disable hardware */
 674         pic32_spi_disable(pic32s);
 675
 676         ctrl = readl(&pic32s->regs->ctrl);
 677         /* enable enhanced fifo of 128bit deep */
 678         ctrl |= CTRL_ENHBUF;
 679         pic32s->fifo_n_byte = 16;
 680
 681         /* disable framing mode */
 682         ctrl &= ~CTRL_FRMEN;
 683
 684         /* enable master mode while disabled */
 685         ctrl |= CTRL_MSTEN;
 686
 687         /* set tx fifo threshold interrupt */
 688         ctrl &= ~(0x3 << CTRL_TX_INT_SHIFT);
 689         ctrl |= (TX_FIFO_HALF_EMPTY << CTRL_TX_INT_SHIFT);
 690
 691         /* set rx fifo threshold interrupt */
 692         ctrl &= ~(0x3 << CTRL_RX_INT_SHIFT);
 693         ctrl |= (RX_FIFO_NOT_EMPTY << CTRL_RX_INT_SHIFT);
 694
 695         /* select clk source */
 696         ctrl &= ~CTRL_MCLKSEL;
 697
 698         /* set manual /CS mode */
 699         ctrl &= ~CTRL_MSSEN;
 700
 701         writel(ctrl, &pic32s->regs->ctrl);
 702
 703         /* enable error reporting */
 704         ctrl = CTRL2_TX_UR_EN | CTRL2_RX_OV_EN | CTRL2_FRM_ERR_EN;
 705         writel(ctrl, &pic32s->regs->ctrl2_set);
 706 }
 707
 708 static int pic32_spi_hw_probe(struct platform_device *pdev,
 709                               struct pic32_spi *pic32s)
 710 {
 711         struct resource *mem;
 712         int ret;
 713
 714         mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 715         pic32s->regs = devm_ioremap_resource(&pdev->dev, mem);
 716         if (IS_ERR(pic32s->regs))
 717                 return PTR_ERR(pic32s->regs);
 718
 719         pic32s->dma_base = mem->start;
 720
 721         /* get irq resources: err-irq, rx-irq, tx-irq */
 722         pic32s->fault_irq = platform_get_irq_byname(pdev, "fault");
 723         if (pic32s->fault_irq < 0) {
 724                 dev_err(&pdev->dev, "fault-irq not found\n");
 725                 return pic32s->fault_irq;
 726         }
 727
 728         pic32s->rx_irq = platform_get_irq_byname(pdev, "rx");
 729         if (pic32s->rx_irq < 0) {
 730                 dev_err(&pdev->dev, "rx-irq not found\n");
 731                 return pic32s->rx_irq;
 732         }
 733
 734         pic32s->tx_irq = platform_get_irq_byname(pdev, "tx");
 735         if (pic32s->tx_irq < 0) {
 736                 dev_err(&pdev->dev, "tx-irq not found\n");
 737                 return pic32s->tx_irq;
 738         }
 739
 740         /* get clock */
 741         pic32s->clk = devm_clk_get(&pdev->dev, "mck0");
 742         if (IS_ERR(pic32s->clk)) {
 743                 dev_err(&pdev->dev, "clk not found\n");
 744                 ret = PTR_ERR(pic32s->clk);
 745                 goto err_unmap_mem;
 746         }
 747
 748         ret = clk_prepare_enable(pic32s->clk);
 749         if (ret)
 750                 goto err_unmap_mem;
 751
 752         pic32_spi_hw_init(pic32s);
 753
 754         return 0;
 755
 756 err_unmap_mem:
 757         dev_err(&pdev->dev, "%s failed, err %d\n", __func__, ret);
 758         return ret;
 759 }
 760
 761 static int pic32_spi_probe(struct platform_device *pdev)
 762 {
 763         struct spi_master *master;
 764         struct pic32_spi *pic32s;
 765         int ret;
 766
 767         master = spi_alloc_master(&pdev->dev, sizeof(*pic32s));
 768         if (!master)
 769                 return -ENOMEM;
 770
 771         pic32s = spi_master_get_devdata(master);
 772         pic32s->master = master;
 773
 774         ret = pic32_spi_hw_probe(pdev, pic32s);
 775         if (ret)
 776                 goto err_master;
 777
 778         master->dev.of_node     = of_node_get(pdev->dev.of_node);
 779         master->mode_bits       = SPI_MODE_3 | SPI_MODE_0 | SPI_CS_HIGH;
 780         master->num_chipselect  = 1; /* single chip-select */
 781         master->max_speed_hz    = clk_get_rate(pic32s->clk);
 782         master->setup           = pic32_spi_setup;
 783         master->cleanup         = pic32_spi_cleanup;
 784         master->flags           = SPI_MASTER_MUST_TX | SPI_MASTER_MUST_RX;
 785         master->bits_per_word_mask      = SPI_BPW_MASK(8) | SPI_BPW_MASK(16) |
 786                                           SPI_BPW_MASK(32);
 787         master->transfer_one            = pic32_spi_one_transfer;
 788         master->prepare_message         = pic32_spi_prepare_message;
 789         master->unprepare_message       = pic32_spi_unprepare_message;
 790         master->prepare_transfer_hardware       = pic32_spi_prepare_hardware;
 791         master->unprepare_transfer_hardware     = pic32_spi_unprepare_hardware;
 792
 793         /* optional DMA support */
 794         pic32_spi_dma_prep(pic32s, &pdev->dev);
 795         if (test_bit(PIC32F_DMA_PREP, &pic32s->flags))
 796                 master->can_dma = pic32_spi_can_dma;
 797
 798         init_completion(&pic32s->xfer_done);
 799         pic32s->mode = -1;
 800
 801         /* install irq handlers (with irq-disabled) */
 802         irq_set_status_flags(pic32s->fault_irq, IRQ_NOAUTOEN);
 803         ret = devm_request_irq(&pdev->dev, pic32s->fault_irq,
 804                                pic32_spi_fault_irq, IRQF_NO_THREAD,
 805                                dev_name(&pdev->dev), pic32s);
 806         if (ret < 0) {
 807                 dev_err(&pdev->dev, "request fault-irq %d\n", pic32s->rx_irq);
 808                 goto err_bailout;
 809         }
 810
 811         /* receive interrupt handler */
 812         irq_set_status_flags(pic32s->rx_irq, IRQ_NOAUTOEN);
 813         ret = devm_request_irq(&pdev->dev, pic32s->rx_irq,
 814                                pic32_spi_rx_irq, IRQF_NO_THREAD,
 815                                dev_name(&pdev->dev), pic32s);
 816         if (ret < 0) {
 817                 dev_err(&pdev->dev, "request rx-irq %d\n", pic32s->rx_irq);
 818                 goto err_bailout;
 819         }
 820
 821         /* transmit interrupt handler */
 822         irq_set_status_flags(pic32s->tx_irq, IRQ_NOAUTOEN);
 823         ret = devm_request_irq(&pdev->dev, pic32s->tx_irq,
 824                                pic32_spi_tx_irq, IRQF_NO_THREAD,
 825                                dev_name(&pdev->dev), pic32s);
 826         if (ret < 0) {
 827                 dev_err(&pdev->dev, "request tx-irq %d\n", pic32s->tx_irq);
 828                 goto err_bailout;
 829         }
 830
 831         /* register master */
 832         ret = devm_spi_register_master(&pdev->dev, master);
 833         if (ret) {
 834                 dev_err(&master->dev, "failed registering spi master\n");
 835                 goto err_bailout;
 836         }
 837
 838         platform_set_drvdata(pdev, pic32s);
 839
 840         return 0;
 841
 842 err_bailout:
 843         pic32_spi_dma_unprep(pic32s);
 844         clk_disable_unprepare(pic32s->clk);
 845 err_master:
 846         spi_master_put(master);
 847         return ret;
 848 }
 849
 850 static int pic32_spi_remove(struct platform_device *pdev)
 851 {
 852         struct pic32_spi *pic32s;
 853
 854         pic32s = platform_get_drvdata(pdev);
 855         pic32_spi_disable(pic32s);
 856         clk_disable_unprepare(pic32s->clk);
 857         pic32_spi_dma_unprep(pic32s);
 858
 859         return 0;
 860 }
 861
 862 static const struct of_device_id pic32_spi_of_match[] = {
 863         {.compatible = "microchip,pic32mzda-spi",},
 864         {},
 865 };
 866 MODULE_DEVICE_TABLE(of, pic32_spi_of_match);
 867
 868 static struct platform_driver pic32_spi_driver = {
 869         .driver = {
 870                 .name = "spi-pic32",
 871                 .of_match_table = of_match_ptr(pic32_spi_of_match),
 872         },
 873         .probe = pic32_spi_probe,
 874         .remove = pic32_spi_remove,
 875 };
 876
 877 module_platform_driver(pic32_spi_driver);
 878
 879 MODULE_AUTHOR("Purna Chandra Mandal <purna.mandal@microchip.com>");
 880 MODULE_DESCRIPTION("Microchip SPI driver for PIC32 SPI controller.");
 881 MODULE_LICENSE("GPL v2");