drivers/spi/fsl_dspi.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * (C) Copyright 2000-2003
   4  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   5  *
   6  * Copyright (C) 2004-2009, 2015 Freescale Semiconductor, Inc.
   7  * TsiChung Liew (Tsi-Chung.Liew@freescale.com)
   8  * Chao Fu (B44548@freescale.com)
   9  * Haikun Wang (B53464@freescale.com)
  10  */
  11
  12 #include <common.h>
  13 #include <dm.h>
  14 #include <errno.h>
  15 #include <common.h>
  16 #include <log.h>
  17 #include <spi.h>
  18 #include <malloc.h>
  19 #include <asm/io.h>
  20 #include <fdtdec.h>
  21 #ifndef CONFIG_M68K
  22 #include <asm/arch/clock.h>
  23 #endif
  24 #include <fsl_dspi.h>
  25
  26 DECLARE_GLOBAL_DATA_PTR;
  27
  28 /* fsl_dspi_platdata flags */
  29 #define DSPI_FLAG_REGMAP_ENDIAN_BIG     BIT(0)
  30
  31 /* idle data value */
  32 #define DSPI_IDLE_VAL                   0x0
  33
  34 /* max chipselect signals number */
  35 #define FSL_DSPI_MAX_CHIPSELECT         6
  36
  37 /* default SCK frequency, unit: HZ */
  38 #define FSL_DSPI_DEFAULT_SCK_FREQ       10000000
  39
  40 /* tx/rx data wait timeout value, unit: us */
  41 #define DSPI_TXRX_WAIT_TIMEOUT          1000000
  42
  43 /* CTAR register pre-configure value */
  44 #define DSPI_CTAR_DEFAULT_VALUE         (DSPI_CTAR_TRSZ(7) | \
  45                                         DSPI_CTAR_PCSSCK_1CLK | \
  46                                         DSPI_CTAR_PASC(0) | \
  47                                         DSPI_CTAR_PDT(0) | \
  48                                         DSPI_CTAR_CSSCK(0) | \
  49                                         DSPI_CTAR_ASC(0) | \
  50                                         DSPI_CTAR_DT(0))
  51
  52 /* CTAR register pre-configure mask */
  53 #define DSPI_CTAR_SET_MODE_MASK         (DSPI_CTAR_TRSZ(15) | \
  54                                         DSPI_CTAR_PCSSCK(3) | \
  55                                         DSPI_CTAR_PASC(3) | \
  56                                         DSPI_CTAR_PDT(3) | \
  57                                         DSPI_CTAR_CSSCK(15) | \
  58                                         DSPI_CTAR_ASC(15) | \
  59                                         DSPI_CTAR_DT(15))
  60
  61 /**
  62  * struct fsl_dspi_platdata - platform data for Freescale DSPI
  63  *
  64  * @flags: Flags for DSPI DSPI_FLAG_...
  65  * @speed_hz: Default SCK frequency
  66  * @num_chipselect: Number of DSPI chipselect signals
  67  * @regs_addr: Base address of DSPI registers
  68  */
  69 struct fsl_dspi_platdata {
  70         uint flags;
  71         uint speed_hz;
  72         uint num_chipselect;
  73         fdt_addr_t regs_addr;
  74 };
  75
  76 /**
  77  * struct fsl_dspi_priv - private data for Freescale DSPI
  78  *
  79  * @flags: Flags for DSPI DSPI_FLAG_...
  80  * @mode: SPI mode to use for slave device (see SPI mode flags)
  81  * @mcr_val: MCR register configure value
  82  * @bus_clk: DSPI input clk frequency
  83  * @speed_hz: Default SCK frequency
  84  * @charbit: How many bits in every transfer
  85  * @num_chipselect: Number of DSPI chipselect signals
  86  * @ctar_val: CTAR register configure value of per chipselect slave device
  87  * @regs: Point to DSPI register structure for I/O access
  88  */
  89 struct fsl_dspi_priv {
  90         uint flags;
  91         uint mode;
  92         uint mcr_val;
  93         uint bus_clk;
  94         uint speed_hz;
  95         uint charbit;
  96         uint num_chipselect;
  97         uint ctar_val[FSL_DSPI_MAX_CHIPSELECT];
  98         struct dspi *regs;
  99 };
 100
 101 #ifndef CONFIG_DM_SPI
 102 struct fsl_dspi {
 103         struct spi_slave slave;
 104         struct fsl_dspi_priv priv;
 105 };
 106 #endif
 107
 108 __weak void cpu_dspi_port_conf(void)
 109 {
 110 }
 111
 112 __weak int cpu_dspi_claim_bus(uint bus, uint cs)
 113 {
 114         return 0;
 115 }
 116
 117 __weak void cpu_dspi_release_bus(uint bus, uint cs)
 118 {
 119 }
 120
 121 static uint dspi_read32(uint flags, uint *addr)
 122 {
 123         return flags & DSPI_FLAG_REGMAP_ENDIAN_BIG ?
 124                 in_be32(addr) : in_le32(addr);
 125 }
 126
 127 static void dspi_write32(uint flags, uint *addr, uint val)
 128 {
 129         flags & DSPI_FLAG_REGMAP_ENDIAN_BIG ?
 130                 out_be32(addr, val) : out_le32(addr, val);
 131 }
 132
 133 static void dspi_halt(struct fsl_dspi_priv *priv, u8 halt)
 134 {
 135         uint mcr_val;
 136
 137         mcr_val = dspi_read32(priv->flags, &priv->regs->mcr);
 138
 139         if (halt)
 140                 mcr_val |= DSPI_MCR_HALT;
 141         else
 142                 mcr_val &= ~DSPI_MCR_HALT;
 143
 144         dspi_write32(priv->flags, &priv->regs->mcr, mcr_val);
 145 }
 146
 147 static void fsl_dspi_init_mcr(struct fsl_dspi_priv *priv, uint cfg_val)
 148 {
 149         /* halt DSPI module */
 150         dspi_halt(priv, 1);
 151
 152         dspi_write32(priv->flags, &priv->regs->mcr, cfg_val);
 153
 154         /* resume module */
 155         dspi_halt(priv, 0);
 156
 157         priv->mcr_val = cfg_val;
 158 }
 159
 160 static void fsl_dspi_cfg_cs_active_state(struct fsl_dspi_priv *priv,
 161                 uint cs, uint state)
 162 {
 163         uint mcr_val;
 164
 165         dspi_halt(priv, 1);
 166
 167         mcr_val = dspi_read32(priv->flags, &priv->regs->mcr);
 168         if (state & SPI_CS_HIGH)
 169                 /* CSx inactive state is low */
 170                 mcr_val &= ~DSPI_MCR_PCSIS(cs);
 171         else
 172                 /* CSx inactive state is high */
 173                 mcr_val |= DSPI_MCR_PCSIS(cs);
 174         dspi_write32(priv->flags, &priv->regs->mcr, mcr_val);
 175
 176         dspi_halt(priv, 0);
 177 }
 178
 179 static int fsl_dspi_cfg_ctar_mode(struct fsl_dspi_priv *priv,
 180                 uint cs, uint mode)
 181 {
 182         uint bus_setup;
 183
 184         bus_setup = dspi_read32(priv->flags, &priv->regs->ctar[0]);
 185
 186         bus_setup &= ~DSPI_CTAR_SET_MODE_MASK;
 187         bus_setup |= priv->ctar_val[cs];
 188         bus_setup &= ~(DSPI_CTAR_CPOL | DSPI_CTAR_CPHA | DSPI_CTAR_LSBFE);
 189
 190         if (mode & SPI_CPOL)
 191                 bus_setup |= DSPI_CTAR_CPOL;
 192         if (mode & SPI_CPHA)
 193                 bus_setup |= DSPI_CTAR_CPHA;
 194         if (mode & SPI_LSB_FIRST)
 195                 bus_setup |= DSPI_CTAR_LSBFE;
 196
 197         dspi_write32(priv->flags, &priv->regs->ctar[0], bus_setup);
 198
 199         priv->charbit =
 200                 ((dspi_read32(priv->flags, &priv->regs->ctar[0]) &
 201                   DSPI_CTAR_TRSZ(15)) == DSPI_CTAR_TRSZ(15)) ? 16 : 8;
 202
 203         return 0;
 204 }
 205
 206 static void fsl_dspi_clr_fifo(struct fsl_dspi_priv *priv)
 207 {
 208         uint mcr_val;
 209
 210         dspi_halt(priv, 1);
 211         mcr_val = dspi_read32(priv->flags, &priv->regs->mcr);
 212         /* flush RX and TX FIFO */
 213         mcr_val |= (DSPI_MCR_CTXF | DSPI_MCR_CRXF);
 214         dspi_write32(priv->flags, &priv->regs->mcr, mcr_val);
 215         dspi_halt(priv, 0);
 216 }
 217
 218 static void dspi_tx(struct fsl_dspi_priv *priv, u32 ctrl, u16 data)
 219 {
 220         int timeout = DSPI_TXRX_WAIT_TIMEOUT;
 221
 222         /* wait for empty entries in TXFIFO or timeout */
 223         while (DSPI_SR_TXCTR(dspi_read32(priv->flags, &priv->regs->sr)) >= 4 &&
 224                         timeout--)
 225                 udelay(1);
 226
 227         if (timeout >= 0)
 228                 dspi_write32(priv->flags, &priv->regs->tfr, (ctrl | data));
 229         else
 230                 debug("dspi_tx: waiting timeout!\n");
 231 }
 232
 233 static u16 dspi_rx(struct fsl_dspi_priv *priv)
 234 {
 235         int timeout = DSPI_TXRX_WAIT_TIMEOUT;
 236
 237         /* wait for valid entries in RXFIFO or timeout */
 238         while (DSPI_SR_RXCTR(dspi_read32(priv->flags, &priv->regs->sr)) == 0 &&
 239                         timeout--)
 240                 udelay(1);
 241
 242         if (timeout >= 0)
 243                 return (u16)DSPI_RFR_RXDATA(
 244                                 dspi_read32(priv->flags, &priv->regs->rfr));
 245         else {
 246                 debug("dspi_rx: waiting timeout!\n");
 247                 return (u16)(~0);
 248         }
 249 }
 250
 251 static int dspi_xfer(struct fsl_dspi_priv *priv, uint cs, unsigned int bitlen,
 252                 const void *dout, void *din, unsigned long flags)
 253 {
 254         u16 *spi_rd16 = NULL, *spi_wr16 = NULL;
 255         u8 *spi_rd = NULL, *spi_wr = NULL;
 256         static u32 ctrl;
 257         uint len = bitlen >> 3;
 258
 259         if (priv->charbit == 16) {
 260                 bitlen >>= 1;
 261                 spi_wr16 = (u16 *)dout;
 262                 spi_rd16 = (u16 *)din;
 263         } else {
 264                 spi_wr = (u8 *)dout;
 265                 spi_rd = (u8 *)din;
 266         }
 267
 268         if ((flags & SPI_XFER_BEGIN) == SPI_XFER_BEGIN)
 269                 ctrl |= DSPI_TFR_CONT;
 270
 271         ctrl = ctrl & DSPI_TFR_CONT;
 272         ctrl = ctrl | DSPI_TFR_CTAS(0) | DSPI_TFR_PCS(cs);
 273
 274         if (len > 1) {
 275                 int tmp_len = len - 1;
 276                 while (tmp_len--) {
 277                         if ((dout != NULL) && (din != NULL)) {
 278                                 if (priv->charbit == 16) {
 279                                         dspi_tx(priv, ctrl, *spi_wr16++);
 280                                         *spi_rd16++ = dspi_rx(priv);
 281                                 }
 282                                 else {
 283                                         dspi_tx(priv, ctrl, *spi_wr++);
 284                                         *spi_rd++ = dspi_rx(priv);
 285                                 }
 286                         }
 287
 288                         else if (dout != NULL) {
 289                                 if (priv->charbit == 16)
 290                                         dspi_tx(priv, ctrl, *spi_wr16++);
 291                                 else
 292                                         dspi_tx(priv, ctrl, *spi_wr++);
 293                                 dspi_rx(priv);
 294                         }
 295
 296                         else if (din != NULL) {
 297                                 dspi_tx(priv, ctrl, DSPI_IDLE_VAL);
 298                                 if (priv->charbit == 16)
 299                                         *spi_rd16++ = dspi_rx(priv);
 300                                 else
 301                                         *spi_rd++ = dspi_rx(priv);
 302                         }
 303                 }
 304
 305                 len = 1;        /* remaining byte */
 306         }
 307
 308         if ((flags & SPI_XFER_END) == SPI_XFER_END)
 309                 ctrl &= ~DSPI_TFR_CONT;
 310
 311         if (len) {
 312                 if ((dout != NULL) && (din != NULL)) {
 313                         if (priv->charbit == 16) {
 314                                 dspi_tx(priv, ctrl, *spi_wr16++);
 315                                 *spi_rd16++ = dspi_rx(priv);
 316                         }
 317                         else {
 318                                 dspi_tx(priv, ctrl, *spi_wr++);
 319                                 *spi_rd++ = dspi_rx(priv);
 320                         }
 321                 }
 322
 323                 else if (dout != NULL) {
 324                         if (priv->charbit == 16)
 325                                 dspi_tx(priv, ctrl, *spi_wr16);
 326                         else
 327                                 dspi_tx(priv, ctrl, *spi_wr);
 328                         dspi_rx(priv);
 329                 }
 330
 331                 else if (din != NULL) {
 332                         dspi_tx(priv, ctrl, DSPI_IDLE_VAL);
 333                         if (priv->charbit == 16)
 334                                 *spi_rd16 = dspi_rx(priv);
 335                         else
 336                                 *spi_rd = dspi_rx(priv);
 337                 }
 338         } else {
 339                 /* dummy read */
 340                 dspi_tx(priv, ctrl, DSPI_IDLE_VAL);
 341                 dspi_rx(priv);
 342         }
 343
 344         return 0;
 345 }
 346
 347 /**
 348  * Calculate the divide value between input clk frequency and expected SCK frequency
 349  * Formula: SCK = (clkrate/pbr) x ((1+dbr)/br)
 350  * Dbr: use default value 0
 351  *
 352  * @pbr: return Baud Rate Prescaler value
 353  * @br: return Baud Rate Scaler value
 354  * @speed_hz: expected SCK frequency
 355  * @clkrate: input clk frequency
 356  */
 357 static int fsl_dspi_hz_to_spi_baud(int *pbr, int *br,
 358                 int speed_hz, uint clkrate)
 359 {
 360         /* Valid baud rate pre-scaler values */
 361         int pbr_tbl[4] = {2, 3, 5, 7};
 362         int brs[16] = {2, 4, 6, 8,
 363                 16, 32, 64, 128,
 364                 256, 512, 1024, 2048,
 365                 4096, 8192, 16384, 32768};
 366         int temp, i = 0, j = 0;
 367
 368         temp = clkrate / speed_hz;
 369
 370         for (i = 0; i < ARRAY_SIZE(pbr_tbl); i++)
 371                 for (j = 0; j < ARRAY_SIZE(brs); j++) {
 372                         if (pbr_tbl[i] * brs[j] >= temp) {
 373                                 *pbr = i;
 374                                 *br = j;
 375                                 return 0;
 376                         }
 377                 }
 378
 379         debug("Can not find valid baud rate,speed_hz is %d, ", speed_hz);
 380         debug("clkrate is %d, we use the max prescaler value.\n", clkrate);
 381
 382         *pbr = ARRAY_SIZE(pbr_tbl) - 1;
 383         *br =  ARRAY_SIZE(brs) - 1;
 384         return -EINVAL;
 385 }
 386
 387 static int fsl_dspi_cfg_speed(struct fsl_dspi_priv *priv, uint speed)
 388 {
 389         int ret;
 390         uint bus_setup;
 391         int best_i, best_j, bus_clk;
 392
 393         bus_clk = priv->bus_clk;
 394
 395         debug("DSPI set_speed: expected SCK speed %u, bus_clk %u.\n",
 396               speed, bus_clk);
 397
 398         bus_setup = dspi_read32(priv->flags, &priv->regs->ctar[0]);
 399         bus_setup &= ~(DSPI_CTAR_DBR | DSPI_CTAR_PBR(0x3) | DSPI_CTAR_BR(0xf));
 400
 401         ret = fsl_dspi_hz_to_spi_baud(&best_i, &best_j, speed, bus_clk);
 402         if (ret) {
 403                 speed = priv->speed_hz;
 404                 debug("DSPI set_speed use default SCK rate %u.\n", speed);
 405                 fsl_dspi_hz_to_spi_baud(&best_i, &best_j, speed, bus_clk);
 406         }
 407
 408         bus_setup |= (DSPI_CTAR_PBR(best_i) | DSPI_CTAR_BR(best_j));
 409         dspi_write32(priv->flags, &priv->regs->ctar[0], bus_setup);
 410
 411         priv->speed_hz = speed;
 412
 413         return 0;
 414 }
 415 #ifndef CONFIG_DM_SPI
 416 int spi_cs_is_valid(unsigned int bus, unsigned int cs)
 417 {
 418         if (((cs >= 0) && (cs < 8)) && ((bus >= 0) && (bus < 8)))
 419                 return 1;
 420         else
 421                 return 0;
 422 }
 423
 424 struct spi_slave *spi_setup_slave(unsigned int bus, unsigned int cs,
 425                                   unsigned int max_hz, unsigned int mode)
 426 {
 427         struct fsl_dspi *dspi;
 428         uint mcr_cfg_val;
 429
 430         dspi = spi_alloc_slave(struct fsl_dspi, bus, cs);
 431         if (!dspi)
 432                 return NULL;
 433
 434         cpu_dspi_port_conf();
 435
 436 #ifdef CONFIG_SYS_FSL_DSPI_BE
 437         dspi->priv.flags |= DSPI_FLAG_REGMAP_ENDIAN_BIG;
 438 #endif
 439
 440         dspi->priv.regs = (struct dspi *)MMAP_DSPI;
 441
 442 #ifdef CONFIG_M68K
 443         dspi->priv.bus_clk = gd->bus_clk;
 444 #else
 445         dspi->priv.bus_clk = mxc_get_clock(MXC_DSPI_CLK);
 446 #endif
 447         dspi->priv.speed_hz = FSL_DSPI_DEFAULT_SCK_FREQ;
 448
 449         /* default: all CS signals inactive state is high */
 450         mcr_cfg_val = DSPI_MCR_MSTR | DSPI_MCR_PCSIS_MASK |
 451                 DSPI_MCR_CRXF | DSPI_MCR_CTXF;
 452         fsl_dspi_init_mcr(&dspi->priv, mcr_cfg_val);
 453
 454         for (i = 0; i < FSL_DSPI_MAX_CHIPSELECT; i++)
 455                 dspi->priv.ctar_val[i] = DSPI_CTAR_DEFAULT_VALUE;
 456
 457 #ifdef CONFIG_SYS_DSPI_CTAR0
 458         if (FSL_DSPI_MAX_CHIPSELECT > 0)
 459                 dspi->priv.ctar_val[0] = CONFIG_SYS_DSPI_CTAR0;
 460 #endif
 461 #ifdef CONFIG_SYS_DSPI_CTAR1
 462         if (FSL_DSPI_MAX_CHIPSELECT > 1)
 463                 dspi->priv.ctar_val[1] = CONFIG_SYS_DSPI_CTAR1;
 464 #endif
 465 #ifdef CONFIG_SYS_DSPI_CTAR2
 466         if (FSL_DSPI_MAX_CHIPSELECT > 2)
 467                 dspi->priv.ctar_val[2] = CONFIG_SYS_DSPI_CTAR2;
 468 #endif
 469 #ifdef CONFIG_SYS_DSPI_CTAR3
 470         if (FSL_DSPI_MAX_CHIPSELECT > 3)
 471                 dspi->priv.ctar_val[3] = CONFIG_SYS_DSPI_CTAR3;
 472 #endif
 473 #ifdef CONFIG_SYS_DSPI_CTAR4
 474         if (FSL_DSPI_MAX_CHIPSELECT > 4)
 475                 dspi->priv.ctar_val[4] = CONFIG_SYS_DSPI_CTAR4;
 476 #endif
 477 #ifdef CONFIG_SYS_DSPI_CTAR5
 478         if (FSL_DSPI_MAX_CHIPSELECT > 5)
 479                 dspi->priv.ctar_val[5] = CONFIG_SYS_DSPI_CTAR5;
 480 #endif
 481 #ifdef CONFIG_SYS_DSPI_CTAR6
 482         if (FSL_DSPI_MAX_CHIPSELECT > 6)
 483                 dspi->priv.ctar_val[6] = CONFIG_SYS_DSPI_CTAR6;
 484 #endif
 485 #ifdef CONFIG_SYS_DSPI_CTAR7
 486         if (FSL_DSPI_MAX_CHIPSELECT > 7)
 487                 dspi->priv.ctar_val[7] = CONFIG_SYS_DSPI_CTAR7;
 488 #endif
 489
 490         fsl_dspi_cfg_speed(&dspi->priv, max_hz);
 491
 492         /* configure transfer mode */
 493         fsl_dspi_cfg_ctar_mode(&dspi->priv, cs, mode);
 494
 495         /* configure active state of CSX */
 496         fsl_dspi_cfg_cs_active_state(&dspi->priv, cs, mode);
 497
 498         return &dspi->slave;
 499 }
 500
 501 void spi_free_slave(struct spi_slave *slave)
 502 {
 503         free(slave);
 504 }
 505
 506 int spi_claim_bus(struct spi_slave *slave)
 507 {
 508         uint sr_val;
 509         struct fsl_dspi *dspi = (struct fsl_dspi *)slave;
 510
 511         cpu_dspi_claim_bus(slave->bus, slave->cs);
 512
 513         fsl_dspi_clr_fifo(&dspi->priv);
 514
 515         /* check module TX and RX status */
 516         sr_val = dspi_read32(dspi->priv.flags, &dspi->priv.regs->sr);
 517         if ((sr_val & DSPI_SR_TXRXS) != DSPI_SR_TXRXS) {
 518                 debug("DSPI RX/TX not ready!\n");
 519                 return -EIO;
 520         }
 521
 522         return 0;
 523 }
 524
 525 void spi_release_bus(struct spi_slave *slave)
 526 {
 527         struct fsl_dspi *dspi = (struct fsl_dspi *)slave;
 528
 529         dspi_halt(&dspi->priv, 1);
 530         cpu_dspi_release_bus(slave->bus.slave->cs);
 531 }
 532
 533 int spi_xfer(struct spi_slave *slave, unsigned int bitlen, const void *dout,
 534              void *din, unsigned long flags)
 535 {
 536         struct fsl_dspi *dspi = (struct fsl_dspi *)slave;
 537         return dspi_xfer(&dspi->priv, slave->cs, bitlen, dout, din, flags);
 538 }
 539 #else
 540 static int fsl_dspi_child_pre_probe(struct udevice *dev)
 541 {
 542         struct dm_spi_slave_platdata *slave_plat = dev_get_parent_platdata(dev);
 543         struct fsl_dspi_priv *priv = dev_get_priv(dev->parent);
 544
 545         if (slave_plat->cs >= priv->num_chipselect) {
 546                 debug("DSPI invalid chipselect number %d(max %d)!\n",
 547                       slave_plat->cs, priv->num_chipselect - 1);
 548                 return -EINVAL;
 549         }
 550
 551         priv->ctar_val[slave_plat->cs] = DSPI_CTAR_DEFAULT_VALUE;
 552
 553         debug("DSPI pre_probe slave device on CS %u, max_hz %u, mode 0x%x.\n",
 554               slave_plat->cs, slave_plat->max_hz, slave_plat->mode);
 555
 556         return 0;
 557 }
 558
 559 static int fsl_dspi_probe(struct udevice *bus)
 560 {
 561         struct fsl_dspi_platdata *plat = dev_get_platdata(bus);
 562         struct fsl_dspi_priv *priv = dev_get_priv(bus);
 563         struct dm_spi_bus *dm_spi_bus;
 564         uint mcr_cfg_val;
 565
 566         dm_spi_bus = bus->uclass_priv;
 567
 568         /* cpu speical pin muxing configure */
 569         cpu_dspi_port_conf();
 570
 571         /* get input clk frequency */
 572         priv->regs = (struct dspi *)plat->regs_addr;
 573         priv->flags = plat->flags;
 574 #ifdef CONFIG_M68K
 575         priv->bus_clk = gd->bus_clk;
 576 #else
 577         priv->bus_clk = mxc_get_clock(MXC_DSPI_CLK);
 578 #endif
 579         priv->num_chipselect = plat->num_chipselect;
 580         priv->speed_hz = plat->speed_hz;
 581         /* frame data length in bits, default 8bits */
 582         priv->charbit = 8;
 583
 584         dm_spi_bus->max_hz = plat->speed_hz;
 585
 586         /* default: all CS signals inactive state is high */
 587         mcr_cfg_val = DSPI_MCR_MSTR | DSPI_MCR_PCSIS_MASK |
 588                 DSPI_MCR_CRXF | DSPI_MCR_CTXF;
 589         fsl_dspi_init_mcr(priv, mcr_cfg_val);
 590
 591         debug("%s probe done, bus-num %d.\n", bus->name, bus->seq);
 592
 593         return 0;
 594 }
 595
 596 static int fsl_dspi_claim_bus(struct udevice *dev)
 597 {
 598         uint sr_val;
 599         struct fsl_dspi_priv *priv;
 600         struct udevice *bus = dev->parent;
 601         struct dm_spi_slave_platdata *slave_plat =
 602                 dev_get_parent_platdata(dev);
 603
 604         priv = dev_get_priv(bus);
 605
 606         /* processor special preparation work */
 607         cpu_dspi_claim_bus(bus->seq, slave_plat->cs);
 608
 609         /* configure transfer mode */
 610         fsl_dspi_cfg_ctar_mode(priv, slave_plat->cs, priv->mode);
 611
 612         /* configure active state of CSX */
 613         fsl_dspi_cfg_cs_active_state(priv, slave_plat->cs,
 614                                      priv->mode);
 615
 616         fsl_dspi_clr_fifo(priv);
 617
 618         /* check module TX and RX status */
 619         sr_val = dspi_read32(priv->flags, &priv->regs->sr);
 620         if ((sr_val & DSPI_SR_TXRXS) != DSPI_SR_TXRXS) {
 621                 debug("DSPI RX/TX not ready!\n");
 622                 return -EIO;
 623         }
 624
 625         return 0;
 626 }
 627
 628 static int fsl_dspi_release_bus(struct udevice *dev)
 629 {
 630         struct udevice *bus = dev->parent;
 631         struct fsl_dspi_priv *priv = dev_get_priv(bus);
 632         struct dm_spi_slave_platdata *slave_plat =
 633                 dev_get_parent_platdata(dev);
 634
 635         /* halt module */
 636         dspi_halt(priv, 1);
 637
 638         /* processor special release work */
 639         cpu_dspi_release_bus(bus->seq, slave_plat->cs);
 640
 641         return 0;
 642 }
 643
 644 /**
 645  * This function doesn't do anything except help with debugging
 646  */
 647 static int fsl_dspi_bind(struct udevice *bus)
 648 {
 649         debug("%s assigned req_seq %d.\n", bus->name, bus->req_seq);
 650         return 0;
 651 }
 652
 653 static int fsl_dspi_ofdata_to_platdata(struct udevice *bus)
 654 {
 655         fdt_addr_t addr;
 656         struct fsl_dspi_platdata *plat = bus->platdata;
 657         const void *blob = gd->fdt_blob;
 658         int node = dev_of_offset(bus);
 659
 660         if (fdtdec_get_bool(blob, node, "big-endian"))
 661                 plat->flags |= DSPI_FLAG_REGMAP_ENDIAN_BIG;
 662
 663         plat->num_chipselect =
 664                 fdtdec_get_int(blob, node, "num-cs", FSL_DSPI_MAX_CHIPSELECT);
 665
 666         addr = devfdt_get_addr(bus);
 667         if (addr == FDT_ADDR_T_NONE) {
 668                 debug("DSPI: Can't get base address or size\n");
 669                 return -ENOMEM;
 670         }
 671         plat->regs_addr = addr;
 672
 673         plat->speed_hz = fdtdec_get_int(blob,
 674                         node, "spi-max-frequency", FSL_DSPI_DEFAULT_SCK_FREQ);
 675
 676         debug("DSPI: regs=%pa, max-frequency=%d, endianess=%s, num-cs=%d\n",
 677               &plat->regs_addr, plat->speed_hz,
 678               plat->flags & DSPI_FLAG_REGMAP_ENDIAN_BIG ? "be" : "le",
 679               plat->num_chipselect);
 680
 681         return 0;
 682 }
 683
 684 static int fsl_dspi_xfer(struct udevice *dev, unsigned int bitlen,
 685                 const void *dout, void *din, unsigned long flags)
 686 {
 687         struct fsl_dspi_priv *priv;
 688         struct dm_spi_slave_platdata *slave_plat = dev_get_parent_platdata(dev);
 689         struct udevice *bus;
 690
 691         bus = dev->parent;
 692         priv = dev_get_priv(bus);
 693
 694         return dspi_xfer(priv, slave_plat->cs, bitlen, dout, din, flags);
 695 }
 696
 697 static int fsl_dspi_set_speed(struct udevice *bus, uint speed)
 698 {
 699         struct fsl_dspi_priv *priv = dev_get_priv(bus);
 700
 701         return fsl_dspi_cfg_speed(priv, speed);
 702 }
 703
 704 static int fsl_dspi_set_mode(struct udevice *bus, uint mode)
 705 {
 706         struct fsl_dspi_priv *priv = dev_get_priv(bus);
 707
 708         debug("DSPI set_mode: mode 0x%x.\n", mode);
 709
 710         /*
 711          * We store some chipselect special configure value in priv->ctar_val,
 712          * and we can't get the correct chipselect number here,
 713          * so just store mode value.
 714          * Do really configuration when claim_bus.
 715          */
 716         priv->mode = mode;
 717
 718         return 0;
 719 }
 720
 721 static const struct dm_spi_ops fsl_dspi_ops = {
 722         .claim_bus      = fsl_dspi_claim_bus,
 723         .release_bus    = fsl_dspi_release_bus,
 724         .xfer           = fsl_dspi_xfer,
 725         .set_speed      = fsl_dspi_set_speed,
 726         .set_mode       = fsl_dspi_set_mode,
 727 };
 728
 729 static const struct udevice_id fsl_dspi_ids[] = {
 730         { .compatible = "fsl,vf610-dspi" },
 731         { }
 732 };
 733
 734 U_BOOT_DRIVER(fsl_dspi) = {
 735         .name   = "fsl_dspi",
 736         .id     = UCLASS_SPI,
 737         .of_match = fsl_dspi_ids,
 738         .ops    = &fsl_dspi_ops,
 739         .ofdata_to_platdata = fsl_dspi_ofdata_to_platdata,
 740         .platdata_auto_alloc_size = sizeof(struct fsl_dspi_platdata),
 741         .priv_auto_alloc_size = sizeof(struct fsl_dspi_priv),
 742         .probe  = fsl_dspi_probe,
 743         .child_pre_probe = fsl_dspi_child_pre_probe,
 744         .bind = fsl_dspi_bind,
 745 };
 746 #endif