drivers/mmc/omap_hsmmc.c

   1 /*
   2  * (C) Copyright 2008
   3  * Texas Instruments, <www.ti.com>
   4  * Sukumar Ghorai <s-ghorai@ti.com>
   5  *
   6  * See file CREDITS for list of people who contributed to this
   7  * project.
   8  *
   9  * This program is free software; you can redistribute it and/or
  10  * modify it under the terms of the GNU General Public License as
  11  * published by the Free Software Foundation's version 2 of
  12  * the License.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  * GNU General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU General Public License
  20  * along with this program; if not, write to the Free Software
  21  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  22  * MA 02111-1307 USA
  23  */
  24
  25 #include <config.h>
  26 #include <common.h>
  27 #include <malloc.h>
  28 #include <mmc.h>
  29 #include <part.h>
  30 #include <i2c.h>
  31 #include <twl4030.h>
  32 #include <twl6030.h>
  33 #include <palmas.h>
  34 #include <asm/gpio.h>
  35 #include <asm/io.h>
  36 #include <asm/arch/mmc_host_def.h>
  37 #include <asm/arch/sys_proto.h>
  38
  39 /* simplify defines to OMAP_HSMMC_USE_GPIO */
  40 #if (defined(CONFIG_OMAP_GPIO) && !defined(CONFIG_SPL_BUILD)) || \
  41         (defined(CONFIG_SPL_BUILD) && defined(CONFIG_SPL_GPIO_SUPPORT))
  42 #define OMAP_HSMMC_USE_GPIO
  43 #else
  44 #undef OMAP_HSMMC_USE_GPIO
  45 #endif
  46
  47 /* common definitions for all OMAPs */
  48 #define SYSCTL_SRC      (1 << 25)
  49 #define SYSCTL_SRD      (1 << 26)
  50
  51 struct omap_hsmmc_data {
  52         struct hsmmc *base_addr;
  53         struct mmc_config cfg;
  54 #ifdef OMAP_HSMMC_USE_GPIO
  55         int cd_gpio;
  56         int wp_gpio;
  57 #endif
  58 };
  59
  60 /* If we fail after 1 second wait, something is really bad */
  61 #define MAX_RETRY_MS    1000
  62
  63 static int mmc_read_data(struct hsmmc *mmc_base, char *buf, unsigned int size);
  64 static int mmc_write_data(struct hsmmc *mmc_base, const char *buf,
  65                         unsigned int siz);
  66
  67 #ifdef OMAP_HSMMC_USE_GPIO
  68 static int omap_mmc_setup_gpio_in(int gpio, const char *label)
  69 {
  70         int ret;
  71
  72 #ifndef CONFIG_DM_GPIO
  73         if (!gpio_is_valid(gpio))
  74                 return -1;
  75 #endif
  76         ret = gpio_request(gpio, label);
  77         if (ret)
  78                 return ret;
  79
  80         ret = gpio_direction_input(gpio);
  81         if (ret)
  82                 return ret;
  83
  84         return gpio;
  85 }
  86 #endif
  87
  88 #if defined(CONFIG_OMAP44XX) && defined(CONFIG_TWL6030_POWER)
  89 static void omap4_vmmc_pbias_config(struct mmc *mmc)
  90 {
  91         u32 value = 0;
  92
  93         value = readl((*ctrl)->control_pbiaslite);
  94         value &= ~(MMC1_PBIASLITE_PWRDNZ | MMC1_PWRDNZ);
  95         writel(value, (*ctrl)->control_pbiaslite);
  96         /* set VMMC to 3V */
  97         twl6030_power_mmc_init();
  98         value = readl((*ctrl)->control_pbiaslite);
  99         value |= MMC1_PBIASLITE_VMODE | MMC1_PBIASLITE_PWRDNZ | MMC1_PWRDNZ;
 100         writel(value, (*ctrl)->control_pbiaslite);
 101 }
 102 #endif
 103
 104 #if defined(CONFIG_OMAP54XX) && defined(CONFIG_PALMAS_POWER)
 105 static void omap5_pbias_config(struct mmc *mmc)
 106 {
 107         u32 value = 0;
 108
 109         value = readl((*ctrl)->control_pbias);
 110         value &= ~SDCARD_PWRDNZ;
 111         writel(value, (*ctrl)->control_pbias);
 112         udelay(10); /* wait 10 us */
 113         value &= ~SDCARD_BIAS_PWRDNZ;
 114         writel(value, (*ctrl)->control_pbias);
 115
 116         palmas_mmc1_poweron_ldo();
 117
 118         value = readl((*ctrl)->control_pbias);
 119         value |= SDCARD_BIAS_PWRDNZ;
 120         writel(value, (*ctrl)->control_pbias);
 121         udelay(150); /* wait 150 us */
 122         value |= SDCARD_PWRDNZ;
 123         writel(value, (*ctrl)->control_pbias);
 124         udelay(150); /* wait 150 us */
 125 }
 126 #endif
 127
 128 static unsigned char mmc_board_init(struct mmc *mmc)
 129 {
 130 #if defined(CONFIG_OMAP34XX)
 131         t2_t *t2_base = (t2_t *)T2_BASE;
 132         struct prcm *prcm_base = (struct prcm *)PRCM_BASE;
 133         u32 pbias_lite;
 134
 135         pbias_lite = readl(&t2_base->pbias_lite);
 136         pbias_lite &= ~(PBIASLITEPWRDNZ1 | PBIASLITEPWRDNZ0);
 137         writel(pbias_lite, &t2_base->pbias_lite);
 138 #endif
 139 #if defined(CONFIG_TWL4030_POWER)
 140         twl4030_power_mmc_init();
 141         mdelay(100);    /* ramp-up delay from Linux code */
 142 #endif
 143 #if defined(CONFIG_OMAP34XX)
 144         writel(pbias_lite | PBIASLITEPWRDNZ1 |
 145                 PBIASSPEEDCTRL0 | PBIASLITEPWRDNZ0,
 146                 &t2_base->pbias_lite);
 147
 148         writel(readl(&t2_base->devconf0) | MMCSDIO1ADPCLKISEL,
 149                 &t2_base->devconf0);
 150
 151         writel(readl(&t2_base->devconf1) | MMCSDIO2ADPCLKISEL,
 152                 &t2_base->devconf1);
 153
 154         /* Change from default of 52MHz to 26MHz if necessary */
 155         if (!(mmc->cfg->host_caps & MMC_MODE_HS_52MHz))
 156                 writel(readl(&t2_base->ctl_prog_io1) & ~CTLPROGIO1SPEEDCTRL,
 157                         &t2_base->ctl_prog_io1);
 158
 159         writel(readl(&prcm_base->fclken1_core) |
 160                 EN_MMC1 | EN_MMC2 | EN_MMC3,
 161                 &prcm_base->fclken1_core);
 162
 163         writel(readl(&prcm_base->iclken1_core) |
 164                 EN_MMC1 | EN_MMC2 | EN_MMC3,
 165                 &prcm_base->iclken1_core);
 166 #endif
 167
 168 #if defined(CONFIG_OMAP44XX) && defined(CONFIG_TWL6030_POWER)
 169         /* PBIAS config needed for MMC1 only */
 170         if (mmc->block_dev.dev == 0)
 171                 omap4_vmmc_pbias_config(mmc);
 172 #endif
 173 #if defined(CONFIG_OMAP54XX) && defined(CONFIG_PALMAS_POWER)
 174         if (mmc->block_dev.dev == 0)
 175                 omap5_pbias_config(mmc);
 176 #endif
 177
 178         return 0;
 179 }
 180
 181 void mmc_init_stream(struct hsmmc *mmc_base)
 182 {
 183         ulong start;
 184
 185         writel(readl(&mmc_base->con) | INIT_INITSTREAM, &mmc_base->con);
 186
 187         writel(MMC_CMD0, &mmc_base->cmd);
 188         start = get_timer(0);
 189         while (!(readl(&mmc_base->stat) & CC_MASK)) {
 190                 if (get_timer(0) - start > MAX_RETRY_MS) {
 191                         printf("%s: timedout waiting for cc!\n", __func__);
 192                         return;
 193                 }
 194         }
 195         writel(CC_MASK, &mmc_base->stat)
 196                 ;
 197         writel(MMC_CMD0, &mmc_base->cmd)
 198                 ;
 199         start = get_timer(0);
 200         while (!(readl(&mmc_base->stat) & CC_MASK)) {
 201                 if (get_timer(0) - start > MAX_RETRY_MS) {
 202                         printf("%s: timedout waiting for cc2!\n", __func__);
 203                         return;
 204                 }
 205         }
 206         writel(readl(&mmc_base->con) & ~INIT_INITSTREAM, &mmc_base->con);
 207 }
 208
 209
 210 static int omap_hsmmc_init_setup(struct mmc *mmc)
 211 {
 212         struct hsmmc *mmc_base;
 213         unsigned int reg_val;
 214         unsigned int dsor;
 215         ulong start;
 216
 217         mmc_base = ((struct omap_hsmmc_data *)mmc->priv)->base_addr;
 218         mmc_board_init(mmc);
 219
 220         writel(readl(&mmc_base->sysconfig) | MMC_SOFTRESET,
 221                 &mmc_base->sysconfig);
 222         start = get_timer(0);
 223         while ((readl(&mmc_base->sysstatus) & RESETDONE) == 0) {
 224                 if (get_timer(0) - start > MAX_RETRY_MS) {
 225                         printf("%s: timedout waiting for cc2!\n", __func__);
 226                         return TIMEOUT;
 227                 }
 228         }
 229         writel(readl(&mmc_base->sysctl) | SOFTRESETALL, &mmc_base->sysctl);
 230         start = get_timer(0);
 231         while ((readl(&mmc_base->sysctl) & SOFTRESETALL) != 0x0) {
 232                 if (get_timer(0) - start > MAX_RETRY_MS) {
 233                         printf("%s: timedout waiting for softresetall!\n",
 234                                 __func__);
 235                         return TIMEOUT;
 236                 }
 237         }
 238         writel(DTW_1_BITMODE | SDBP_PWROFF | SDVS_3V0, &mmc_base->hctl);
 239         writel(readl(&mmc_base->capa) | VS30_3V0SUP | VS18_1V8SUP,
 240                 &mmc_base->capa);
 241
 242         reg_val = readl(&mmc_base->con) & RESERVED_MASK;
 243
 244         writel(CTPL_MMC_SD | reg_val | WPP_ACTIVEHIGH | CDP_ACTIVEHIGH |
 245                 MIT_CTO | DW8_1_4BITMODE | MODE_FUNC | STR_BLOCK |
 246                 HR_NOHOSTRESP | INIT_NOINIT | NOOPENDRAIN, &mmc_base->con);
 247
 248         dsor = 240;
 249         mmc_reg_out(&mmc_base->sysctl, (ICE_MASK | DTO_MASK | CEN_MASK),
 250                 (ICE_STOP | DTO_15THDTO | CEN_DISABLE));
 251         mmc_reg_out(&mmc_base->sysctl, ICE_MASK | CLKD_MASK,
 252                 (dsor << CLKD_OFFSET) | ICE_OSCILLATE);
 253         start = get_timer(0);
 254         while ((readl(&mmc_base->sysctl) & ICS_MASK) == ICS_NOTREADY) {
 255                 if (get_timer(0) - start > MAX_RETRY_MS) {
 256                         printf("%s: timedout waiting for ics!\n", __func__);
 257                         return TIMEOUT;
 258                 }
 259         }
 260         writel(readl(&mmc_base->sysctl) | CEN_ENABLE, &mmc_base->sysctl);
 261
 262         writel(readl(&mmc_base->hctl) | SDBP_PWRON, &mmc_base->hctl);
 263
 264         writel(IE_BADA | IE_CERR | IE_DEB | IE_DCRC | IE_DTO | IE_CIE |
 265                 IE_CEB | IE_CCRC | IE_CTO | IE_BRR | IE_BWR | IE_TC | IE_CC,
 266                 &mmc_base->ie);
 267
 268         mmc_init_stream(mmc_base);
 269
 270         return 0;
 271 }
 272
 273 /*
 274  * MMC controller internal finite state machine reset
 275  *
 276  * Used to reset command or data internal state machines, using respectively
 277  * SRC or SRD bit of SYSCTL register
 278  */
 279 static void mmc_reset_controller_fsm(struct hsmmc *mmc_base, u32 bit)
 280 {
 281         ulong start;
 282
 283         mmc_reg_out(&mmc_base->sysctl, bit, bit);
 284
 285         /*
 286          * CMD(DAT) lines reset procedures are slightly different
 287          * for OMAP3 and OMAP4(AM335x,OMAP5,DRA7xx).
 288          * According to OMAP3 TRM:
 289          * Set SRC(SRD) bit in MMCHS_SYSCTL register to 0x1 and wait until it
 290          * returns to 0x0.
 291          * According to OMAP4(AM335x,OMAP5,DRA7xx) TRMs, CMD(DATA) lines reset
 292          * procedure steps must be as follows:
 293          * 1. Initiate CMD(DAT) line reset by writing 0x1 to SRC(SRD) bit in
 294          *    MMCHS_SYSCTL register (SD_SYSCTL for AM335x).
 295          * 2. Poll the SRC(SRD) bit until it is set to 0x1.
 296          * 3. Wait until the SRC (SRD) bit returns to 0x0
 297          *    (reset procedure is completed).
 298          */
 299 #if defined(CONFIG_OMAP44XX) || defined(CONFIG_OMAP54XX) || \
 300         defined(CONFIG_AM33XX)
 301         if (!(readl(&mmc_base->sysctl) & bit)) {
 302                 start = get_timer(0);
 303                 while (!(readl(&mmc_base->sysctl) & bit)) {
 304                         if (get_timer(0) - start > MAX_RETRY_MS)
 305                                 return;
 306                 }
 307         }
 308 #endif
 309         start = get_timer(0);
 310         while ((readl(&mmc_base->sysctl) & bit) != 0) {
 311                 if (get_timer(0) - start > MAX_RETRY_MS) {
 312                         printf("%s: timedout waiting for sysctl %x to clear\n",
 313                                 __func__, bit);
 314                         return;
 315                 }
 316         }
 317 }
 318
 319 static int omap_hsmmc_send_cmd(struct mmc *mmc, struct mmc_cmd *cmd,
 320                         struct mmc_data *data)
 321 {
 322         struct hsmmc *mmc_base;
 323         unsigned int flags, mmc_stat;
 324         ulong start;
 325
 326         mmc_base = ((struct omap_hsmmc_data *)mmc->priv)->base_addr;
 327         start = get_timer(0);
 328         while ((readl(&mmc_base->pstate) & (DATI_MASK | CMDI_MASK)) != 0) {
 329                 if (get_timer(0) - start > MAX_RETRY_MS) {
 330                         printf("%s: timedout waiting on cmd inhibit to clear\n",
 331                                         __func__);
 332                         return TIMEOUT;
 333                 }
 334         }
 335         writel(0xFFFFFFFF, &mmc_base->stat);
 336         start = get_timer(0);
 337         while (readl(&mmc_base->stat)) {
 338                 if (get_timer(0) - start > MAX_RETRY_MS) {
 339                         printf("%s: timedout waiting for STAT (%x) to clear\n",
 340                                 __func__, readl(&mmc_base->stat));
 341                         return TIMEOUT;
 342                 }
 343         }
 344         /*
 345          * CMDREG
 346          * CMDIDX[13:8] : Command index
 347          * DATAPRNT[5]  : Data Present Select
 348          * ENCMDIDX[4]  : Command Index Check Enable
 349          * ENCMDCRC[3]  : Command CRC Check Enable
 350          * RSPTYP[1:0]
 351          *      00 = No Response
 352          *      01 = Length 136
 353          *      10 = Length 48
 354          *      11 = Length 48 Check busy after response
 355          */
 356         /* Delay added before checking the status of frq change
 357          * retry not supported by mmc.c(core file)
 358          */
 359         if (cmd->cmdidx == SD_CMD_APP_SEND_SCR)
 360                 udelay(50000); /* wait 50 ms */
 361
 362         if (!(cmd->resp_type & MMC_RSP_PRESENT))
 363                 flags = 0;
 364         else if (cmd->resp_type & MMC_RSP_136)
 365                 flags = RSP_TYPE_LGHT136 | CICE_NOCHECK;
 366         else if (cmd->resp_type & MMC_RSP_BUSY)
 367                 flags = RSP_TYPE_LGHT48B;
 368         else
 369                 flags = RSP_TYPE_LGHT48;
 370
 371         /* enable default flags */
 372         flags = flags | (CMD_TYPE_NORMAL | CICE_NOCHECK | CCCE_NOCHECK |
 373                         MSBS_SGLEBLK | ACEN_DISABLE | BCE_DISABLE | DE_DISABLE);
 374
 375         if (cmd->resp_type & MMC_RSP_CRC)
 376                 flags |= CCCE_CHECK;
 377         if (cmd->resp_type & MMC_RSP_OPCODE)
 378                 flags |= CICE_CHECK;
 379
 380         if (data) {
 381                 if ((cmd->cmdidx == MMC_CMD_READ_MULTIPLE_BLOCK) ||
 382                          (cmd->cmdidx == MMC_CMD_WRITE_MULTIPLE_BLOCK)) {
 383                         flags |= (MSBS_MULTIBLK | BCE_ENABLE);
 384                         data->blocksize = 512;
 385                         writel(data->blocksize | (data->blocks << 16),
 386                                                         &mmc_base->blk);
 387                 } else
 388                         writel(data->blocksize | NBLK_STPCNT, &mmc_base->blk);
 389
 390                 if (data->flags & MMC_DATA_READ)
 391                         flags |= (DP_DATA | DDIR_READ);
 392                 else
 393                         flags |= (DP_DATA | DDIR_WRITE);
 394         }
 395
 396         writel(cmd->cmdarg, &mmc_base->arg);
 397         udelay(20);             /* To fix "No status update" error on eMMC */
 398         writel((cmd->cmdidx << 24) | flags, &mmc_base->cmd);
 399
 400         start = get_timer(0);
 401         do {
 402                 mmc_stat = readl(&mmc_base->stat);
 403                 if (get_timer(0) - start > MAX_RETRY_MS) {
 404                         printf("%s : timeout: No status update\n", __func__);
 405                         return TIMEOUT;
 406                 }
 407         } while (!mmc_stat);
 408
 409         if ((mmc_stat & IE_CTO) != 0) {
 410                 mmc_reset_controller_fsm(mmc_base, SYSCTL_SRC);
 411                 return TIMEOUT;
 412         } else if ((mmc_stat & ERRI_MASK) != 0)
 413                 return -1;
 414
 415         if (mmc_stat & CC_MASK) {
 416                 writel(CC_MASK, &mmc_base->stat);
 417                 if (cmd->resp_type & MMC_RSP_PRESENT) {
 418                         if (cmd->resp_type & MMC_RSP_136) {
 419                                 /* response type 2 */
 420                                 cmd->response[3] = readl(&mmc_base->rsp10);
 421                                 cmd->response[2] = readl(&mmc_base->rsp32);
 422                                 cmd->response[1] = readl(&mmc_base->rsp54);
 423                                 cmd->response[0] = readl(&mmc_base->rsp76);
 424                         } else
 425                                 /* response types 1, 1b, 3, 4, 5, 6 */
 426                                 cmd->response[0] = readl(&mmc_base->rsp10);
 427                 }
 428         }
 429
 430         if (data && (data->flags & MMC_DATA_READ)) {
 431                 mmc_read_data(mmc_base, data->dest,
 432                                 data->blocksize * data->blocks);
 433         } else if (data && (data->flags & MMC_DATA_WRITE)) {
 434                 mmc_write_data(mmc_base, data->src,
 435                                 data->blocksize * data->blocks);
 436         }
 437         return 0;
 438 }
 439
 440 static int mmc_read_data(struct hsmmc *mmc_base, char *buf, unsigned int size)
 441 {
 442         unsigned int *output_buf = (unsigned int *)buf;
 443         unsigned int mmc_stat;
 444         unsigned int count;
 445
 446         /*
 447          * Start Polled Read
 448          */
 449         count = (size > MMCSD_SECTOR_SIZE) ? MMCSD_SECTOR_SIZE : size;
 450         count /= 4;
 451
 452         while (size) {
 453                 ulong start = get_timer(0);
 454                 do {
 455                         mmc_stat = readl(&mmc_base->stat);
 456                         if (get_timer(0) - start > MAX_RETRY_MS) {
 457                                 printf("%s: timedout waiting for status!\n",
 458                                                 __func__);
 459                                 return TIMEOUT;
 460                         }
 461                 } while (mmc_stat == 0);
 462
 463                 if ((mmc_stat & (IE_DTO | IE_DCRC | IE_DEB)) != 0)
 464                         mmc_reset_controller_fsm(mmc_base, SYSCTL_SRD);
 465
 466                 if ((mmc_stat & ERRI_MASK) != 0)
 467                         return 1;
 468
 469                 if (mmc_stat & BRR_MASK) {
 470                         unsigned int k;
 471
 472                         writel(readl(&mmc_base->stat) | BRR_MASK,
 473                                 &mmc_base->stat);
 474                         for (k = 0; k < count; k++) {
 475                                 *output_buf = readl(&mmc_base->data);
 476                                 output_buf++;
 477                         }
 478                         size -= (count*4);
 479                 }
 480
 481                 if (mmc_stat & BWR_MASK)
 482                         writel(readl(&mmc_base->stat) | BWR_MASK,
 483                                 &mmc_base->stat);
 484
 485                 if (mmc_stat & TC_MASK) {
 486                         writel(readl(&mmc_base->stat) | TC_MASK,
 487                                 &mmc_base->stat);
 488                         break;
 489                 }
 490         }
 491         return 0;
 492 }
 493
 494 static int mmc_write_data(struct hsmmc *mmc_base, const char *buf,
 495                                 unsigned int size)
 496 {
 497         unsigned int *input_buf = (unsigned int *)buf;
 498         unsigned int mmc_stat;
 499         unsigned int count;
 500
 501         /*
 502          * Start Polled Write
 503          */
 504         count = (size > MMCSD_SECTOR_SIZE) ? MMCSD_SECTOR_SIZE : size;
 505         count /= 4;
 506
 507         while (size) {
 508                 ulong start = get_timer(0);
 509                 do {
 510                         mmc_stat = readl(&mmc_base->stat);
 511                         if (get_timer(0) - start > MAX_RETRY_MS) {
 512                                 printf("%s: timedout waiting for status!\n",
 513                                                 __func__);
 514                                 return TIMEOUT;
 515                         }
 516                 } while (mmc_stat == 0);
 517
 518                 if ((mmc_stat & (IE_DTO | IE_DCRC | IE_DEB)) != 0)
 519                         mmc_reset_controller_fsm(mmc_base, SYSCTL_SRD);
 520
 521                 if ((mmc_stat & ERRI_MASK) != 0)
 522                         return 1;
 523
 524                 if (mmc_stat & BWR_MASK) {
 525                         unsigned int k;
 526
 527                         writel(readl(&mmc_base->stat) | BWR_MASK,
 528                                         &mmc_base->stat);
 529                         for (k = 0; k < count; k++) {
 530                                 writel(*input_buf, &mmc_base->data);
 531                                 input_buf++;
 532                         }
 533                         size -= (count*4);
 534                 }
 535
 536                 if (mmc_stat & BRR_MASK)
 537                         writel(readl(&mmc_base->stat) | BRR_MASK,
 538                                 &mmc_base->stat);
 539
 540                 if (mmc_stat & TC_MASK) {
 541                         writel(readl(&mmc_base->stat) | TC_MASK,
 542                                 &mmc_base->stat);
 543                         break;
 544                 }
 545         }
 546         return 0;
 547 }
 548
 549 static void omap_hsmmc_set_ios(struct mmc *mmc)
 550 {
 551         struct hsmmc *mmc_base;
 552         unsigned int dsor = 0;
 553         ulong start;
 554
 555         mmc_base = ((struct omap_hsmmc_data *)mmc->priv)->base_addr;
 556         /* configue bus width */
 557         switch (mmc->bus_width) {
 558         case 8:
 559                 writel(readl(&mmc_base->con) | DTW_8_BITMODE,
 560                         &mmc_base->con);
 561                 break;
 562
 563         case 4:
 564                 writel(readl(&mmc_base->con) & ~DTW_8_BITMODE,
 565                         &mmc_base->con);
 566                 writel(readl(&mmc_base->hctl) | DTW_4_BITMODE,
 567                         &mmc_base->hctl);
 568                 break;
 569
 570         case 1:
 571         default:
 572                 writel(readl(&mmc_base->con) & ~DTW_8_BITMODE,
 573                         &mmc_base->con);
 574                 writel(readl(&mmc_base->hctl) & ~DTW_4_BITMODE,
 575                         &mmc_base->hctl);
 576                 break;
 577         }
 578
 579         /* configure clock with 96Mhz system clock.
 580          */
 581         if (mmc->clock != 0) {
 582                 dsor = (MMC_CLOCK_REFERENCE * 1000000 / mmc->clock);
 583                 if ((MMC_CLOCK_REFERENCE * 1000000) / dsor > mmc->clock)
 584                         dsor++;
 585         }
 586
 587         mmc_reg_out(&mmc_base->sysctl, (ICE_MASK | DTO_MASK | CEN_MASK),
 588                                 (ICE_STOP | DTO_15THDTO | CEN_DISABLE));
 589
 590         mmc_reg_out(&mmc_base->sysctl, ICE_MASK | CLKD_MASK,
 591                                 (dsor << CLKD_OFFSET) | ICE_OSCILLATE);
 592
 593         start = get_timer(0);
 594         while ((readl(&mmc_base->sysctl) & ICS_MASK) == ICS_NOTREADY) {
 595                 if (get_timer(0) - start > MAX_RETRY_MS) {
 596                         printf("%s: timedout waiting for ics!\n", __func__);
 597                         return;
 598                 }
 599         }
 600         writel(readl(&mmc_base->sysctl) | CEN_ENABLE, &mmc_base->sysctl);
 601 }
 602
 603 #ifdef OMAP_HSMMC_USE_GPIO
 604 static int omap_hsmmc_getcd(struct mmc *mmc)
 605 {
 606         struct omap_hsmmc_data *priv_data = mmc->priv;
 607         int cd_gpio;
 608
 609         /* if no CD return as 1 */
 610         cd_gpio = priv_data->cd_gpio;
 611         if (cd_gpio < 0)
 612                 return 1;
 613
 614         return gpio_get_value(cd_gpio);
 615 }
 616
 617 static int omap_hsmmc_getwp(struct mmc *mmc)
 618 {
 619         struct omap_hsmmc_data *priv_data = mmc->priv;
 620         int wp_gpio;
 621
 622         /* if no WP return as 0 */
 623         wp_gpio = priv_data->wp_gpio;
 624         if (wp_gpio < 0)
 625                 return 0;
 626
 627         return gpio_get_value(wp_gpio);
 628 }
 629 #endif
 630
 631 static const struct mmc_ops omap_hsmmc_ops = {
 632         .send_cmd       = omap_hsmmc_send_cmd,
 633         .set_ios        = omap_hsmmc_set_ios,
 634         .init           = omap_hsmmc_init_setup,
 635 #ifdef OMAP_HSMMC_USE_GPIO
 636         .getcd          = omap_hsmmc_getcd,
 637         .getwp          = omap_hsmmc_getwp,
 638 #endif
 639 };
 640
 641 int omap_mmc_init(int dev_index, uint host_caps_mask, uint f_max, int cd_gpio,
 642                 int wp_gpio)
 643 {
 644         struct mmc *mmc;
 645         struct omap_hsmmc_data *priv_data;
 646         struct mmc_config *cfg;
 647         uint host_caps_val;
 648
 649         priv_data = malloc(sizeof(*priv_data));
 650         if (priv_data == NULL)
 651                 return -1;
 652
 653         host_caps_val = MMC_MODE_4BIT | MMC_MODE_HS_52MHz | MMC_MODE_HS |
 654                              MMC_MODE_HC;
 655
 656         switch (dev_index) {
 657         case 0:
 658                 priv_data->base_addr = (struct hsmmc *)OMAP_HSMMC1_BASE;
 659                 break;
 660 #ifdef OMAP_HSMMC2_BASE
 661         case 1:
 662                 priv_data->base_addr = (struct hsmmc *)OMAP_HSMMC2_BASE;
 663 #if (defined(CONFIG_OMAP44XX) || defined(CONFIG_OMAP54XX) || \
 664      defined(CONFIG_DRA7XX)) && defined(CONFIG_HSMMC2_8BIT)
 665                 /* Enable 8-bit interface for eMMC on OMAP4/5 or DRA7XX */
 666                 host_caps_val |= MMC_MODE_8BIT;
 667 #endif
 668                 break;
 669 #endif
 670 #ifdef OMAP_HSMMC3_BASE
 671         case 2:
 672                 priv_data->base_addr = (struct hsmmc *)OMAP_HSMMC3_BASE;
 673 #if defined(CONFIG_DRA7XX) && defined(CONFIG_HSMMC3_8BIT)
 674                 /* Enable 8-bit interface for eMMC on DRA7XX */
 675                 host_caps_val |= MMC_MODE_8BIT;
 676 #endif
 677                 break;
 678 #endif
 679         default:
 680                 priv_data->base_addr = (struct hsmmc *)OMAP_HSMMC1_BASE;
 681                 return 1;
 682         }
 683 #ifdef OMAP_HSMMC_USE_GPIO
 684         /* on error gpio values are set to -1, which is what we want */
 685         priv_data->cd_gpio = omap_mmc_setup_gpio_in(cd_gpio, "mmc_cd");
 686         priv_data->wp_gpio = omap_mmc_setup_gpio_in(wp_gpio, "mmc_wp");
 687 #endif
 688
 689         cfg = &priv_data->cfg;
 690
 691         cfg->name = "OMAP SD/MMC";
 692         cfg->ops = &omap_hsmmc_ops;
 693
 694         cfg->voltages = MMC_VDD_32_33 | MMC_VDD_33_34 | MMC_VDD_165_195;
 695         cfg->host_caps = host_caps_val & ~host_caps_mask;
 696
 697         cfg->f_min = 400000;
 698
 699         if (f_max != 0)
 700                 cfg->f_max = f_max;
 701         else {
 702                 if (cfg->host_caps & MMC_MODE_HS) {
 703                         if (cfg->host_caps & MMC_MODE_HS_52MHz)
 704                                 cfg->f_max = 52000000;
 705                         else
 706                                 cfg->f_max = 26000000;
 707                 } else
 708                         cfg->f_max = 20000000;
 709         }
 710
 711         cfg->b_max = CONFIG_SYS_MMC_MAX_BLK_COUNT;
 712
 713 #if defined(CONFIG_OMAP34XX)
 714         /*
 715          * Silicon revs 2.1 and older do not support multiblock transfers.
 716          */
 717         if ((get_cpu_family() == CPU_OMAP34XX) && (get_cpu_rev() <= CPU_3XX_ES21))
 718                 cfg->b_max = 1;
 719 #endif
 720         mmc = mmc_create(cfg, priv_data);
 721         if (mmc == NULL)
 722                 return -1;
 723
 724         return 0;
 725 }