uboot/drivers/mmc/mxsmmc.c
<<
>>
Prefs
   1// SPDX-License-Identifier: GPL-2.0+
   2/*
   3 * Freescale i.MX28 SSP MMC driver
   4 *
   5 * Copyright (C) 2019 DENX Software Engineering
   6 * Lukasz Majewski, DENX Software Engineering, lukma@denx.de
   7 *
   8 * Copyright (C) 2011 Marek Vasut <marek.vasut@gmail.com>
   9 * on behalf of DENX Software Engineering GmbH
  10 *
  11 * Based on code from LTIB:
  12 * (C) Copyright 2008-2010 Freescale Semiconductor, Inc.
  13 * Terry Lv
  14 *
  15 * Copyright 2007, Freescale Semiconductor, Inc
  16 * Andy Fleming
  17 *
  18 * Based vaguely on the pxa mmc code:
  19 * (C) Copyright 2003
  20 * Kyle Harris, Nexus Technologies, Inc. kharris@nexus-tech.net
  21 */
  22
  23#include <common.h>
  24#include <log.h>
  25#include <malloc.h>
  26#include <mmc.h>
  27#include <linux/bitops.h>
  28#include <linux/delay.h>
  29#include <linux/errno.h>
  30#include <asm/io.h>
  31#include <asm/arch/clock.h>
  32#include <asm/arch/imx-regs.h>
  33#include <asm/arch/sys_proto.h>
  34#include <asm/mach-imx/dma.h>
  35#include <bouncebuf.h>
  36
  37#define MXSMMC_MAX_TIMEOUT      10000
  38#define MXSMMC_SMALL_TRANSFER   512
  39
  40#if !CONFIG_IS_ENABLED(DM_MMC)
  41struct mxsmmc_priv {
  42        int                     id;
  43        int                     (*mmc_is_wp)(int);
  44        int                     (*mmc_cd)(int);
  45        struct mmc_config       cfg;    /* mmc configuration */
  46        struct mxs_dma_desc     *desc;
  47        uint32_t                buswidth;
  48        struct mxs_ssp_regs     *regs;
  49};
  50#else /* CONFIG_IS_ENABLED(DM_MMC) */
  51#include <dm/device.h>
  52#include <dm/read.h>
  53#include <dt-structs.h>
  54
  55struct mxsmmc_plat {
  56#if CONFIG_IS_ENABLED(OF_PLATDATA)
  57        struct dtd_fsl_imx23_mmc dtplat;
  58#endif
  59        struct mmc_config cfg;
  60        struct mmc mmc;
  61        fdt_addr_t base;
  62        int non_removable;
  63        int buswidth;
  64        int dma_id;
  65        int clk_id;
  66};
  67
  68struct mxsmmc_priv {
  69        int clkid;
  70        struct mxs_dma_desc     *desc;
  71        u32                     buswidth;
  72        struct mxs_ssp_regs     *regs;
  73        unsigned int            dma_channel;
  74};
  75#endif
  76
  77#if !CONFIG_IS_ENABLED(DM_MMC)
  78static int mxsmmc_send_cmd(struct mmc *mmc, struct mmc_cmd *cmd,
  79                           struct mmc_data *data);
  80
  81static int mxsmmc_cd(struct mxsmmc_priv *priv)
  82{
  83        struct mxs_ssp_regs *ssp_regs = priv->regs;
  84
  85        if (priv->mmc_cd)
  86                return priv->mmc_cd(priv->id);
  87
  88        return !(readl(&ssp_regs->hw_ssp_status) & SSP_STATUS_CARD_DETECT);
  89}
  90
  91static int mxsmmc_set_ios(struct mmc *mmc)
  92{
  93        struct mxsmmc_priv *priv = mmc->priv;
  94        struct mxs_ssp_regs *ssp_regs = priv->regs;
  95
  96        /* Set the clock speed */
  97        if (mmc->clock)
  98                mxs_set_ssp_busclock(priv->id, mmc->clock / 1000);
  99
 100        switch (mmc->bus_width) {
 101        case 1:
 102                priv->buswidth = SSP_CTRL0_BUS_WIDTH_ONE_BIT;
 103                break;
 104        case 4:
 105                priv->buswidth = SSP_CTRL0_BUS_WIDTH_FOUR_BIT;
 106                break;
 107        case 8:
 108                priv->buswidth = SSP_CTRL0_BUS_WIDTH_EIGHT_BIT;
 109                break;
 110        }
 111
 112        /* Set the bus width */
 113        clrsetbits_le32(&ssp_regs->hw_ssp_ctrl0,
 114                        SSP_CTRL0_BUS_WIDTH_MASK, priv->buswidth);
 115
 116        debug("MMC%d: Set %d bits bus width\n",
 117              mmc->block_dev.devnum, mmc->bus_width);
 118
 119        return 0;
 120}
 121
 122static int mxsmmc_init(struct mmc *mmc)
 123{
 124        struct mxsmmc_priv *priv = mmc->priv;
 125        struct mxs_ssp_regs *ssp_regs = priv->regs;
 126
 127        /* Reset SSP */
 128        mxs_reset_block(&ssp_regs->hw_ssp_ctrl0_reg);
 129
 130        /* Reconfigure the SSP block for MMC operation */
 131        writel(SSP_CTRL1_SSP_MODE_SD_MMC |
 132                SSP_CTRL1_WORD_LENGTH_EIGHT_BITS |
 133                SSP_CTRL1_DMA_ENABLE |
 134                SSP_CTRL1_POLARITY |
 135                SSP_CTRL1_RECV_TIMEOUT_IRQ_EN |
 136                SSP_CTRL1_DATA_CRC_IRQ_EN |
 137                SSP_CTRL1_DATA_TIMEOUT_IRQ_EN |
 138                SSP_CTRL1_RESP_TIMEOUT_IRQ_EN |
 139                SSP_CTRL1_RESP_ERR_IRQ_EN,
 140                &ssp_regs->hw_ssp_ctrl1_set);
 141
 142        /* Set initial bit clock 400 KHz */
 143        mxs_set_ssp_busclock(priv->id, 400);
 144
 145        /* Send initial 74 clock cycles (185 us @ 400 KHz)*/
 146        writel(SSP_CMD0_CONT_CLKING_EN, &ssp_regs->hw_ssp_cmd0_set);
 147        udelay(200);
 148        writel(SSP_CMD0_CONT_CLKING_EN, &ssp_regs->hw_ssp_cmd0_clr);
 149
 150        return 0;
 151}
 152
 153static const struct mmc_ops mxsmmc_ops = {
 154        .send_cmd       = mxsmmc_send_cmd,
 155        .set_ios        = mxsmmc_set_ios,
 156        .init           = mxsmmc_init,
 157};
 158
 159int mxsmmc_initialize(struct bd_info *bis, int id, int (*wp)(int),
 160                      int (*cd)(int))
 161{
 162        struct mmc *mmc = NULL;
 163        struct mxsmmc_priv *priv = NULL;
 164        int ret;
 165        const unsigned int mxsmmc_clk_id = mxs_ssp_clock_by_bus(id);
 166
 167        if (!mxs_ssp_bus_id_valid(id))
 168                return -ENODEV;
 169
 170        priv = malloc(sizeof(struct mxsmmc_priv));
 171        if (!priv)
 172                return -ENOMEM;
 173
 174        priv->desc = mxs_dma_desc_alloc();
 175        if (!priv->desc) {
 176                free(priv);
 177                return -ENOMEM;
 178        }
 179
 180        ret = mxs_dma_init_channel(MXS_DMA_CHANNEL_AHB_APBH_SSP0 + id);
 181        if (ret)
 182                return ret;
 183
 184        priv->mmc_is_wp = wp;
 185        priv->mmc_cd = cd;
 186        priv->id = id;
 187        priv->regs = mxs_ssp_regs_by_bus(id);
 188
 189        priv->cfg.name = "MXS MMC";
 190        priv->cfg.ops = &mxsmmc_ops;
 191
 192        priv->cfg.voltages = MMC_VDD_32_33 | MMC_VDD_33_34;
 193
 194        priv->cfg.host_caps = MMC_MODE_4BIT | MMC_MODE_8BIT |
 195                         MMC_MODE_HS_52MHz | MMC_MODE_HS;
 196
 197        /*
 198         * SSPCLK = 480 * 18 / 29 / 1 = 297.731 MHz
 199         * SSP bit rate = SSPCLK / (CLOCK_DIVIDE * (1 + CLOCK_RATE)),
 200         * CLOCK_DIVIDE has to be an even value from 2 to 254, and
 201         * CLOCK_RATE could be any integer from 0 to 255.
 202         */
 203        priv->cfg.f_min = 400000;
 204        priv->cfg.f_max = mxc_get_clock(MXC_SSP0_CLK + mxsmmc_clk_id)
 205                * 1000 / 2;
 206        priv->cfg.b_max = 0x20;
 207
 208        mmc = mmc_create(&priv->cfg, priv);
 209        if (!mmc) {
 210                mxs_dma_desc_free(priv->desc);
 211                free(priv);
 212                return -ENOMEM;
 213        }
 214        return 0;
 215}
 216#endif /* CONFIG_IS_ENABLED(DM_MMC) */
 217
 218static int mxsmmc_send_cmd_pio(struct mxsmmc_priv *priv, struct mmc_data *data)
 219{
 220        struct mxs_ssp_regs *ssp_regs = priv->regs;
 221        uint32_t *data_ptr;
 222        int timeout = MXSMMC_MAX_TIMEOUT;
 223        uint32_t reg;
 224        uint32_t data_count = data->blocksize * data->blocks;
 225
 226        if (data->flags & MMC_DATA_READ) {
 227                data_ptr = (uint32_t *)data->dest;
 228                while (data_count && --timeout) {
 229                        reg = readl(&ssp_regs->hw_ssp_status);
 230                        if (!(reg & SSP_STATUS_FIFO_EMPTY)) {
 231                                *data_ptr++ = readl(&ssp_regs->hw_ssp_data);
 232                                data_count -= 4;
 233                                timeout = MXSMMC_MAX_TIMEOUT;
 234                        } else
 235                                udelay(1000);
 236                }
 237        } else {
 238                data_ptr = (uint32_t *)data->src;
 239                timeout *= 100;
 240                while (data_count && --timeout) {
 241                        reg = readl(&ssp_regs->hw_ssp_status);
 242                        if (!(reg & SSP_STATUS_FIFO_FULL)) {
 243                                writel(*data_ptr++, &ssp_regs->hw_ssp_data);
 244                                data_count -= 4;
 245                                timeout = MXSMMC_MAX_TIMEOUT;
 246                        } else
 247                                udelay(1000);
 248                }
 249        }
 250
 251        return timeout ? 0 : -ECOMM;
 252}
 253
 254static int mxsmmc_send_cmd_dma(struct mxsmmc_priv *priv, struct mmc_data *data)
 255{
 256        uint32_t data_count = data->blocksize * data->blocks;
 257        int dmach;
 258        struct mxs_dma_desc *desc = priv->desc;
 259        void *addr;
 260        unsigned int flags;
 261        struct bounce_buffer bbstate;
 262
 263        memset(desc, 0, sizeof(struct mxs_dma_desc));
 264        desc->address = (dma_addr_t)desc;
 265
 266        if (data->flags & MMC_DATA_READ) {
 267                priv->desc->cmd.data = MXS_DMA_DESC_COMMAND_DMA_WRITE;
 268                addr = data->dest;
 269                flags = GEN_BB_WRITE;
 270        } else {
 271                priv->desc->cmd.data = MXS_DMA_DESC_COMMAND_DMA_READ;
 272                addr = (void *)data->src;
 273                flags = GEN_BB_READ;
 274        }
 275
 276        bounce_buffer_start(&bbstate, addr, data_count, flags);
 277
 278        priv->desc->cmd.address = (dma_addr_t)bbstate.bounce_buffer;
 279
 280        priv->desc->cmd.data |= MXS_DMA_DESC_IRQ | MXS_DMA_DESC_DEC_SEM |
 281                                (data_count << MXS_DMA_DESC_BYTES_OFFSET);
 282
 283#if !CONFIG_IS_ENABLED(DM_MMC)
 284        dmach = MXS_DMA_CHANNEL_AHB_APBH_SSP0 + priv->id;
 285#else
 286        dmach = priv->dma_channel;
 287#endif
 288        mxs_dma_desc_append(dmach, priv->desc);
 289        if (mxs_dma_go(dmach)) {
 290                bounce_buffer_stop(&bbstate);
 291                return -ECOMM;
 292        }
 293
 294        bounce_buffer_stop(&bbstate);
 295
 296        return 0;
 297}
 298
 299#if !CONFIG_IS_ENABLED(DM_MMC)
 300/*
 301 * Sends a command out on the bus.  Takes the mmc pointer,
 302 * a command pointer, and an optional data pointer.
 303 */
 304static int
 305mxsmmc_send_cmd(struct mmc *mmc, struct mmc_cmd *cmd, struct mmc_data *data)
 306{
 307        struct mxsmmc_priv *priv = mmc->priv;
 308        struct mxs_ssp_regs *ssp_regs = priv->regs;
 309#else
 310static int
 311mxsmmc_send_cmd(struct udevice *dev, struct mmc_cmd *cmd, struct mmc_data *data)
 312{
 313        struct mxsmmc_plat *plat = dev_get_plat(dev);
 314        struct mxsmmc_priv *priv = dev_get_priv(dev);
 315        struct mxs_ssp_regs *ssp_regs = priv->regs;
 316        struct mmc *mmc = &plat->mmc;
 317#endif
 318        uint32_t reg;
 319        int timeout;
 320        uint32_t ctrl0;
 321        int ret;
 322#if !CONFIG_IS_ENABLED(DM_MMC)
 323        int devnum = mmc->block_dev.devnum;
 324#else
 325        int devnum = mmc_get_blk_desc(mmc)->devnum;
 326#endif
 327        debug("MMC%d: CMD%d\n", devnum, cmd->cmdidx);
 328
 329        /* Check bus busy */
 330        timeout = MXSMMC_MAX_TIMEOUT;
 331        while (--timeout) {
 332                udelay(1000);
 333                reg = readl(&ssp_regs->hw_ssp_status);
 334                if (!(reg &
 335                        (SSP_STATUS_BUSY | SSP_STATUS_DATA_BUSY |
 336                        SSP_STATUS_CMD_BUSY))) {
 337                        break;
 338                }
 339        }
 340
 341        if (!timeout) {
 342                printf("MMC%d: Bus busy timeout!\n", devnum);
 343                return -ETIMEDOUT;
 344        }
 345#if !CONFIG_IS_ENABLED(DM_MMC)
 346        /* See if card is present */
 347        if (!mxsmmc_cd(priv)) {
 348                printf("MMC%d: No card detected!\n", devnum);
 349                return -ENOMEDIUM;
 350        }
 351#endif
 352        /* Start building CTRL0 contents */
 353        ctrl0 = priv->buswidth;
 354
 355        /* Set up command */
 356        if (!(cmd->resp_type & MMC_RSP_CRC))
 357                ctrl0 |= SSP_CTRL0_IGNORE_CRC;
 358        if (cmd->resp_type & MMC_RSP_PRESENT)   /* Need to get response */
 359                ctrl0 |= SSP_CTRL0_GET_RESP;
 360        if (cmd->resp_type & MMC_RSP_136)       /* It's a 136 bits response */
 361                ctrl0 |= SSP_CTRL0_LONG_RESP;
 362
 363        if (data && (data->blocksize * data->blocks < MXSMMC_SMALL_TRANSFER))
 364                writel(SSP_CTRL1_DMA_ENABLE, &ssp_regs->hw_ssp_ctrl1_clr);
 365        else
 366                writel(SSP_CTRL1_DMA_ENABLE, &ssp_regs->hw_ssp_ctrl1_set);
 367
 368        /* Command index */
 369        reg = readl(&ssp_regs->hw_ssp_cmd0);
 370        reg &= ~(SSP_CMD0_CMD_MASK | SSP_CMD0_APPEND_8CYC);
 371        reg |= cmd->cmdidx << SSP_CMD0_CMD_OFFSET;
 372        if (cmd->cmdidx == MMC_CMD_STOP_TRANSMISSION)
 373                reg |= SSP_CMD0_APPEND_8CYC;
 374        writel(reg, &ssp_regs->hw_ssp_cmd0);
 375
 376        /* Command argument */
 377        writel(cmd->cmdarg, &ssp_regs->hw_ssp_cmd1);
 378
 379        /* Set up data */
 380        if (data) {
 381                /* READ or WRITE */
 382                if (data->flags & MMC_DATA_READ) {
 383                        ctrl0 |= SSP_CTRL0_READ;
 384#if !CONFIG_IS_ENABLED(DM_MMC)
 385                } else if (priv->mmc_is_wp &&
 386                        priv->mmc_is_wp(devnum)) {
 387                        printf("MMC%d: Can not write a locked card!\n", devnum);
 388                        return -EOPNOTSUPP;
 389#endif
 390                }
 391                ctrl0 |= SSP_CTRL0_DATA_XFER;
 392
 393                reg = data->blocksize * data->blocks;
 394#if defined(CONFIG_MX23)
 395                ctrl0 |= reg & SSP_CTRL0_XFER_COUNT_MASK;
 396
 397                clrsetbits_le32(&ssp_regs->hw_ssp_cmd0,
 398                        SSP_CMD0_BLOCK_SIZE_MASK | SSP_CMD0_BLOCK_COUNT_MASK,
 399                        ((data->blocks - 1) << SSP_CMD0_BLOCK_COUNT_OFFSET) |
 400                        ((ffs(data->blocksize) - 1) <<
 401                                SSP_CMD0_BLOCK_SIZE_OFFSET));
 402#elif defined(CONFIG_MX28)
 403                writel(reg, &ssp_regs->hw_ssp_xfer_size);
 404
 405                reg = ((data->blocks - 1) <<
 406                        SSP_BLOCK_SIZE_BLOCK_COUNT_OFFSET) |
 407                        ((ffs(data->blocksize) - 1) <<
 408                        SSP_BLOCK_SIZE_BLOCK_SIZE_OFFSET);
 409                writel(reg, &ssp_regs->hw_ssp_block_size);
 410#endif
 411        }
 412
 413        /* Kick off the command */
 414        ctrl0 |= SSP_CTRL0_WAIT_FOR_IRQ | SSP_CTRL0_ENABLE | SSP_CTRL0_RUN;
 415        writel(ctrl0, &ssp_regs->hw_ssp_ctrl0);
 416
 417        /* Wait for the command to complete */
 418        timeout = MXSMMC_MAX_TIMEOUT;
 419        while (--timeout) {
 420                udelay(1000);
 421                reg = readl(&ssp_regs->hw_ssp_status);
 422                if (!(reg & SSP_STATUS_CMD_BUSY))
 423                        break;
 424        }
 425
 426        if (!timeout) {
 427                printf("MMC%d: Command %d busy\n", devnum, cmd->cmdidx);
 428                return -ETIMEDOUT;
 429        }
 430
 431        /* Check command timeout */
 432        if (reg & SSP_STATUS_RESP_TIMEOUT) {
 433                debug("MMC%d: Command %d timeout (status 0x%08x)\n",
 434                      devnum, cmd->cmdidx, reg);
 435                return -ETIMEDOUT;
 436        }
 437
 438        /* Check command errors */
 439        if (reg & (SSP_STATUS_RESP_CRC_ERR | SSP_STATUS_RESP_ERR)) {
 440                printf("MMC%d: Command %d error (status 0x%08x)!\n",
 441                       devnum, cmd->cmdidx, reg);
 442                return -ECOMM;
 443        }
 444
 445        /* Copy response to response buffer */
 446        if (cmd->resp_type & MMC_RSP_136) {
 447                cmd->response[3] = readl(&ssp_regs->hw_ssp_sdresp0);
 448                cmd->response[2] = readl(&ssp_regs->hw_ssp_sdresp1);
 449                cmd->response[1] = readl(&ssp_regs->hw_ssp_sdresp2);
 450                cmd->response[0] = readl(&ssp_regs->hw_ssp_sdresp3);
 451        } else
 452                cmd->response[0] = readl(&ssp_regs->hw_ssp_sdresp0);
 453
 454        /* Return if no data to process */
 455        if (!data)
 456                return 0;
 457
 458        if (data->blocksize * data->blocks < MXSMMC_SMALL_TRANSFER) {
 459                ret = mxsmmc_send_cmd_pio(priv, data);
 460                if (ret) {
 461                        printf("MMC%d: Data timeout with command %d "
 462                                "(status 0x%08x)!\n", devnum, cmd->cmdidx, reg);
 463                        return ret;
 464                }
 465        } else {
 466                ret = mxsmmc_send_cmd_dma(priv, data);
 467                if (ret) {
 468                        printf("MMC%d: DMA transfer failed\n", devnum);
 469                        return ret;
 470                }
 471        }
 472
 473        /* Check data errors */
 474        reg = readl(&ssp_regs->hw_ssp_status);
 475        if (reg &
 476                (SSP_STATUS_TIMEOUT | SSP_STATUS_DATA_CRC_ERR |
 477                SSP_STATUS_FIFO_OVRFLW | SSP_STATUS_FIFO_UNDRFLW)) {
 478                printf("MMC%d: Data error with command %d (status 0x%08x)!\n",
 479                       devnum, cmd->cmdidx, reg);
 480                return -ECOMM;
 481        }
 482
 483        return 0;
 484}
 485
 486#if CONFIG_IS_ENABLED(DM_MMC)
 487/* Base numbers of i.MX2[38] clk for ssp0 IP block */
 488#define MXS_SSP_IMX23_CLKID_SSP0 33
 489#define MXS_SSP_IMX28_CLKID_SSP0 46
 490
 491static int mxsmmc_get_cd(struct udevice *dev)
 492{
 493        struct mxsmmc_plat *plat = dev_get_plat(dev);
 494        struct mxsmmc_priv *priv = dev_get_priv(dev);
 495        struct mxs_ssp_regs *ssp_regs = priv->regs;
 496
 497        if (plat->non_removable)
 498                return 1;
 499
 500        return !(readl(&ssp_regs->hw_ssp_status) & SSP_STATUS_CARD_DETECT);
 501}
 502
 503static int mxsmmc_set_ios(struct udevice *dev)
 504{
 505        struct mxsmmc_plat *plat = dev_get_plat(dev);
 506        struct mxsmmc_priv *priv = dev_get_priv(dev);
 507        struct mxs_ssp_regs *ssp_regs = priv->regs;
 508        struct mmc *mmc = &plat->mmc;
 509
 510        /* Set the clock speed */
 511        if (mmc->clock)
 512                mxs_set_ssp_busclock(priv->clkid, mmc->clock / 1000);
 513
 514        switch (mmc->bus_width) {
 515        case 1:
 516                priv->buswidth = SSP_CTRL0_BUS_WIDTH_ONE_BIT;
 517                break;
 518        case 4:
 519                priv->buswidth = SSP_CTRL0_BUS_WIDTH_FOUR_BIT;
 520                break;
 521        case 8:
 522                priv->buswidth = SSP_CTRL0_BUS_WIDTH_EIGHT_BIT;
 523                break;
 524        }
 525
 526        /* Set the bus width */
 527        clrsetbits_le32(&ssp_regs->hw_ssp_ctrl0,
 528                        SSP_CTRL0_BUS_WIDTH_MASK, priv->buswidth);
 529
 530        debug("MMC%d: Set %d bits bus width\n", mmc_get_blk_desc(mmc)->devnum,
 531              mmc->bus_width);
 532
 533        return 0;
 534}
 535
 536static int mxsmmc_init(struct udevice *dev)
 537{
 538        struct mxsmmc_priv *priv = dev_get_priv(dev);
 539        struct mxs_ssp_regs *ssp_regs = priv->regs;
 540
 541        /* Reset SSP */
 542        mxs_reset_block(&ssp_regs->hw_ssp_ctrl0_reg);
 543
 544        /* Reconfigure the SSP block for MMC operation */
 545        writel(SSP_CTRL1_SSP_MODE_SD_MMC |
 546                SSP_CTRL1_WORD_LENGTH_EIGHT_BITS |
 547                SSP_CTRL1_DMA_ENABLE |
 548                SSP_CTRL1_POLARITY |
 549                SSP_CTRL1_RECV_TIMEOUT_IRQ_EN |
 550                SSP_CTRL1_DATA_CRC_IRQ_EN |
 551                SSP_CTRL1_DATA_TIMEOUT_IRQ_EN |
 552                SSP_CTRL1_RESP_TIMEOUT_IRQ_EN |
 553                SSP_CTRL1_RESP_ERR_IRQ_EN,
 554                &ssp_regs->hw_ssp_ctrl1_set);
 555
 556        /* Set initial bit clock 400 KHz */
 557        mxs_set_ssp_busclock(priv->clkid, 400);
 558
 559        /* Send initial 74 clock cycles (185 us @ 400 KHz)*/
 560        writel(SSP_CMD0_CONT_CLKING_EN, &ssp_regs->hw_ssp_cmd0_set);
 561        udelay(200);
 562        writel(SSP_CMD0_CONT_CLKING_EN, &ssp_regs->hw_ssp_cmd0_clr);
 563
 564        return 0;
 565}
 566
 567static int mxsmmc_probe(struct udevice *dev)
 568{
 569        struct mmc_uclass_priv *upriv = dev_get_uclass_priv(dev);
 570        struct mxsmmc_plat *plat = dev_get_plat(dev);
 571        struct mxsmmc_priv *priv = dev_get_priv(dev);
 572        struct blk_desc *bdesc;
 573        struct mmc *mmc;
 574        int ret, clkid;
 575
 576        debug("%s: probe\n", __func__);
 577
 578#if CONFIG_IS_ENABLED(OF_PLATDATA)
 579        struct dtd_fsl_imx23_mmc *dtplat = &plat->dtplat;
 580        struct phandle_1_arg *p1a = &dtplat->clocks[0];
 581
 582        priv->buswidth = dtplat->bus_width;
 583        priv->regs = (struct mxs_ssp_regs *)dtplat->reg[0];
 584        priv->dma_channel = dtplat->dmas[1];
 585        clkid = p1a->arg[0];
 586        plat->non_removable = dtplat->non_removable;
 587
 588        debug("OF_PLATDATA: regs: 0x%p bw: %d clkid: %d non_removable: %d\n",
 589              priv->regs, priv->buswidth, clkid, plat->non_removable);
 590#else
 591        priv->regs = (struct mxs_ssp_regs *)plat->base;
 592        priv->dma_channel = plat->dma_id;
 593        clkid = plat->clk_id;
 594#endif
 595
 596#ifdef CONFIG_MX28
 597        priv->clkid = clkid - MXS_SSP_IMX28_CLKID_SSP0;
 598#else /* CONFIG_MX23 */
 599        priv->clkid = clkid - MXS_SSP_IMX23_CLKID_SSP0;
 600#endif
 601        mmc = &plat->mmc;
 602        mmc->cfg = &plat->cfg;
 603        mmc->dev = dev;
 604
 605        priv->desc = mxs_dma_desc_alloc();
 606        if (!priv->desc) {
 607                printf("%s: Cannot allocate DMA descriptor\n", __func__);
 608                return -ENOMEM;
 609        }
 610
 611        ret = mxs_dma_init_channel(priv->dma_channel);
 612        if (ret)
 613                return ret;
 614
 615        plat->cfg.name = "MXS MMC";
 616        plat->cfg.voltages = MMC_VDD_32_33 | MMC_VDD_33_34;
 617
 618        plat->cfg.host_caps = MMC_MODE_4BIT | MMC_MODE_8BIT |
 619                MMC_MODE_HS_52MHz | MMC_MODE_HS;
 620
 621        /*
 622         * SSPCLK = 480 * 18 / 29 / 1 = 297.731 MHz
 623         * SSP bit rate = SSPCLK / (CLOCK_DIVIDE * (1 + CLOCK_RATE)),
 624         * CLOCK_DIVIDE has to be an even value from 2 to 254, and
 625         * CLOCK_RATE could be any integer from 0 to 255.
 626         */
 627        plat->cfg.f_min = 400000;
 628        plat->cfg.f_max = mxc_get_clock(MXC_SSP0_CLK + priv->clkid) * 1000 / 2;
 629        plat->cfg.b_max = 0x20;
 630
 631        bdesc = mmc_get_blk_desc(mmc);
 632        if (!bdesc) {
 633                printf("%s: No block device descriptor!\n", __func__);
 634                return -ENODEV;
 635        }
 636
 637        if (plat->non_removable)
 638                bdesc->removable = 0;
 639
 640        ret = mxsmmc_init(dev);
 641        if (ret)
 642                printf("%s: MMC%d init error %d\n", __func__,
 643                       bdesc->devnum, ret);
 644
 645        /* Set the initial clock speed */
 646        mmc_set_clock(mmc, 400000, MMC_CLK_ENABLE);
 647
 648        upriv->mmc = mmc;
 649
 650        return 0;
 651};
 652
 653#if CONFIG_IS_ENABLED(BLK)
 654static int mxsmmc_bind(struct udevice *dev)
 655{
 656        struct mxsmmc_plat *plat = dev_get_plat(dev);
 657
 658        return mmc_bind(dev, &plat->mmc, &plat->cfg);
 659}
 660#endif
 661
 662static const struct dm_mmc_ops mxsmmc_ops = {
 663        .get_cd         = mxsmmc_get_cd,
 664        .send_cmd       = mxsmmc_send_cmd,
 665        .set_ios        = mxsmmc_set_ios,
 666};
 667
 668#if CONFIG_IS_ENABLED(OF_REAL)
 669static int mxsmmc_of_to_plat(struct udevice *bus)
 670{
 671        struct mxsmmc_plat *plat = dev_get_plat(bus);
 672        u32 prop[2];
 673        int ret;
 674
 675        plat->base = dev_read_addr(bus);
 676        plat->buswidth =
 677                dev_read_u32_default(bus, "bus-width", 1);
 678        plat->non_removable = dev_read_bool(bus, "non-removable");
 679
 680        ret = dev_read_u32_array(bus, "dmas", prop, ARRAY_SIZE(prop));
 681        if (ret) {
 682                printf("%s: Reading 'dmas' property failed!\n", __func__);
 683                return ret;
 684        }
 685        plat->dma_id = prop[1];
 686
 687        ret = dev_read_u32_array(bus, "clocks", prop, ARRAY_SIZE(prop));
 688        if (ret) {
 689                printf("%s: Reading 'clocks' property failed!\n", __func__);
 690                return ret;
 691        }
 692        plat->clk_id = prop[1];
 693
 694        debug("%s: base=0x%x, bus_width=%d %s dma_id=%d clk_id=%d\n",
 695              __func__, (uint)plat->base, plat->buswidth,
 696              plat->non_removable ? "non-removable" : NULL,
 697              plat->dma_id, plat->clk_id);
 698
 699        return 0;
 700}
 701
 702static const struct udevice_id mxsmmc_ids[] = {
 703        { .compatible = "fsl,imx23-mmc", },
 704        { .compatible = "fsl,imx28-mmc", },
 705        { /* sentinel */ }
 706};
 707#endif
 708
 709U_BOOT_DRIVER(fsl_imx23_mmc) = {
 710        .name = "fsl_imx23_mmc",
 711        .id     = UCLASS_MMC,
 712#if CONFIG_IS_ENABLED(OF_REAL)
 713        .of_match = mxsmmc_ids,
 714        .of_to_plat = mxsmmc_of_to_plat,
 715#endif
 716        .ops    = &mxsmmc_ops,
 717#if CONFIG_IS_ENABLED(BLK)
 718        .bind   = mxsmmc_bind,
 719#endif
 720        .probe  = mxsmmc_probe,
 721        .priv_auto      = sizeof(struct mxsmmc_priv),
 722        .plat_auto      = sizeof(struct mxsmmc_plat),
 723};
 724
 725DM_DRIVER_ALIAS(fsl_imx23_mmc, fsl_imx28_mmc)
 726#endif /* CONFIG_DM_MMC */
 727