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