drivers/mmc/mmc.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright 2008, Freescale Semiconductor, Inc
   4  * Andy Fleming
   5  *
   6  * Based vaguely on the Linux code
   7  */
   8
   9 #include <config.h>
  10 #include <common.h>
  11 #include <command.h>
  12 #include <dm.h>
  13 #include <dm/device-internal.h>
  14 #include <errno.h>
  15 #include <mmc.h>
  16 #include <part.h>
  17 #include <power/regulator.h>
  18 #include <malloc.h>
  19 #include <memalign.h>
  20 #include <linux/list.h>
  21 #include <div64.h>
  22 #include "mmc_private.h"
  23
  24 static int mmc_set_signal_voltage(struct mmc *mmc, uint signal_voltage);
  25 static int mmc_power_cycle(struct mmc *mmc);
  26 #if !CONFIG_IS_ENABLED(MMC_TINY)
  27 static int mmc_select_mode_and_width(struct mmc *mmc, uint card_caps);
  28 #endif
  29
  30 #if !CONFIG_IS_ENABLED(DM_MMC)
  31
  32 #if CONFIG_IS_ENABLED(MMC_UHS_SUPPORT)
  33 static int mmc_wait_dat0(struct mmc *mmc, int state, int timeout)
  34 {
  35         return -ENOSYS;
  36 }
  37 #endif
  38
  39 __weak int board_mmc_getwp(struct mmc *mmc)
  40 {
  41         return -1;
  42 }
  43
  44 int mmc_getwp(struct mmc *mmc)
  45 {
  46         int wp;
  47
  48         wp = board_mmc_getwp(mmc);
  49
  50         if (wp < 0) {
  51                 if (mmc->cfg->ops->getwp)
  52                         wp = mmc->cfg->ops->getwp(mmc);
  53                 else
  54                         wp = 0;
  55         }
  56
  57         return wp;
  58 }
  59
  60 __weak int board_mmc_getcd(struct mmc *mmc)
  61 {
  62         return -1;
  63 }
  64 #endif
  65
  66 #ifdef CONFIG_MMC_TRACE
  67 void mmmc_trace_before_send(struct mmc *mmc, struct mmc_cmd *cmd)
  68 {
  69         printf("CMD_SEND:%d\n", cmd->cmdidx);
  70         printf("\t\tARG\t\t\t 0x%08x\n", cmd->cmdarg);
  71 }
  72
  73 void mmmc_trace_after_send(struct mmc *mmc, struct mmc_cmd *cmd, int ret)
  74 {
  75         int i;
  76         u8 *ptr;
  77
  78         if (ret) {
  79                 printf("\t\tRET\t\t\t %d\n", ret);
  80         } else {
  81                 switch (cmd->resp_type) {
  82                 case MMC_RSP_NONE:
  83                         printf("\t\tMMC_RSP_NONE\n");
  84                         break;
  85                 case MMC_RSP_R1:
  86                         printf("\t\tMMC_RSP_R1,5,6,7 \t 0x%08x \n",
  87                                 cmd->response[0]);
  88                         break;
  89                 case MMC_RSP_R1b:
  90                         printf("\t\tMMC_RSP_R1b\t\t 0x%08x \n",
  91                                 cmd->response[0]);
  92                         break;
  93                 case MMC_RSP_R2:
  94                         printf("\t\tMMC_RSP_R2\t\t 0x%08x \n",
  95                                 cmd->response[0]);
  96                         printf("\t\t          \t\t 0x%08x \n",
  97                                 cmd->response[1]);
  98                         printf("\t\t          \t\t 0x%08x \n",
  99                                 cmd->response[2]);
 100                         printf("\t\t          \t\t 0x%08x \n",
 101                                 cmd->response[3]);
 102                         printf("\n");
 103                         printf("\t\t\t\t\tDUMPING DATA\n");
 104                         for (i = 0; i < 4; i++) {
 105                                 int j;
 106                                 printf("\t\t\t\t\t%03d - ", i*4);
 107                                 ptr = (u8 *)&cmd->response[i];
 108                                 ptr += 3;
 109                                 for (j = 0; j < 4; j++)
 110                                         printf("%02x ", *ptr--);
 111                                 printf("\n");
 112                         }
 113                         break;
 114                 case MMC_RSP_R3:
 115                         printf("\t\tMMC_RSP_R3,4\t\t 0x%08x \n",
 116                                 cmd->response[0]);
 117                         break;
 118                 default:
 119                         printf("\t\tERROR MMC rsp not supported\n");
 120                         break;
 121                 }
 122         }
 123 }
 124
 125 void mmc_trace_state(struct mmc *mmc, struct mmc_cmd *cmd)
 126 {
 127         int status;
 128
 129         status = (cmd->response[0] & MMC_STATUS_CURR_STATE) >> 9;
 130         printf("CURR STATE:%d\n", status);
 131 }
 132 #endif
 133
 134 #if CONFIG_IS_ENABLED(MMC_VERBOSE) || defined(DEBUG)
 135 const char *mmc_mode_name(enum bus_mode mode)
 136 {
 137         static const char *const names[] = {
 138               [MMC_LEGACY]      = "MMC legacy",
 139               [SD_LEGACY]       = "SD Legacy",
 140               [MMC_HS]          = "MMC High Speed (26MHz)",
 141               [SD_HS]           = "SD High Speed (50MHz)",
 142               [UHS_SDR12]       = "UHS SDR12 (25MHz)",
 143               [UHS_SDR25]       = "UHS SDR25 (50MHz)",
 144               [UHS_SDR50]       = "UHS SDR50 (100MHz)",
 145               [UHS_SDR104]      = "UHS SDR104 (208MHz)",
 146               [UHS_DDR50]       = "UHS DDR50 (50MHz)",
 147               [MMC_HS_52]       = "MMC High Speed (52MHz)",
 148               [MMC_DDR_52]      = "MMC DDR52 (52MHz)",
 149               [MMC_HS_200]      = "HS200 (200MHz)",
 150               [MMC_HS_400]      = "HS400 (200MHz)",
 151         };
 152
 153         if (mode >= MMC_MODES_END)
 154                 return "Unknown mode";
 155         else
 156                 return names[mode];
 157 }
 158 #endif
 159
 160 static uint mmc_mode2freq(struct mmc *mmc, enum bus_mode mode)
 161 {
 162         static const int freqs[] = {
 163               [MMC_LEGACY]      = 25000000,
 164               [SD_LEGACY]       = 25000000,
 165               [MMC_HS]          = 26000000,
 166               [SD_HS]           = 50000000,
 167               [MMC_HS_52]       = 52000000,
 168               [MMC_DDR_52]      = 52000000,
 169               [UHS_SDR12]       = 25000000,
 170               [UHS_SDR25]       = 50000000,
 171               [UHS_SDR50]       = 100000000,
 172               [UHS_DDR50]       = 50000000,
 173               [UHS_SDR104]      = 208000000,
 174               [MMC_HS_200]      = 200000000,
 175               [MMC_HS_400]      = 200000000,
 176         };
 177
 178         if (mode == MMC_LEGACY)
 179                 return mmc->legacy_speed;
 180         else if (mode >= MMC_MODES_END)
 181                 return 0;
 182         else
 183                 return freqs[mode];
 184 }
 185
 186 static int mmc_select_mode(struct mmc *mmc, enum bus_mode mode)
 187 {
 188         mmc->selected_mode = mode;
 189         mmc->tran_speed = mmc_mode2freq(mmc, mode);
 190         mmc->ddr_mode = mmc_is_mode_ddr(mode);
 191         pr_debug("selecting mode %s (freq : %d MHz)\n", mmc_mode_name(mode),
 192                  mmc->tran_speed / 1000000);
 193         return 0;
 194 }
 195
 196 #if !CONFIG_IS_ENABLED(DM_MMC)
 197 int mmc_send_cmd(struct mmc *mmc, struct mmc_cmd *cmd, struct mmc_data *data)
 198 {
 199         int ret;
 200
 201         mmmc_trace_before_send(mmc, cmd);
 202         ret = mmc->cfg->ops->send_cmd(mmc, cmd, data);
 203         mmmc_trace_after_send(mmc, cmd, ret);
 204
 205         return ret;
 206 }
 207 #endif
 208
 209 int mmc_send_status(struct mmc *mmc, int timeout)
 210 {
 211         struct mmc_cmd cmd;
 212         int err, retries = 5;
 213
 214         cmd.cmdidx = MMC_CMD_SEND_STATUS;
 215         cmd.resp_type = MMC_RSP_R1;
 216         if (!mmc_host_is_spi(mmc))
 217                 cmd.cmdarg = mmc->rca << 16;
 218
 219         while (1) {
 220                 err = mmc_send_cmd(mmc, &cmd, NULL);
 221                 if (!err) {
 222                         if ((cmd.response[0] & MMC_STATUS_RDY_FOR_DATA) &&
 223                             (cmd.response[0] & MMC_STATUS_CURR_STATE) !=
 224                              MMC_STATE_PRG)
 225                                 break;
 226
 227                         if (cmd.response[0] & MMC_STATUS_MASK) {
 228 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
 229                                 pr_err("Status Error: 0x%08x\n",
 230                                        cmd.response[0]);
 231 #endif
 232                                 return -ECOMM;
 233                         }
 234                 } else if (--retries < 0)
 235                         return err;
 236
 237                 if (timeout-- <= 0)
 238                         break;
 239
 240                 udelay(1000);
 241         }
 242
 243         mmc_trace_state(mmc, &cmd);
 244         if (timeout <= 0) {
 245 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
 246                 pr_err("Timeout waiting card ready\n");
 247 #endif
 248                 return -ETIMEDOUT;
 249         }
 250
 251         return 0;
 252 }
 253
 254 int mmc_set_blocklen(struct mmc *mmc, int len)
 255 {
 256         struct mmc_cmd cmd;
 257         int err;
 258
 259         if (mmc->ddr_mode)
 260                 return 0;
 261
 262         cmd.cmdidx = MMC_CMD_SET_BLOCKLEN;
 263         cmd.resp_type = MMC_RSP_R1;
 264         cmd.cmdarg = len;
 265
 266         err = mmc_send_cmd(mmc, &cmd, NULL);
 267
 268 #ifdef CONFIG_MMC_QUIRKS
 269         if (err && (mmc->quirks & MMC_QUIRK_RETRY_SET_BLOCKLEN)) {
 270                 int retries = 4;
 271                 /*
 272                  * It has been seen that SET_BLOCKLEN may fail on the first
 273                  * attempt, let's try a few more time
 274                  */
 275                 do {
 276                         err = mmc_send_cmd(mmc, &cmd, NULL);
 277                         if (!err)
 278                                 break;
 279                 } while (retries--);
 280         }
 281 #endif
 282
 283         return err;
 284 }
 285
 286 #ifdef MMC_SUPPORTS_TUNING
 287 static const u8 tuning_blk_pattern_4bit[] = {
 288         0xff, 0x0f, 0xff, 0x00, 0xff, 0xcc, 0xc3, 0xcc,
 289         0xc3, 0x3c, 0xcc, 0xff, 0xfe, 0xff, 0xfe, 0xef,
 290         0xff, 0xdf, 0xff, 0xdd, 0xff, 0xfb, 0xff, 0xfb,
 291         0xbf, 0xff, 0x7f, 0xff, 0x77, 0xf7, 0xbd, 0xef,
 292         0xff, 0xf0, 0xff, 0xf0, 0x0f, 0xfc, 0xcc, 0x3c,
 293         0xcc, 0x33, 0xcc, 0xcf, 0xff, 0xef, 0xff, 0xee,
 294         0xff, 0xfd, 0xff, 0xfd, 0xdf, 0xff, 0xbf, 0xff,
 295         0xbb, 0xff, 0xf7, 0xff, 0xf7, 0x7f, 0x7b, 0xde,
 296 };
 297
 298 static const u8 tuning_blk_pattern_8bit[] = {
 299         0xff, 0xff, 0x00, 0xff, 0xff, 0xff, 0x00, 0x00,
 300         0xff, 0xff, 0xcc, 0xcc, 0xcc, 0x33, 0xcc, 0xcc,
 301         0xcc, 0x33, 0x33, 0xcc, 0xcc, 0xcc, 0xff, 0xff,
 302         0xff, 0xee, 0xff, 0xff, 0xff, 0xee, 0xee, 0xff,
 303         0xff, 0xff, 0xdd, 0xff, 0xff, 0xff, 0xdd, 0xdd,
 304         0xff, 0xff, 0xff, 0xbb, 0xff, 0xff, 0xff, 0xbb,
 305         0xbb, 0xff, 0xff, 0xff, 0x77, 0xff, 0xff, 0xff,
 306         0x77, 0x77, 0xff, 0x77, 0xbb, 0xdd, 0xee, 0xff,
 307         0xff, 0xff, 0xff, 0x00, 0xff, 0xff, 0xff, 0x00,
 308         0x00, 0xff, 0xff, 0xcc, 0xcc, 0xcc, 0x33, 0xcc,
 309         0xcc, 0xcc, 0x33, 0x33, 0xcc, 0xcc, 0xcc, 0xff,
 310         0xff, 0xff, 0xee, 0xff, 0xff, 0xff, 0xee, 0xee,
 311         0xff, 0xff, 0xff, 0xdd, 0xff, 0xff, 0xff, 0xdd,
 312         0xdd, 0xff, 0xff, 0xff, 0xbb, 0xff, 0xff, 0xff,
 313         0xbb, 0xbb, 0xff, 0xff, 0xff, 0x77, 0xff, 0xff,
 314         0xff, 0x77, 0x77, 0xff, 0x77, 0xbb, 0xdd, 0xee,
 315 };
 316
 317 int mmc_send_tuning(struct mmc *mmc, u32 opcode, int *cmd_error)
 318 {
 319         struct mmc_cmd cmd;
 320         struct mmc_data data;
 321         const u8 *tuning_block_pattern;
 322         int size, err;
 323
 324         if (mmc->bus_width == 8) {
 325                 tuning_block_pattern = tuning_blk_pattern_8bit;
 326                 size = sizeof(tuning_blk_pattern_8bit);
 327         } else if (mmc->bus_width == 4) {
 328                 tuning_block_pattern = tuning_blk_pattern_4bit;
 329                 size = sizeof(tuning_blk_pattern_4bit);
 330         } else {
 331                 return -EINVAL;
 332         }
 333
 334         ALLOC_CACHE_ALIGN_BUFFER(u8, data_buf, size);
 335
 336         cmd.cmdidx = opcode;
 337         cmd.cmdarg = 0;
 338         cmd.resp_type = MMC_RSP_R1;
 339
 340         data.dest = (void *)data_buf;
 341         data.blocks = 1;
 342         data.blocksize = size;
 343         data.flags = MMC_DATA_READ;
 344
 345         err = mmc_send_cmd(mmc, &cmd, &data);
 346         if (err)
 347                 return err;
 348
 349         if (memcmp(data_buf, tuning_block_pattern, size))
 350                 return -EIO;
 351
 352         return 0;
 353 }
 354 #endif
 355
 356 static int mmc_read_blocks(struct mmc *mmc, void *dst, lbaint_t start,
 357                            lbaint_t blkcnt)
 358 {
 359         struct mmc_cmd cmd;
 360         struct mmc_data data;
 361
 362         if (blkcnt > 1)
 363                 cmd.cmdidx = MMC_CMD_READ_MULTIPLE_BLOCK;
 364         else
 365                 cmd.cmdidx = MMC_CMD_READ_SINGLE_BLOCK;
 366
 367         if (mmc->high_capacity)
 368                 cmd.cmdarg = start;
 369         else
 370                 cmd.cmdarg = start * mmc->read_bl_len;
 371
 372         cmd.resp_type = MMC_RSP_R1;
 373
 374         data.dest = dst;
 375         data.blocks = blkcnt;
 376         data.blocksize = mmc->read_bl_len;
 377         data.flags = MMC_DATA_READ;
 378
 379         if (mmc_send_cmd(mmc, &cmd, &data))
 380                 return 0;
 381
 382         if (blkcnt > 1) {
 383                 cmd.cmdidx = MMC_CMD_STOP_TRANSMISSION;
 384                 cmd.cmdarg = 0;
 385                 cmd.resp_type = MMC_RSP_R1b;
 386                 if (mmc_send_cmd(mmc, &cmd, NULL)) {
 387 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
 388                         pr_err("mmc fail to send stop cmd\n");
 389 #endif
 390                         return 0;
 391                 }
 392         }
 393
 394         return blkcnt;
 395 }
 396
 397 #if CONFIG_IS_ENABLED(BLK)
 398 ulong mmc_bread(struct udevice *dev, lbaint_t start, lbaint_t blkcnt, void *dst)
 399 #else
 400 ulong mmc_bread(struct blk_desc *block_dev, lbaint_t start, lbaint_t blkcnt,
 401                 void *dst)
 402 #endif
 403 {
 404 #if CONFIG_IS_ENABLED(BLK)
 405         struct blk_desc *block_dev = dev_get_uclass_platdata(dev);
 406 #endif
 407         int dev_num = block_dev->devnum;
 408         int err;
 409         lbaint_t cur, blocks_todo = blkcnt;
 410
 411         if (blkcnt == 0)
 412                 return 0;
 413
 414         struct mmc *mmc = find_mmc_device(dev_num);
 415         if (!mmc)
 416                 return 0;
 417
 418         if (CONFIG_IS_ENABLED(MMC_TINY))
 419                 err = mmc_switch_part(mmc, block_dev->hwpart);
 420         else
 421                 err = blk_dselect_hwpart(block_dev, block_dev->hwpart);
 422
 423         if (err < 0)
 424                 return 0;
 425
 426         if ((start + blkcnt) > block_dev->lba) {
 427 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
 428                 pr_err("MMC: block number 0x" LBAF " exceeds max(0x" LBAF ")\n",
 429                        start + blkcnt, block_dev->lba);
 430 #endif
 431                 return 0;
 432         }
 433
 434         if (mmc_set_blocklen(mmc, mmc->read_bl_len)) {
 435                 pr_debug("%s: Failed to set blocklen\n", __func__);
 436                 return 0;
 437         }
 438
 439         do {
 440                 cur = (blocks_todo > mmc->cfg->b_max) ?
 441                         mmc->cfg->b_max : blocks_todo;
 442                 if (mmc_read_blocks(mmc, dst, start, cur) != cur) {
 443                         pr_debug("%s: Failed to read blocks\n", __func__);
 444                         return 0;
 445                 }
 446                 blocks_todo -= cur;
 447                 start += cur;
 448                 dst += cur * mmc->read_bl_len;
 449         } while (blocks_todo > 0);
 450
 451         return blkcnt;
 452 }
 453
 454 static int mmc_go_idle(struct mmc *mmc)
 455 {
 456         struct mmc_cmd cmd;
 457         int err;
 458
 459         udelay(1000);
 460
 461         cmd.cmdidx = MMC_CMD_GO_IDLE_STATE;
 462         cmd.cmdarg = 0;
 463         cmd.resp_type = MMC_RSP_NONE;
 464
 465         err = mmc_send_cmd(mmc, &cmd, NULL);
 466
 467         if (err)
 468                 return err;
 469
 470         udelay(2000);
 471
 472         return 0;
 473 }
 474
 475 #if CONFIG_IS_ENABLED(MMC_UHS_SUPPORT)
 476 static int mmc_switch_voltage(struct mmc *mmc, int signal_voltage)
 477 {
 478         struct mmc_cmd cmd;
 479         int err = 0;
 480
 481         /*
 482          * Send CMD11 only if the request is to switch the card to
 483          * 1.8V signalling.
 484          */
 485         if (signal_voltage == MMC_SIGNAL_VOLTAGE_330)
 486                 return mmc_set_signal_voltage(mmc, signal_voltage);
 487
 488         cmd.cmdidx = SD_CMD_SWITCH_UHS18V;
 489         cmd.cmdarg = 0;
 490         cmd.resp_type = MMC_RSP_R1;
 491
 492         err = mmc_send_cmd(mmc, &cmd, NULL);
 493         if (err)
 494                 return err;
 495
 496         if (!mmc_host_is_spi(mmc) && (cmd.response[0] & MMC_STATUS_ERROR))
 497                 return -EIO;
 498
 499         /*
 500          * The card should drive cmd and dat[0:3] low immediately
 501          * after the response of cmd11, but wait 100 us to be sure
 502          */
 503         err = mmc_wait_dat0(mmc, 0, 100);
 504         if (err == -ENOSYS)
 505                 udelay(100);
 506         else if (err)
 507                 return -ETIMEDOUT;
 508
 509         /*
 510          * During a signal voltage level switch, the clock must be gated
 511          * for 5 ms according to the SD spec
 512          */
 513         mmc_set_clock(mmc, mmc->clock, MMC_CLK_DISABLE);
 514
 515         err = mmc_set_signal_voltage(mmc, signal_voltage);
 516         if (err)
 517                 return err;
 518
 519         /* Keep clock gated for at least 10 ms, though spec only says 5 ms */
 520         mdelay(10);
 521         mmc_set_clock(mmc, mmc->clock, MMC_CLK_ENABLE);
 522
 523         /*
 524          * Failure to switch is indicated by the card holding
 525          * dat[0:3] low. Wait for at least 1 ms according to spec
 526          */
 527         err = mmc_wait_dat0(mmc, 1, 1000);
 528         if (err == -ENOSYS)
 529                 udelay(1000);
 530         else if (err)
 531                 return -ETIMEDOUT;
 532
 533         return 0;
 534 }
 535 #endif
 536
 537 static int sd_send_op_cond(struct mmc *mmc, bool uhs_en)
 538 {
 539         int timeout = 1000;
 540         int err;
 541         struct mmc_cmd cmd;
 542
 543         while (1) {
 544                 cmd.cmdidx = MMC_CMD_APP_CMD;
 545                 cmd.resp_type = MMC_RSP_R1;
 546                 cmd.cmdarg = 0;
 547
 548                 err = mmc_send_cmd(mmc, &cmd, NULL);
 549
 550                 if (err)
 551                         return err;
 552
 553                 cmd.cmdidx = SD_CMD_APP_SEND_OP_COND;
 554                 cmd.resp_type = MMC_RSP_R3;
 555
 556                 /*
 557                  * Most cards do not answer if some reserved bits
 558                  * in the ocr are set. However, Some controller
 559                  * can set bit 7 (reserved for low voltages), but
 560                  * how to manage low voltages SD card is not yet
 561                  * specified.
 562                  */
 563                 cmd.cmdarg = mmc_host_is_spi(mmc) ? 0 :
 564                         (mmc->cfg->voltages & 0xff8000);
 565
 566                 if (mmc->version == SD_VERSION_2)
 567                         cmd.cmdarg |= OCR_HCS;
 568
 569                 if (uhs_en)
 570                         cmd.cmdarg |= OCR_S18R;
 571
 572                 err = mmc_send_cmd(mmc, &cmd, NULL);
 573
 574                 if (err)
 575                         return err;
 576
 577                 if (cmd.response[0] & OCR_BUSY)
 578                         break;
 579
 580                 if (timeout-- <= 0)
 581                         return -EOPNOTSUPP;
 582
 583                 udelay(1000);
 584         }
 585
 586         if (mmc->version != SD_VERSION_2)
 587                 mmc->version = SD_VERSION_1_0;
 588
 589         if (mmc_host_is_spi(mmc)) { /* read OCR for spi */
 590                 cmd.cmdidx = MMC_CMD_SPI_READ_OCR;
 591                 cmd.resp_type = MMC_RSP_R3;
 592                 cmd.cmdarg = 0;
 593
 594                 err = mmc_send_cmd(mmc, &cmd, NULL);
 595
 596                 if (err)
 597                         return err;
 598         }
 599
 600         mmc->ocr = cmd.response[0];
 601
 602 #if CONFIG_IS_ENABLED(MMC_UHS_SUPPORT)
 603         if (uhs_en && !(mmc_host_is_spi(mmc)) && (cmd.response[0] & 0x41000000)
 604             == 0x41000000) {
 605                 err = mmc_switch_voltage(mmc, MMC_SIGNAL_VOLTAGE_180);
 606                 if (err)
 607                         return err;
 608         }
 609 #endif
 610
 611         mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
 612         mmc->rca = 0;
 613
 614         return 0;
 615 }
 616
 617 static int mmc_send_op_cond_iter(struct mmc *mmc, int use_arg)
 618 {
 619         struct mmc_cmd cmd;
 620         int err;
 621
 622         cmd.cmdidx = MMC_CMD_SEND_OP_COND;
 623         cmd.resp_type = MMC_RSP_R3;
 624         cmd.cmdarg = 0;
 625         if (use_arg && !mmc_host_is_spi(mmc))
 626                 cmd.cmdarg = OCR_HCS |
 627                         (mmc->cfg->voltages &
 628                         (mmc->ocr & OCR_VOLTAGE_MASK)) |
 629                         (mmc->ocr & OCR_ACCESS_MODE);
 630
 631         err = mmc_send_cmd(mmc, &cmd, NULL);
 632         if (err)
 633                 return err;
 634         mmc->ocr = cmd.response[0];
 635         return 0;
 636 }
 637
 638 static int mmc_send_op_cond(struct mmc *mmc)
 639 {
 640         int err, i;
 641
 642         /* Some cards seem to need this */
 643         mmc_go_idle(mmc);
 644
 645         /* Asking to the card its capabilities */
 646         for (i = 0; i < 2; i++) {
 647                 err = mmc_send_op_cond_iter(mmc, i != 0);
 648                 if (err)
 649                         return err;
 650
 651                 /* exit if not busy (flag seems to be inverted) */
 652                 if (mmc->ocr & OCR_BUSY)
 653                         break;
 654         }
 655         mmc->op_cond_pending = 1;
 656         return 0;
 657 }
 658
 659 static int mmc_complete_op_cond(struct mmc *mmc)
 660 {
 661         struct mmc_cmd cmd;
 662         int timeout = 1000;
 663         ulong start;
 664         int err;
 665
 666         mmc->op_cond_pending = 0;
 667         if (!(mmc->ocr & OCR_BUSY)) {
 668                 /* Some cards seem to need this */
 669                 mmc_go_idle(mmc);
 670
 671                 start = get_timer(0);
 672                 while (1) {
 673                         err = mmc_send_op_cond_iter(mmc, 1);
 674                         if (err)
 675                                 return err;
 676                         if (mmc->ocr & OCR_BUSY)
 677                                 break;
 678                         if (get_timer(start) > timeout)
 679                                 return -EOPNOTSUPP;
 680                         udelay(100);
 681                 }
 682         }
 683
 684         if (mmc_host_is_spi(mmc)) { /* read OCR for spi */
 685                 cmd.cmdidx = MMC_CMD_SPI_READ_OCR;
 686                 cmd.resp_type = MMC_RSP_R3;
 687                 cmd.cmdarg = 0;
 688
 689                 err = mmc_send_cmd(mmc, &cmd, NULL);
 690
 691                 if (err)
 692                         return err;
 693
 694                 mmc->ocr = cmd.response[0];
 695         }
 696
 697         mmc->version = MMC_VERSION_UNKNOWN;
 698
 699         mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
 700         mmc->rca = 1;
 701
 702         return 0;
 703 }
 704
 705
 706 static int mmc_send_ext_csd(struct mmc *mmc, u8 *ext_csd)
 707 {
 708         struct mmc_cmd cmd;
 709         struct mmc_data data;
 710         int err;
 711
 712         /* Get the Card Status Register */
 713         cmd.cmdidx = MMC_CMD_SEND_EXT_CSD;
 714         cmd.resp_type = MMC_RSP_R1;
 715         cmd.cmdarg = 0;
 716
 717         data.dest = (char *)ext_csd;
 718         data.blocks = 1;
 719         data.blocksize = MMC_MAX_BLOCK_LEN;
 720         data.flags = MMC_DATA_READ;
 721
 722         err = mmc_send_cmd(mmc, &cmd, &data);
 723
 724         return err;
 725 }
 726
 727 static int __mmc_switch(struct mmc *mmc, u8 set, u8 index, u8 value,
 728                         bool send_status)
 729 {
 730         struct mmc_cmd cmd;
 731         int timeout = 1000;
 732         int retries = 3;
 733         int ret;
 734
 735         cmd.cmdidx = MMC_CMD_SWITCH;
 736         cmd.resp_type = MMC_RSP_R1b;
 737         cmd.cmdarg = (MMC_SWITCH_MODE_WRITE_BYTE << 24) |
 738                                  (index << 16) |
 739                                  (value << 8);
 740
 741         while (retries > 0) {
 742                 ret = mmc_send_cmd(mmc, &cmd, NULL);
 743
 744                 if (ret) {
 745                         retries--;
 746                         continue;
 747                 }
 748
 749                 if (!send_status) {
 750                         mdelay(50);
 751                         return 0;
 752                 }
 753
 754                 /* Waiting for the ready status */
 755                 return mmc_send_status(mmc, timeout);
 756         }
 757
 758         return ret;
 759
 760 }
 761
 762 int mmc_switch(struct mmc *mmc, u8 set, u8 index, u8 value)
 763 {
 764         return __mmc_switch(mmc, set, index, value, true);
 765 }
 766
 767 #if !CONFIG_IS_ENABLED(MMC_TINY)
 768 static int mmc_set_card_speed(struct mmc *mmc, enum bus_mode mode,
 769                               bool hsdowngrade)
 770 {
 771         int err;
 772         int speed_bits;
 773
 774         ALLOC_CACHE_ALIGN_BUFFER(u8, test_csd, MMC_MAX_BLOCK_LEN);
 775
 776         switch (mode) {
 777         case MMC_HS:
 778         case MMC_HS_52:
 779         case MMC_DDR_52:
 780                 speed_bits = EXT_CSD_TIMING_HS;
 781                 break;
 782 #if CONFIG_IS_ENABLED(MMC_HS200_SUPPORT)
 783         case MMC_HS_200:
 784                 speed_bits = EXT_CSD_TIMING_HS200;
 785                 break;
 786 #endif
 787 #if CONFIG_IS_ENABLED(MMC_HS400_SUPPORT)
 788         case MMC_HS_400:
 789                 speed_bits = EXT_CSD_TIMING_HS400;
 790                 break;
 791 #endif
 792         case MMC_LEGACY:
 793                 speed_bits = EXT_CSD_TIMING_LEGACY;
 794                 break;
 795         default:
 796                 return -EINVAL;
 797         }
 798
 799         err = __mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_HS_TIMING,
 800                            speed_bits, !hsdowngrade);
 801         if (err)
 802                 return err;
 803
 804 #if CONFIG_IS_ENABLED(MMC_HS200_SUPPORT) || \
 805     CONFIG_IS_ENABLED(MMC_HS400_SUPPORT)
 806         /*
 807          * In case the eMMC is in HS200/HS400 mode and we are downgrading
 808          * to HS mode, the card clock are still running much faster than
 809          * the supported HS mode clock, so we can not reliably read out
 810          * Extended CSD. Reconfigure the controller to run at HS mode.
 811          */
 812         if (hsdowngrade) {
 813                 mmc_select_mode(mmc, MMC_HS);
 814                 mmc_set_clock(mmc, mmc_mode2freq(mmc, MMC_HS), false);
 815         }
 816 #endif
 817
 818         if ((mode == MMC_HS) || (mode == MMC_HS_52)) {
 819                 /* Now check to see that it worked */
 820                 err = mmc_send_ext_csd(mmc, test_csd);
 821                 if (err)
 822                         return err;
 823
 824                 /* No high-speed support */
 825                 if (!test_csd[EXT_CSD_HS_TIMING])
 826                         return -ENOTSUPP;
 827         }
 828
 829         return 0;
 830 }
 831
 832 static int mmc_get_capabilities(struct mmc *mmc)
 833 {
 834         u8 *ext_csd = mmc->ext_csd;
 835         char cardtype;
 836
 837         mmc->card_caps = MMC_MODE_1BIT | MMC_CAP(MMC_LEGACY);
 838
 839         if (mmc_host_is_spi(mmc))
 840                 return 0;
 841
 842         /* Only version 4 supports high-speed */
 843         if (mmc->version < MMC_VERSION_4)
 844                 return 0;
 845
 846         if (!ext_csd) {
 847                 pr_err("No ext_csd found!\n"); /* this should enver happen */
 848                 return -ENOTSUPP;
 849         }
 850
 851         mmc->card_caps |= MMC_MODE_4BIT | MMC_MODE_8BIT;
 852
 853         cardtype = ext_csd[EXT_CSD_CARD_TYPE];
 854         mmc->cardtype = cardtype;
 855
 856 #if CONFIG_IS_ENABLED(MMC_HS200_SUPPORT)
 857         if (cardtype & (EXT_CSD_CARD_TYPE_HS200_1_2V |
 858                         EXT_CSD_CARD_TYPE_HS200_1_8V)) {
 859                 mmc->card_caps |= MMC_MODE_HS200;
 860         }
 861 #endif
 862 #if CONFIG_IS_ENABLED(MMC_HS400_SUPPORT)
 863         if (cardtype & (EXT_CSD_CARD_TYPE_HS400_1_2V |
 864                         EXT_CSD_CARD_TYPE_HS400_1_8V)) {
 865                 mmc->card_caps |= MMC_MODE_HS400;
 866         }
 867 #endif
 868         if (cardtype & EXT_CSD_CARD_TYPE_52) {
 869                 if (cardtype & EXT_CSD_CARD_TYPE_DDR_52)
 870                         mmc->card_caps |= MMC_MODE_DDR_52MHz;
 871                 mmc->card_caps |= MMC_MODE_HS_52MHz;
 872         }
 873         if (cardtype & EXT_CSD_CARD_TYPE_26)
 874                 mmc->card_caps |= MMC_MODE_HS;
 875
 876         return 0;
 877 }
 878 #endif
 879
 880 static int mmc_set_capacity(struct mmc *mmc, int part_num)
 881 {
 882         switch (part_num) {
 883         case 0:
 884                 mmc->capacity = mmc->capacity_user;
 885                 break;
 886         case 1:
 887         case 2:
 888                 mmc->capacity = mmc->capacity_boot;
 889                 break;
 890         case 3:
 891                 mmc->capacity = mmc->capacity_rpmb;
 892                 break;
 893         case 4:
 894         case 5:
 895         case 6:
 896         case 7:
 897                 mmc->capacity = mmc->capacity_gp[part_num - 4];
 898                 break;
 899         default:
 900                 return -1;
 901         }
 902
 903         mmc_get_blk_desc(mmc)->lba = lldiv(mmc->capacity, mmc->read_bl_len);
 904
 905         return 0;
 906 }
 907
 908 #if CONFIG_IS_ENABLED(MMC_HS200_SUPPORT)
 909 static int mmc_boot_part_access_chk(struct mmc *mmc, unsigned int part_num)
 910 {
 911         int forbidden = 0;
 912         bool change = false;
 913
 914         if (part_num & PART_ACCESS_MASK)
 915                 forbidden = MMC_CAP(MMC_HS_200);
 916
 917         if (MMC_CAP(mmc->selected_mode) & forbidden) {
 918                 pr_debug("selected mode (%s) is forbidden for part %d\n",
 919                          mmc_mode_name(mmc->selected_mode), part_num);
 920                 change = true;
 921         } else if (mmc->selected_mode != mmc->best_mode) {
 922                 pr_debug("selected mode is not optimal\n");
 923                 change = true;
 924         }
 925
 926         if (change)
 927                 return mmc_select_mode_and_width(mmc,
 928                                                  mmc->card_caps & ~forbidden);
 929
 930         return 0;
 931 }
 932 #else
 933 static inline int mmc_boot_part_access_chk(struct mmc *mmc,
 934                                            unsigned int part_num)
 935 {
 936         return 0;
 937 }
 938 #endif
 939
 940 int mmc_switch_part(struct mmc *mmc, unsigned int part_num)
 941 {
 942         int ret;
 943
 944         ret = mmc_boot_part_access_chk(mmc, part_num);
 945         if (ret)
 946                 return ret;
 947
 948         ret = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_PART_CONF,
 949                          (mmc->part_config & ~PART_ACCESS_MASK)
 950                          | (part_num & PART_ACCESS_MASK));
 951
 952         /*
 953          * Set the capacity if the switch succeeded or was intended
 954          * to return to representing the raw device.
 955          */
 956         if ((ret == 0) || ((ret == -ENODEV) && (part_num == 0))) {
 957                 ret = mmc_set_capacity(mmc, part_num);
 958                 mmc_get_blk_desc(mmc)->hwpart = part_num;
 959         }
 960
 961         return ret;
 962 }
 963
 964 #if CONFIG_IS_ENABLED(MMC_HW_PARTITIONING)
 965 int mmc_hwpart_config(struct mmc *mmc,
 966                       const struct mmc_hwpart_conf *conf,
 967                       enum mmc_hwpart_conf_mode mode)
 968 {
 969         u8 part_attrs = 0;
 970         u32 enh_size_mult;
 971         u32 enh_start_addr;
 972         u32 gp_size_mult[4];
 973         u32 max_enh_size_mult;
 974         u32 tot_enh_size_mult = 0;
 975         u8 wr_rel_set;
 976         int i, pidx, err;
 977         ALLOC_CACHE_ALIGN_BUFFER(u8, ext_csd, MMC_MAX_BLOCK_LEN);
 978
 979         if (mode < MMC_HWPART_CONF_CHECK || mode > MMC_HWPART_CONF_COMPLETE)
 980                 return -EINVAL;
 981
 982         if (IS_SD(mmc) || (mmc->version < MMC_VERSION_4_41)) {
 983                 pr_err("eMMC >= 4.4 required for enhanced user data area\n");
 984                 return -EMEDIUMTYPE;
 985         }
 986
 987         if (!(mmc->part_support & PART_SUPPORT)) {
 988                 pr_err("Card does not support partitioning\n");
 989                 return -EMEDIUMTYPE;
 990         }
 991
 992         if (!mmc->hc_wp_grp_size) {
 993                 pr_err("Card does not define HC WP group size\n");
 994                 return -EMEDIUMTYPE;
 995         }
 996
 997         /* check partition alignment and total enhanced size */
 998         if (conf->user.enh_size) {
 999                 if (conf->user.enh_size % mmc->hc_wp_grp_size ||
1000                     conf->user.enh_start % mmc->hc_wp_grp_size) {
1001                         pr_err("User data enhanced area not HC WP group "
1002                                "size aligned\n");
1003                         return -EINVAL;
1004                 }
1005                 part_attrs |= EXT_CSD_ENH_USR;
1006                 enh_size_mult = conf->user.enh_size / mmc->hc_wp_grp_size;
1007                 if (mmc->high_capacity) {
1008                         enh_start_addr = conf->user.enh_start;
1009                 } else {
1010                         enh_start_addr = (conf->user.enh_start << 9);
1011                 }
1012         } else {
1013                 enh_size_mult = 0;
1014                 enh_start_addr = 0;
1015         }
1016         tot_enh_size_mult += enh_size_mult;
1017
1018         for (pidx = 0; pidx < 4; pidx++) {
1019                 if (conf->gp_part[pidx].size % mmc->hc_wp_grp_size) {
1020                         pr_err("GP%i partition not HC WP group size "
1021                                "aligned\n", pidx+1);
1022                         return -EINVAL;
1023                 }
1024                 gp_size_mult[pidx] = conf->gp_part[pidx].size / mmc->hc_wp_grp_size;
1025                 if (conf->gp_part[pidx].size && conf->gp_part[pidx].enhanced) {
1026                         part_attrs |= EXT_CSD_ENH_GP(pidx);
1027                         tot_enh_size_mult += gp_size_mult[pidx];
1028                 }
1029         }
1030
1031         if (part_attrs && ! (mmc->part_support & ENHNCD_SUPPORT)) {
1032                 pr_err("Card does not support enhanced attribute\n");
1033                 return -EMEDIUMTYPE;
1034         }
1035
1036         err = mmc_send_ext_csd(mmc, ext_csd);
1037         if (err)
1038                 return err;
1039
1040         max_enh_size_mult =
1041                 (ext_csd[EXT_CSD_MAX_ENH_SIZE_MULT+2] << 16) +
1042                 (ext_csd[EXT_CSD_MAX_ENH_SIZE_MULT+1] << 8) +
1043                 ext_csd[EXT_CSD_MAX_ENH_SIZE_MULT];
1044         if (tot_enh_size_mult > max_enh_size_mult) {
1045                 pr_err("Total enhanced size exceeds maximum (%u > %u)\n",
1046                        tot_enh_size_mult, max_enh_size_mult);
1047                 return -EMEDIUMTYPE;
1048         }
1049
1050         /* The default value of EXT_CSD_WR_REL_SET is device
1051          * dependent, the values can only be changed if the
1052          * EXT_CSD_HS_CTRL_REL bit is set. The values can be
1053          * changed only once and before partitioning is completed. */
1054         wr_rel_set = ext_csd[EXT_CSD_WR_REL_SET];
1055         if (conf->user.wr_rel_change) {
1056                 if (conf->user.wr_rel_set)
1057                         wr_rel_set |= EXT_CSD_WR_DATA_REL_USR;
1058                 else
1059                         wr_rel_set &= ~EXT_CSD_WR_DATA_REL_USR;
1060         }
1061         for (pidx = 0; pidx < 4; pidx++) {
1062                 if (conf->gp_part[pidx].wr_rel_change) {
1063                         if (conf->gp_part[pidx].wr_rel_set)
1064                                 wr_rel_set |= EXT_CSD_WR_DATA_REL_GP(pidx);
1065                         else
1066                                 wr_rel_set &= ~EXT_CSD_WR_DATA_REL_GP(pidx);
1067                 }
1068         }
1069
1070         if (wr_rel_set != ext_csd[EXT_CSD_WR_REL_SET] &&
1071             !(ext_csd[EXT_CSD_WR_REL_PARAM] & EXT_CSD_HS_CTRL_REL)) {
1072                 puts("Card does not support host controlled partition write "
1073                      "reliability settings\n");
1074                 return -EMEDIUMTYPE;
1075         }
1076
1077         if (ext_csd[EXT_CSD_PARTITION_SETTING] &
1078             EXT_CSD_PARTITION_SETTING_COMPLETED) {
1079                 pr_err("Card already partitioned\n");
1080                 return -EPERM;
1081         }
1082
1083         if (mode == MMC_HWPART_CONF_CHECK)
1084                 return 0;
1085
1086         /* Partitioning requires high-capacity size definitions */
1087         if (!(ext_csd[EXT_CSD_ERASE_GROUP_DEF] & 0x01)) {
1088                 err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
1089                                  EXT_CSD_ERASE_GROUP_DEF, 1);
1090
1091                 if (err)
1092                         return err;
1093
1094                 ext_csd[EXT_CSD_ERASE_GROUP_DEF] = 1;
1095
1096                 /* update erase group size to be high-capacity */
1097                 mmc->erase_grp_size =
1098                         ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE] * 1024;
1099
1100         }
1101
1102         /* all OK, write the configuration */
1103         for (i = 0; i < 4; i++) {
1104                 err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
1105                                  EXT_CSD_ENH_START_ADDR+i,
1106                                  (enh_start_addr >> (i*8)) & 0xFF);
1107                 if (err)
1108                         return err;
1109         }
1110         for (i = 0; i < 3; i++) {
1111                 err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
1112                                  EXT_CSD_ENH_SIZE_MULT+i,
1113                                  (enh_size_mult >> (i*8)) & 0xFF);
1114                 if (err)
1115                         return err;
1116         }
1117         for (pidx = 0; pidx < 4; pidx++) {
1118                 for (i = 0; i < 3; i++) {
1119                         err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
1120                                          EXT_CSD_GP_SIZE_MULT+pidx*3+i,
1121                                          (gp_size_mult[pidx] >> (i*8)) & 0xFF);
1122                         if (err)
1123                                 return err;
1124                 }
1125         }
1126         err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
1127                          EXT_CSD_PARTITIONS_ATTRIBUTE, part_attrs);
1128         if (err)
1129                 return err;
1130
1131         if (mode == MMC_HWPART_CONF_SET)
1132                 return 0;
1133
1134         /* The WR_REL_SET is a write-once register but shall be
1135          * written before setting PART_SETTING_COMPLETED. As it is
1136          * write-once we can only write it when completing the
1137          * partitioning. */
1138         if (wr_rel_set != ext_csd[EXT_CSD_WR_REL_SET]) {
1139                 err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
1140                                  EXT_CSD_WR_REL_SET, wr_rel_set);
1141                 if (err)
1142                         return err;
1143         }
1144
1145         /* Setting PART_SETTING_COMPLETED confirms the partition
1146          * configuration but it only becomes effective after power
1147          * cycle, so we do not adjust the partition related settings
1148          * in the mmc struct. */
1149
1150         err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
1151                          EXT_CSD_PARTITION_SETTING,
1152                          EXT_CSD_PARTITION_SETTING_COMPLETED);
1153         if (err)
1154                 return err;
1155
1156         return 0;
1157 }
1158 #endif
1159
1160 #if !CONFIG_IS_ENABLED(DM_MMC)
1161 int mmc_getcd(struct mmc *mmc)
1162 {
1163         int cd;
1164
1165         cd = board_mmc_getcd(mmc);
1166
1167         if (cd < 0) {
1168                 if (mmc->cfg->ops->getcd)
1169                         cd = mmc->cfg->ops->getcd(mmc);
1170                 else
1171                         cd = 1;
1172         }
1173
1174         return cd;
1175 }
1176 #endif
1177
1178 #if !CONFIG_IS_ENABLED(MMC_TINY)
1179 static int sd_switch(struct mmc *mmc, int mode, int group, u8 value, u8 *resp)
1180 {
1181         struct mmc_cmd cmd;
1182         struct mmc_data data;
1183
1184         /* Switch the frequency */
1185         cmd.cmdidx = SD_CMD_SWITCH_FUNC;
1186         cmd.resp_type = MMC_RSP_R1;
1187         cmd.cmdarg = (mode << 31) | 0xffffff;
1188         cmd.cmdarg &= ~(0xf << (group * 4));
1189         cmd.cmdarg |= value << (group * 4);
1190
1191         data.dest = (char *)resp;
1192         data.blocksize = 64;
1193         data.blocks = 1;
1194         data.flags = MMC_DATA_READ;
1195
1196         return mmc_send_cmd(mmc, &cmd, &data);
1197 }
1198
1199 static int sd_get_capabilities(struct mmc *mmc)
1200 {
1201         int err;
1202         struct mmc_cmd cmd;
1203         ALLOC_CACHE_ALIGN_BUFFER(__be32, scr, 2);
1204         ALLOC_CACHE_ALIGN_BUFFER(__be32, switch_status, 16);
1205         struct mmc_data data;
1206         int timeout;
1207 #if CONFIG_IS_ENABLED(MMC_UHS_SUPPORT)
1208         u32 sd3_bus_mode;
1209 #endif
1210
1211         mmc->card_caps = MMC_MODE_1BIT | MMC_CAP(SD_LEGACY);
1212
1213         if (mmc_host_is_spi(mmc))
1214                 return 0;
1215
1216         /* Read the SCR to find out if this card supports higher speeds */
1217         cmd.cmdidx = MMC_CMD_APP_CMD;
1218         cmd.resp_type = MMC_RSP_R1;
1219         cmd.cmdarg = mmc->rca << 16;
1220
1221         err = mmc_send_cmd(mmc, &cmd, NULL);
1222
1223         if (err)
1224                 return err;
1225
1226         cmd.cmdidx = SD_CMD_APP_SEND_SCR;
1227         cmd.resp_type = MMC_RSP_R1;
1228         cmd.cmdarg = 0;
1229
1230         timeout = 3;
1231
1232 retry_scr:
1233         data.dest = (char *)scr;
1234         data.blocksize = 8;
1235         data.blocks = 1;
1236         data.flags = MMC_DATA_READ;
1237
1238         err = mmc_send_cmd(mmc, &cmd, &data);
1239
1240         if (err) {
1241                 if (timeout--)
1242                         goto retry_scr;
1243
1244                 return err;
1245         }
1246
1247         mmc->scr[0] = __be32_to_cpu(scr[0]);
1248         mmc->scr[1] = __be32_to_cpu(scr[1]);
1249
1250         switch ((mmc->scr[0] >> 24) & 0xf) {
1251         case 0:
1252                 mmc->version = SD_VERSION_1_0;
1253                 break;
1254         case 1:
1255                 mmc->version = SD_VERSION_1_10;
1256                 break;
1257         case 2:
1258                 mmc->version = SD_VERSION_2;
1259                 if ((mmc->scr[0] >> 15) & 0x1)
1260                         mmc->version = SD_VERSION_3;
1261                 break;
1262         default:
1263                 mmc->version = SD_VERSION_1_0;
1264                 break;
1265         }
1266
1267         if (mmc->scr[0] & SD_DATA_4BIT)
1268                 mmc->card_caps |= MMC_MODE_4BIT;
1269
1270         /* Version 1.0 doesn't support switching */
1271         if (mmc->version == SD_VERSION_1_0)
1272                 return 0;
1273
1274         timeout = 4;
1275         while (timeout--) {
1276                 err = sd_switch(mmc, SD_SWITCH_CHECK, 0, 1,
1277                                 (u8 *)switch_status);
1278
1279                 if (err)
1280                         return err;
1281
1282                 /* The high-speed function is busy.  Try again */
1283                 if (!(__be32_to_cpu(switch_status[7]) & SD_HIGHSPEED_BUSY))
1284                         break;
1285         }
1286
1287         /* If high-speed isn't supported, we return */
1288         if (__be32_to_cpu(switch_status[3]) & SD_HIGHSPEED_SUPPORTED)
1289                 mmc->card_caps |= MMC_CAP(SD_HS);
1290
1291 #if CONFIG_IS_ENABLED(MMC_UHS_SUPPORT)
1292         /* Version before 3.0 don't support UHS modes */
1293         if (mmc->version < SD_VERSION_3)
1294                 return 0;
1295
1296         sd3_bus_mode = __be32_to_cpu(switch_status[3]) >> 16 & 0x1f;
1297         if (sd3_bus_mode & SD_MODE_UHS_SDR104)
1298                 mmc->card_caps |= MMC_CAP(UHS_SDR104);
1299         if (sd3_bus_mode & SD_MODE_UHS_SDR50)
1300                 mmc->card_caps |= MMC_CAP(UHS_SDR50);
1301         if (sd3_bus_mode & SD_MODE_UHS_SDR25)
1302                 mmc->card_caps |= MMC_CAP(UHS_SDR25);
1303         if (sd3_bus_mode & SD_MODE_UHS_SDR12)
1304                 mmc->card_caps |= MMC_CAP(UHS_SDR12);
1305         if (sd3_bus_mode & SD_MODE_UHS_DDR50)
1306                 mmc->card_caps |= MMC_CAP(UHS_DDR50);
1307 #endif
1308
1309         return 0;
1310 }
1311
1312 static int sd_set_card_speed(struct mmc *mmc, enum bus_mode mode)
1313 {
1314         int err;
1315
1316         ALLOC_CACHE_ALIGN_BUFFER(uint, switch_status, 16);
1317         int speed;
1318
1319         /* SD version 1.00 and 1.01 does not support CMD 6 */
1320         if (mmc->version == SD_VERSION_1_0)
1321                 return 0;
1322
1323         switch (mode) {
1324         case SD_LEGACY:
1325                 speed = UHS_SDR12_BUS_SPEED;
1326                 break;
1327         case SD_HS:
1328                 speed = HIGH_SPEED_BUS_SPEED;
1329                 break;
1330 #if CONFIG_IS_ENABLED(MMC_UHS_SUPPORT)
1331         case UHS_SDR12:
1332                 speed = UHS_SDR12_BUS_SPEED;
1333                 break;
1334         case UHS_SDR25:
1335                 speed = UHS_SDR25_BUS_SPEED;
1336                 break;
1337         case UHS_SDR50:
1338                 speed = UHS_SDR50_BUS_SPEED;
1339                 break;
1340         case UHS_DDR50:
1341                 speed = UHS_DDR50_BUS_SPEED;
1342                 break;
1343         case UHS_SDR104:
1344                 speed = UHS_SDR104_BUS_SPEED;
1345                 break;
1346 #endif
1347         default:
1348                 return -EINVAL;
1349         }
1350
1351         err = sd_switch(mmc, SD_SWITCH_SWITCH, 0, speed, (u8 *)switch_status);
1352         if (err)
1353                 return err;
1354
1355         if (((__be32_to_cpu(switch_status[4]) >> 24) & 0xF) != speed)
1356                 return -ENOTSUPP;
1357
1358         return 0;
1359 }
1360
1361 static int sd_select_bus_width(struct mmc *mmc, int w)
1362 {
1363         int err;
1364         struct mmc_cmd cmd;
1365
1366         if ((w != 4) && (w != 1))
1367                 return -EINVAL;
1368
1369         cmd.cmdidx = MMC_CMD_APP_CMD;
1370         cmd.resp_type = MMC_RSP_R1;
1371         cmd.cmdarg = mmc->rca << 16;
1372
1373         err = mmc_send_cmd(mmc, &cmd, NULL);
1374         if (err)
1375                 return err;
1376
1377         cmd.cmdidx = SD_CMD_APP_SET_BUS_WIDTH;
1378         cmd.resp_type = MMC_RSP_R1;
1379         if (w == 4)
1380                 cmd.cmdarg = 2;
1381         else if (w == 1)
1382                 cmd.cmdarg = 0;
1383         err = mmc_send_cmd(mmc, &cmd, NULL);
1384         if (err)
1385                 return err;
1386
1387         return 0;
1388 }
1389 #endif
1390
1391 #if CONFIG_IS_ENABLED(MMC_WRITE)
1392 static int sd_read_ssr(struct mmc *mmc)
1393 {
1394         static const unsigned int sd_au_size[] = {
1395                 0,              SZ_16K / 512,           SZ_32K / 512,
1396                 SZ_64K / 512,   SZ_128K / 512,          SZ_256K / 512,
1397                 SZ_512K / 512,  SZ_1M / 512,            SZ_2M / 512,
1398                 SZ_4M / 512,    SZ_8M / 512,            (SZ_8M + SZ_4M) / 512,
1399                 SZ_16M / 512,   (SZ_16M + SZ_8M) / 512, SZ_32M / 512,
1400                 SZ_64M / 512,
1401         };
1402         int err, i;
1403         struct mmc_cmd cmd;
1404         ALLOC_CACHE_ALIGN_BUFFER(uint, ssr, 16);
1405         struct mmc_data data;
1406         int timeout = 3;
1407         unsigned int au, eo, et, es;
1408
1409         cmd.cmdidx = MMC_CMD_APP_CMD;
1410         cmd.resp_type = MMC_RSP_R1;
1411         cmd.cmdarg = mmc->rca << 16;
1412
1413         err = mmc_send_cmd(mmc, &cmd, NULL);
1414         if (err)
1415                 return err;
1416
1417         cmd.cmdidx = SD_CMD_APP_SD_STATUS;
1418         cmd.resp_type = MMC_RSP_R1;
1419         cmd.cmdarg = 0;
1420
1421 retry_ssr:
1422         data.dest = (char *)ssr;
1423         data.blocksize = 64;
1424         data.blocks = 1;
1425         data.flags = MMC_DATA_READ;
1426
1427         err = mmc_send_cmd(mmc, &cmd, &data);
1428         if (err) {
1429                 if (timeout--)
1430                         goto retry_ssr;
1431
1432                 return err;
1433         }
1434
1435         for (i = 0; i < 16; i++)
1436                 ssr[i] = be32_to_cpu(ssr[i]);
1437
1438         au = (ssr[2] >> 12) & 0xF;
1439         if ((au <= 9) || (mmc->version == SD_VERSION_3)) {
1440                 mmc->ssr.au = sd_au_size[au];
1441                 es = (ssr[3] >> 24) & 0xFF;
1442                 es |= (ssr[2] & 0xFF) << 8;
1443                 et = (ssr[3] >> 18) & 0x3F;
1444                 if (es && et) {
1445                         eo = (ssr[3] >> 16) & 0x3;
1446                         mmc->ssr.erase_timeout = (et * 1000) / es;
1447                         mmc->ssr.erase_offset = eo * 1000;
1448                 }
1449         } else {
1450                 pr_debug("Invalid Allocation Unit Size.\n");
1451         }
1452
1453         return 0;
1454 }
1455 #endif
1456 /* frequency bases */
1457 /* divided by 10 to be nice to platforms without floating point */
1458 static const int fbase[] = {
1459         10000,
1460         100000,
1461         1000000,
1462         10000000,
1463 };
1464
1465 /* Multiplier values for TRAN_SPEED.  Multiplied by 10 to be nice
1466  * to platforms without floating point.
1467  */
1468 static const u8 multipliers[] = {
1469         0,      /* reserved */
1470         10,
1471         12,
1472         13,
1473         15,
1474         20,
1475         25,
1476         30,
1477         35,
1478         40,
1479         45,
1480         50,
1481         55,
1482         60,
1483         70,
1484         80,
1485 };
1486
1487 static inline int bus_width(uint cap)
1488 {
1489         if (cap == MMC_MODE_8BIT)
1490                 return 8;
1491         if (cap == MMC_MODE_4BIT)
1492                 return 4;
1493         if (cap == MMC_MODE_1BIT)
1494                 return 1;
1495         pr_warn("invalid bus witdh capability 0x%x\n", cap);
1496         return 0;
1497 }
1498
1499 #if !CONFIG_IS_ENABLED(DM_MMC)
1500 #ifdef MMC_SUPPORTS_TUNING
1501 static int mmc_execute_tuning(struct mmc *mmc, uint opcode)
1502 {
1503         return -ENOTSUPP;
1504 }
1505 #endif
1506
1507 static void mmc_send_init_stream(struct mmc *mmc)
1508 {
1509 }
1510
1511 static int mmc_set_ios(struct mmc *mmc)
1512 {
1513         int ret = 0;
1514
1515         if (mmc->cfg->ops->set_ios)
1516                 ret = mmc->cfg->ops->set_ios(mmc);
1517
1518         return ret;
1519 }
1520 #endif
1521
1522 int mmc_set_clock(struct mmc *mmc, uint clock, bool disable)
1523 {
1524         if (!disable) {
1525                 if (clock > mmc->cfg->f_max)
1526                         clock = mmc->cfg->f_max;
1527
1528                 if (clock < mmc->cfg->f_min)
1529                         clock = mmc->cfg->f_min;
1530         }
1531
1532         mmc->clock = clock;
1533         mmc->clk_disable = disable;
1534
1535         debug("clock is %s (%dHz)\n", disable ? "disabled" : "enabled", clock);
1536
1537         return mmc_set_ios(mmc);
1538 }
1539
1540 static int mmc_set_bus_width(struct mmc *mmc, uint width)
1541 {
1542         mmc->bus_width = width;
1543
1544         return mmc_set_ios(mmc);
1545 }
1546
1547 #if CONFIG_IS_ENABLED(MMC_VERBOSE) || defined(DEBUG)
1548 /*
1549  * helper function to display the capabilities in a human
1550  * friendly manner. The capabilities include bus width and
1551  * supported modes.
1552  */
1553 void mmc_dump_capabilities(const char *text, uint caps)
1554 {
1555         enum bus_mode mode;
1556
1557         pr_debug("%s: widths [", text);
1558         if (caps & MMC_MODE_8BIT)
1559                 pr_debug("8, ");
1560         if (caps & MMC_MODE_4BIT)
1561                 pr_debug("4, ");
1562         if (caps & MMC_MODE_1BIT)
1563                 pr_debug("1, ");
1564         pr_debug("\b\b] modes [");
1565         for (mode = MMC_LEGACY; mode < MMC_MODES_END; mode++)
1566                 if (MMC_CAP(mode) & caps)
1567                         pr_debug("%s, ", mmc_mode_name(mode));
1568         pr_debug("\b\b]\n");
1569 }
1570 #endif
1571
1572 struct mode_width_tuning {
1573         enum bus_mode mode;
1574         uint widths;
1575 #ifdef MMC_SUPPORTS_TUNING
1576         uint tuning;
1577 #endif
1578 };
1579
1580 #if CONFIG_IS_ENABLED(MMC_IO_VOLTAGE)
1581 int mmc_voltage_to_mv(enum mmc_voltage voltage)
1582 {
1583         switch (voltage) {
1584         case MMC_SIGNAL_VOLTAGE_000: return 0;
1585         case MMC_SIGNAL_VOLTAGE_330: return 3300;
1586         case MMC_SIGNAL_VOLTAGE_180: return 1800;
1587         case MMC_SIGNAL_VOLTAGE_120: return 1200;
1588         }
1589         return -EINVAL;
1590 }
1591
1592 static int mmc_set_signal_voltage(struct mmc *mmc, uint signal_voltage)
1593 {
1594         int err;
1595
1596         if (mmc->signal_voltage == signal_voltage)
1597                 return 0;
1598
1599         mmc->signal_voltage = signal_voltage;
1600         err = mmc_set_ios(mmc);
1601         if (err)
1602                 pr_debug("unable to set voltage (err %d)\n", err);
1603
1604         return err;
1605 }
1606 #else
1607 static inline int mmc_set_signal_voltage(struct mmc *mmc, uint signal_voltage)
1608 {
1609         return 0;
1610 }
1611 #endif
1612
1613 #if !CONFIG_IS_ENABLED(MMC_TINY)
1614 static const struct mode_width_tuning sd_modes_by_pref[] = {
1615 #if CONFIG_IS_ENABLED(MMC_UHS_SUPPORT)
1616 #ifdef MMC_SUPPORTS_TUNING
1617         {
1618                 .mode = UHS_SDR104,
1619                 .widths = MMC_MODE_4BIT | MMC_MODE_1BIT,
1620                 .tuning = MMC_CMD_SEND_TUNING_BLOCK
1621         },
1622 #endif
1623         {
1624                 .mode = UHS_SDR50,
1625                 .widths = MMC_MODE_4BIT | MMC_MODE_1BIT,
1626         },
1627         {
1628                 .mode = UHS_DDR50,
1629                 .widths = MMC_MODE_4BIT | MMC_MODE_1BIT,
1630         },
1631         {
1632                 .mode = UHS_SDR25,
1633                 .widths = MMC_MODE_4BIT | MMC_MODE_1BIT,
1634         },
1635 #endif
1636         {
1637                 .mode = SD_HS,
1638                 .widths = MMC_MODE_4BIT | MMC_MODE_1BIT,
1639         },
1640 #if CONFIG_IS_ENABLED(MMC_UHS_SUPPORT)
1641         {
1642                 .mode = UHS_SDR12,
1643                 .widths = MMC_MODE_4BIT | MMC_MODE_1BIT,
1644         },
1645 #endif
1646         {
1647                 .mode = SD_LEGACY,
1648                 .widths = MMC_MODE_4BIT | MMC_MODE_1BIT,
1649         }
1650 };
1651
1652 #define for_each_sd_mode_by_pref(caps, mwt) \
1653         for (mwt = sd_modes_by_pref;\
1654              mwt < sd_modes_by_pref + ARRAY_SIZE(sd_modes_by_pref);\
1655              mwt++) \
1656                 if (caps & MMC_CAP(mwt->mode))
1657
1658 static int sd_select_mode_and_width(struct mmc *mmc, uint card_caps)
1659 {
1660         int err;
1661         uint widths[] = {MMC_MODE_4BIT, MMC_MODE_1BIT};
1662         const struct mode_width_tuning *mwt;
1663 #if CONFIG_IS_ENABLED(MMC_UHS_SUPPORT)
1664         bool uhs_en = (mmc->ocr & OCR_S18R) ? true : false;
1665 #else
1666         bool uhs_en = false;
1667 #endif
1668         uint caps;
1669
1670 #ifdef DEBUG
1671         mmc_dump_capabilities("sd card", card_caps);
1672         mmc_dump_capabilities("host", mmc->host_caps);
1673 #endif
1674
1675         /* Restrict card's capabilities by what the host can do */
1676         caps = card_caps & mmc->host_caps;
1677
1678         if (!uhs_en)
1679                 caps &= ~UHS_CAPS;
1680
1681         for_each_sd_mode_by_pref(caps, mwt) {
1682                 uint *w;
1683
1684                 for (w = widths; w < widths + ARRAY_SIZE(widths); w++) {
1685                         if (*w & caps & mwt->widths) {
1686                                 pr_debug("trying mode %s width %d (at %d MHz)\n",
1687                                          mmc_mode_name(mwt->mode),
1688                                          bus_width(*w),
1689                                          mmc_mode2freq(mmc, mwt->mode) / 1000000);
1690
1691                                 /* configure the bus width (card + host) */
1692                                 err = sd_select_bus_width(mmc, bus_width(*w));
1693                                 if (err)
1694                                         goto error;
1695                                 mmc_set_bus_width(mmc, bus_width(*w));
1696
1697                                 /* configure the bus mode (card) */
1698                                 err = sd_set_card_speed(mmc, mwt->mode);
1699                                 if (err)
1700                                         goto error;
1701
1702                                 /* configure the bus mode (host) */
1703                                 mmc_select_mode(mmc, mwt->mode);
1704                                 mmc_set_clock(mmc, mmc->tran_speed,
1705                                                 MMC_CLK_ENABLE);
1706
1707 #ifdef MMC_SUPPORTS_TUNING
1708                                 /* execute tuning if needed */
1709                                 if (mwt->tuning && !mmc_host_is_spi(mmc)) {
1710                                         err = mmc_execute_tuning(mmc,
1711                                                                  mwt->tuning);
1712                                         if (err) {
1713                                                 pr_debug("tuning failed\n");
1714                                                 goto error;
1715                                         }
1716                                 }
1717 #endif
1718
1719 #if CONFIG_IS_ENABLED(MMC_WRITE)
1720                                 err = sd_read_ssr(mmc);
1721                                 if (err)
1722                                         pr_warn("unable to read ssr\n");
1723 #endif
1724                                 if (!err)
1725                                         return 0;
1726
1727 error:
1728                                 /* revert to a safer bus speed */
1729                                 mmc_select_mode(mmc, SD_LEGACY);
1730                                 mmc_set_clock(mmc, mmc->tran_speed,
1731                                                 MMC_CLK_ENABLE);
1732                         }
1733                 }
1734         }
1735
1736         pr_err("unable to select a mode\n");
1737         return -ENOTSUPP;
1738 }
1739
1740 /*
1741  * read the compare the part of ext csd that is constant.
1742  * This can be used to check that the transfer is working
1743  * as expected.
1744  */
1745 static int mmc_read_and_compare_ext_csd(struct mmc *mmc)
1746 {
1747         int err;
1748         const u8 *ext_csd = mmc->ext_csd;
1749         ALLOC_CACHE_ALIGN_BUFFER(u8, test_csd, MMC_MAX_BLOCK_LEN);
1750
1751         if (mmc->version < MMC_VERSION_4)
1752                 return 0;
1753
1754         err = mmc_send_ext_csd(mmc, test_csd);
1755         if (err)
1756                 return err;
1757
1758         /* Only compare read only fields */
1759         if (ext_csd[EXT_CSD_PARTITIONING_SUPPORT]
1760                 == test_csd[EXT_CSD_PARTITIONING_SUPPORT] &&
1761             ext_csd[EXT_CSD_HC_WP_GRP_SIZE]
1762                 == test_csd[EXT_CSD_HC_WP_GRP_SIZE] &&
1763             ext_csd[EXT_CSD_REV]
1764                 == test_csd[EXT_CSD_REV] &&
1765             ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]
1766                 == test_csd[EXT_CSD_HC_ERASE_GRP_SIZE] &&
1767             memcmp(&ext_csd[EXT_CSD_SEC_CNT],
1768                    &test_csd[EXT_CSD_SEC_CNT], 4) == 0)
1769                 return 0;
1770
1771         return -EBADMSG;
1772 }
1773
1774 #if CONFIG_IS_ENABLED(MMC_IO_VOLTAGE)
1775 static int mmc_set_lowest_voltage(struct mmc *mmc, enum bus_mode mode,
1776                                   uint32_t allowed_mask)
1777 {
1778         u32 card_mask = 0;
1779
1780         switch (mode) {
1781         case MMC_HS_400:
1782         case MMC_HS_200:
1783                 if (mmc->cardtype & (EXT_CSD_CARD_TYPE_HS200_1_8V |
1784                     EXT_CSD_CARD_TYPE_HS400_1_8V))
1785                         card_mask |= MMC_SIGNAL_VOLTAGE_180;
1786                 if (mmc->cardtype & (EXT_CSD_CARD_TYPE_HS200_1_2V |
1787                     EXT_CSD_CARD_TYPE_HS400_1_2V))
1788                         card_mask |= MMC_SIGNAL_VOLTAGE_120;
1789                 break;
1790         case MMC_DDR_52:
1791                 if (mmc->cardtype & EXT_CSD_CARD_TYPE_DDR_1_8V)
1792                         card_mask |= MMC_SIGNAL_VOLTAGE_330 |
1793                                      MMC_SIGNAL_VOLTAGE_180;
1794                 if (mmc->cardtype & EXT_CSD_CARD_TYPE_DDR_1_2V)
1795                         card_mask |= MMC_SIGNAL_VOLTAGE_120;
1796                 break;
1797         default:
1798                 card_mask |= MMC_SIGNAL_VOLTAGE_330;
1799                 break;
1800         }
1801
1802         while (card_mask & allowed_mask) {
1803                 enum mmc_voltage best_match;
1804
1805                 best_match = 1 << (ffs(card_mask & allowed_mask) - 1);
1806                 if (!mmc_set_signal_voltage(mmc,  best_match))
1807                         return 0;
1808
1809                 allowed_mask &= ~best_match;
1810         }
1811
1812         return -ENOTSUPP;
1813 }
1814 #else
1815 static inline int mmc_set_lowest_voltage(struct mmc *mmc, enum bus_mode mode,
1816                                          uint32_t allowed_mask)
1817 {
1818         return 0;
1819 }
1820 #endif
1821
1822 static const struct mode_width_tuning mmc_modes_by_pref[] = {
1823 #if CONFIG_IS_ENABLED(MMC_HS400_SUPPORT)
1824         {
1825                 .mode = MMC_HS_400,
1826                 .widths = MMC_MODE_8BIT,
1827                 .tuning = MMC_CMD_SEND_TUNING_BLOCK_HS200
1828         },
1829 #endif
1830 #if CONFIG_IS_ENABLED(MMC_HS200_SUPPORT)
1831         {
1832                 .mode = MMC_HS_200,
1833                 .widths = MMC_MODE_8BIT | MMC_MODE_4BIT,
1834                 .tuning = MMC_CMD_SEND_TUNING_BLOCK_HS200
1835         },
1836 #endif
1837         {
1838                 .mode = MMC_DDR_52,
1839                 .widths = MMC_MODE_8BIT | MMC_MODE_4BIT,
1840         },
1841         {
1842                 .mode = MMC_HS_52,
1843                 .widths = MMC_MODE_8BIT | MMC_MODE_4BIT | MMC_MODE_1BIT,
1844         },
1845         {
1846                 .mode = MMC_HS,
1847                 .widths = MMC_MODE_8BIT | MMC_MODE_4BIT | MMC_MODE_1BIT,
1848         },
1849         {
1850                 .mode = MMC_LEGACY,
1851                 .widths = MMC_MODE_8BIT | MMC_MODE_4BIT | MMC_MODE_1BIT,
1852         }
1853 };
1854
1855 #define for_each_mmc_mode_by_pref(caps, mwt) \
1856         for (mwt = mmc_modes_by_pref;\
1857             mwt < mmc_modes_by_pref + ARRAY_SIZE(mmc_modes_by_pref);\
1858             mwt++) \
1859                 if (caps & MMC_CAP(mwt->mode))
1860
1861 static const struct ext_csd_bus_width {
1862         uint cap;
1863         bool is_ddr;
1864         uint ext_csd_bits;
1865 } ext_csd_bus_width[] = {
1866         {MMC_MODE_8BIT, true, EXT_CSD_DDR_BUS_WIDTH_8},
1867         {MMC_MODE_4BIT, true, EXT_CSD_DDR_BUS_WIDTH_4},
1868         {MMC_MODE_8BIT, false, EXT_CSD_BUS_WIDTH_8},
1869         {MMC_MODE_4BIT, false, EXT_CSD_BUS_WIDTH_4},
1870         {MMC_MODE_1BIT, false, EXT_CSD_BUS_WIDTH_1},
1871 };
1872
1873 #if CONFIG_IS_ENABLED(MMC_HS400_SUPPORT)
1874 static int mmc_select_hs400(struct mmc *mmc)
1875 {
1876         int err;
1877
1878         /* Set timing to HS200 for tuning */
1879         err = mmc_set_card_speed(mmc, MMC_HS_200, false);
1880         if (err)
1881                 return err;
1882
1883         /* configure the bus mode (host) */
1884         mmc_select_mode(mmc, MMC_HS_200);
1885         mmc_set_clock(mmc, mmc->tran_speed, false);
1886
1887         /* execute tuning if needed */
1888         err = mmc_execute_tuning(mmc, MMC_CMD_SEND_TUNING_BLOCK_HS200);
1889         if (err) {
1890                 debug("tuning failed\n");
1891                 return err;
1892         }
1893
1894         /* Set back to HS */
1895         mmc_set_card_speed(mmc, MMC_HS, false);
1896         mmc_set_clock(mmc, mmc_mode2freq(mmc, MMC_HS), false);
1897
1898         err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_BUS_WIDTH,
1899                          EXT_CSD_BUS_WIDTH_8 | EXT_CSD_DDR_FLAG);
1900         if (err)
1901                 return err;
1902
1903         err = mmc_set_card_speed(mmc, MMC_HS_400, false);
1904         if (err)
1905                 return err;
1906
1907         mmc_select_mode(mmc, MMC_HS_400);
1908         err = mmc_set_clock(mmc, mmc->tran_speed, false);
1909         if (err)
1910                 return err;
1911
1912         return 0;
1913 }
1914 #else
1915 static int mmc_select_hs400(struct mmc *mmc)
1916 {
1917         return -ENOTSUPP;
1918 }
1919 #endif
1920
1921 #define for_each_supported_width(caps, ddr, ecbv) \
1922         for (ecbv = ext_csd_bus_width;\
1923             ecbv < ext_csd_bus_width + ARRAY_SIZE(ext_csd_bus_width);\
1924             ecbv++) \
1925                 if ((ddr == ecbv->is_ddr) && (caps & ecbv->cap))
1926
1927 static int mmc_select_mode_and_width(struct mmc *mmc, uint card_caps)
1928 {
1929         int err;
1930         const struct mode_width_tuning *mwt;
1931         const struct ext_csd_bus_width *ecbw;
1932
1933 #ifdef DEBUG
1934         mmc_dump_capabilities("mmc", card_caps);
1935         mmc_dump_capabilities("host", mmc->host_caps);
1936 #endif
1937
1938         /* Restrict card's capabilities by what the host can do */
1939         card_caps &= mmc->host_caps;
1940
1941         /* Only version 4 of MMC supports wider bus widths */
1942         if (mmc->version < MMC_VERSION_4)
1943                 return 0;
1944
1945         if (!mmc->ext_csd) {
1946                 pr_debug("No ext_csd found!\n"); /* this should enver happen */
1947                 return -ENOTSUPP;
1948         }
1949
1950 #if CONFIG_IS_ENABLED(MMC_HS200_SUPPORT) || \
1951     CONFIG_IS_ENABLED(MMC_HS400_SUPPORT)
1952         /*
1953          * In case the eMMC is in HS200/HS400 mode, downgrade to HS mode
1954          * before doing anything else, since a transition from either of
1955          * the HS200/HS400 mode directly to legacy mode is not supported.
1956          */
1957         if (mmc->selected_mode == MMC_HS_200 ||
1958             mmc->selected_mode == MMC_HS_400)
1959                 mmc_set_card_speed(mmc, MMC_HS, true);
1960         else
1961 #endif
1962                 mmc_set_clock(mmc, mmc->legacy_speed, MMC_CLK_ENABLE);
1963
1964         for_each_mmc_mode_by_pref(card_caps, mwt) {
1965                 for_each_supported_width(card_caps & mwt->widths,
1966                                          mmc_is_mode_ddr(mwt->mode), ecbw) {
1967                         enum mmc_voltage old_voltage;
1968                         pr_debug("trying mode %s width %d (at %d MHz)\n",
1969                                  mmc_mode_name(mwt->mode),
1970                                  bus_width(ecbw->cap),
1971                                  mmc_mode2freq(mmc, mwt->mode) / 1000000);
1972                         old_voltage = mmc->signal_voltage;
1973                         err = mmc_set_lowest_voltage(mmc, mwt->mode,
1974                                                      MMC_ALL_SIGNAL_VOLTAGE);
1975                         if (err)
1976                                 continue;
1977
1978                         /* configure the bus width (card + host) */
1979                         err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
1980                                     EXT_CSD_BUS_WIDTH,
1981                                     ecbw->ext_csd_bits & ~EXT_CSD_DDR_FLAG);
1982                         if (err)
1983                                 goto error;
1984                         mmc_set_bus_width(mmc, bus_width(ecbw->cap));
1985
1986                         if (mwt->mode == MMC_HS_400) {
1987                                 err = mmc_select_hs400(mmc);
1988                                 if (err) {
1989                                         printf("Select HS400 failed %d\n", err);
1990                                         goto error;
1991                                 }
1992                         } else {
1993                                 /* configure the bus speed (card) */
1994                                 err = mmc_set_card_speed(mmc, mwt->mode, false);
1995                                 if (err)
1996                                         goto error;
1997
1998                                 /*
1999                                  * configure the bus width AND the ddr mode
2000                                  * (card). The host side will be taken care
2001                                  * of in the next step
2002                                  */
2003                                 if (ecbw->ext_csd_bits & EXT_CSD_DDR_FLAG) {
2004                                         err = mmc_switch(mmc,
2005                                                          EXT_CSD_CMD_SET_NORMAL,
2006                                                          EXT_CSD_BUS_WIDTH,
2007                                                          ecbw->ext_csd_bits);
2008                                         if (err)
2009                                                 goto error;
2010                                 }
2011
2012                                 /* configure the bus mode (host) */
2013                                 mmc_select_mode(mmc, mwt->mode);
2014                                 mmc_set_clock(mmc, mmc->tran_speed,
2015                                               MMC_CLK_ENABLE);
2016 #ifdef MMC_SUPPORTS_TUNING
2017
2018                                 /* execute tuning if needed */
2019                                 if (mwt->tuning) {
2020                                         err = mmc_execute_tuning(mmc,
2021                                                                  mwt->tuning);
2022                                         if (err) {
2023                                                 pr_debug("tuning failed\n");
2024                                                 goto error;
2025                                         }
2026                                 }
2027 #endif
2028                         }
2029
2030                         /* do a transfer to check the configuration */
2031                         err = mmc_read_and_compare_ext_csd(mmc);
2032                         if (!err)
2033                                 return 0;
2034 error:
2035                         mmc_set_signal_voltage(mmc, old_voltage);
2036                         /* if an error occured, revert to a safer bus mode */
2037                         mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
2038                                    EXT_CSD_BUS_WIDTH, EXT_CSD_BUS_WIDTH_1);
2039                         mmc_select_mode(mmc, MMC_LEGACY);
2040                         mmc_set_bus_width(mmc, 1);
2041                 }
2042         }
2043
2044         pr_err("unable to select a mode\n");
2045
2046         return -ENOTSUPP;
2047 }
2048 #endif
2049
2050 #if CONFIG_IS_ENABLED(MMC_TINY)
2051 DEFINE_CACHE_ALIGN_BUFFER(u8, ext_csd_bkup, MMC_MAX_BLOCK_LEN);
2052 #endif
2053
2054 static int mmc_startup_v4(struct mmc *mmc)
2055 {
2056         int err, i;
2057         u64 capacity;
2058         bool has_parts = false;
2059         bool part_completed;
2060         static const u32 mmc_versions[] = {
2061                 MMC_VERSION_4,
2062                 MMC_VERSION_4_1,
2063                 MMC_VERSION_4_2,
2064                 MMC_VERSION_4_3,
2065                 MMC_VERSION_4_4,
2066                 MMC_VERSION_4_41,
2067                 MMC_VERSION_4_5,
2068                 MMC_VERSION_5_0,
2069                 MMC_VERSION_5_1
2070         };
2071
2072 #if CONFIG_IS_ENABLED(MMC_TINY)
2073         u8 *ext_csd = ext_csd_bkup;
2074
2075         if (IS_SD(mmc) || mmc->version < MMC_VERSION_4)
2076                 return 0;
2077
2078         if (!mmc->ext_csd)
2079                 memset(ext_csd_bkup, 0, sizeof(ext_csd_bkup));
2080
2081         err = mmc_send_ext_csd(mmc, ext_csd);
2082         if (err)
2083                 goto error;
2084
2085         /* store the ext csd for future reference */
2086         if (!mmc->ext_csd)
2087                 mmc->ext_csd = ext_csd;
2088 #else
2089         ALLOC_CACHE_ALIGN_BUFFER(u8, ext_csd, MMC_MAX_BLOCK_LEN);
2090
2091         if (IS_SD(mmc) || (mmc->version < MMC_VERSION_4))
2092                 return 0;
2093
2094         /* check  ext_csd version and capacity */
2095         err = mmc_send_ext_csd(mmc, ext_csd);
2096         if (err)
2097                 goto error;
2098
2099         /* store the ext csd for future reference */
2100         if (!mmc->ext_csd)
2101                 mmc->ext_csd = malloc(MMC_MAX_BLOCK_LEN);
2102         if (!mmc->ext_csd)
2103                 return -ENOMEM;
2104         memcpy(mmc->ext_csd, ext_csd, MMC_MAX_BLOCK_LEN);
2105 #endif
2106         if (ext_csd[EXT_CSD_REV] >= ARRAY_SIZE(mmc_versions))
2107                 return -EINVAL;
2108
2109         mmc->version = mmc_versions[ext_csd[EXT_CSD_REV]];
2110
2111         if (mmc->version >= MMC_VERSION_4_2) {
2112                 /*
2113                  * According to the JEDEC Standard, the value of
2114                  * ext_csd's capacity is valid if the value is more
2115                  * than 2GB
2116                  */
2117                 capacity = ext_csd[EXT_CSD_SEC_CNT] << 0
2118                                 | ext_csd[EXT_CSD_SEC_CNT + 1] << 8
2119                                 | ext_csd[EXT_CSD_SEC_CNT + 2] << 16
2120                                 | ext_csd[EXT_CSD_SEC_CNT + 3] << 24;
2121                 capacity *= MMC_MAX_BLOCK_LEN;
2122                 if ((capacity >> 20) > 2 * 1024)
2123                         mmc->capacity_user = capacity;
2124         }
2125
2126         /* The partition data may be non-zero but it is only
2127          * effective if PARTITION_SETTING_COMPLETED is set in
2128          * EXT_CSD, so ignore any data if this bit is not set,
2129          * except for enabling the high-capacity group size
2130          * definition (see below).
2131          */
2132         part_completed = !!(ext_csd[EXT_CSD_PARTITION_SETTING] &
2133                             EXT_CSD_PARTITION_SETTING_COMPLETED);
2134
2135         /* store the partition info of emmc */
2136         mmc->part_support = ext_csd[EXT_CSD_PARTITIONING_SUPPORT];
2137         if ((ext_csd[EXT_CSD_PARTITIONING_SUPPORT] & PART_SUPPORT) ||
2138             ext_csd[EXT_CSD_BOOT_MULT])
2139                 mmc->part_config = ext_csd[EXT_CSD_PART_CONF];
2140         if (part_completed &&
2141             (ext_csd[EXT_CSD_PARTITIONING_SUPPORT] & ENHNCD_SUPPORT))
2142                 mmc->part_attr = ext_csd[EXT_CSD_PARTITIONS_ATTRIBUTE];
2143
2144         mmc->capacity_boot = ext_csd[EXT_CSD_BOOT_MULT] << 17;
2145
2146         mmc->capacity_rpmb = ext_csd[EXT_CSD_RPMB_MULT] << 17;
2147
2148         for (i = 0; i < 4; i++) {
2149                 int idx = EXT_CSD_GP_SIZE_MULT + i * 3;
2150                 uint mult = (ext_csd[idx + 2] << 16) +
2151                         (ext_csd[idx + 1] << 8) + ext_csd[idx];
2152                 if (mult)
2153                         has_parts = true;
2154                 if (!part_completed)
2155                         continue;
2156                 mmc->capacity_gp[i] = mult;
2157                 mmc->capacity_gp[i] *=
2158                         ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
2159                 mmc->capacity_gp[i] *= ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
2160                 mmc->capacity_gp[i] <<= 19;
2161         }
2162
2163 #ifndef CONFIG_SPL_BUILD
2164         if (part_completed) {
2165                 mmc->enh_user_size =
2166                         (ext_csd[EXT_CSD_ENH_SIZE_MULT + 2] << 16) +
2167                         (ext_csd[EXT_CSD_ENH_SIZE_MULT + 1] << 8) +
2168                         ext_csd[EXT_CSD_ENH_SIZE_MULT];
2169                 mmc->enh_user_size *= ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
2170                 mmc->enh_user_size *= ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
2171                 mmc->enh_user_size <<= 19;
2172                 mmc->enh_user_start =
2173                         (ext_csd[EXT_CSD_ENH_START_ADDR + 3] << 24) +
2174                         (ext_csd[EXT_CSD_ENH_START_ADDR + 2] << 16) +
2175                         (ext_csd[EXT_CSD_ENH_START_ADDR + 1] << 8) +
2176                         ext_csd[EXT_CSD_ENH_START_ADDR];
2177                 if (mmc->high_capacity)
2178                         mmc->enh_user_start <<= 9;
2179         }
2180 #endif
2181
2182         /*
2183          * Host needs to enable ERASE_GRP_DEF bit if device is
2184          * partitioned. This bit will be lost every time after a reset
2185          * or power off. This will affect erase size.
2186          */
2187         if (part_completed)
2188                 has_parts = true;
2189         if ((ext_csd[EXT_CSD_PARTITIONING_SUPPORT] & PART_SUPPORT) &&
2190             (ext_csd[EXT_CSD_PARTITIONS_ATTRIBUTE] & PART_ENH_ATTRIB))
2191                 has_parts = true;
2192         if (has_parts) {
2193                 err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
2194                                  EXT_CSD_ERASE_GROUP_DEF, 1);
2195
2196                 if (err)
2197                         goto error;
2198
2199                 ext_csd[EXT_CSD_ERASE_GROUP_DEF] = 1;
2200         }
2201
2202         if (ext_csd[EXT_CSD_ERASE_GROUP_DEF] & 0x01) {
2203 #if CONFIG_IS_ENABLED(MMC_WRITE)
2204                 /* Read out group size from ext_csd */
2205                 mmc->erase_grp_size =
2206                         ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE] * 1024;
2207 #endif
2208                 /*
2209                  * if high capacity and partition setting completed
2210                  * SEC_COUNT is valid even if it is smaller than 2 GiB
2211                  * JEDEC Standard JESD84-B45, 6.2.4
2212                  */
2213                 if (mmc->high_capacity && part_completed) {
2214                         capacity = (ext_csd[EXT_CSD_SEC_CNT]) |
2215                                 (ext_csd[EXT_CSD_SEC_CNT + 1] << 8) |
2216                                 (ext_csd[EXT_CSD_SEC_CNT + 2] << 16) |
2217                                 (ext_csd[EXT_CSD_SEC_CNT + 3] << 24);
2218                         capacity *= MMC_MAX_BLOCK_LEN;
2219                         mmc->capacity_user = capacity;
2220                 }
2221         }
2222 #if CONFIG_IS_ENABLED(MMC_WRITE)
2223         else {
2224                 /* Calculate the group size from the csd value. */
2225                 int erase_gsz, erase_gmul;
2226
2227                 erase_gsz = (mmc->csd[2] & 0x00007c00) >> 10;
2228                 erase_gmul = (mmc->csd[2] & 0x000003e0) >> 5;
2229                 mmc->erase_grp_size = (erase_gsz + 1)
2230                         * (erase_gmul + 1);
2231         }
2232 #endif
2233 #if CONFIG_IS_ENABLED(MMC_HW_PARTITIONING)
2234         mmc->hc_wp_grp_size = 1024
2235                 * ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]
2236                 * ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
2237 #endif
2238
2239         mmc->wr_rel_set = ext_csd[EXT_CSD_WR_REL_SET];
2240
2241         return 0;
2242 error:
2243         if (mmc->ext_csd) {
2244 #if !CONFIG_IS_ENABLED(MMC_TINY)
2245                 free(mmc->ext_csd);
2246 #endif
2247                 mmc->ext_csd = NULL;
2248         }
2249         return err;
2250 }
2251
2252 static int mmc_startup(struct mmc *mmc)
2253 {
2254         int err, i;
2255         uint mult, freq;
2256         u64 cmult, csize;
2257         struct mmc_cmd cmd;
2258         struct blk_desc *bdesc;
2259
2260 #ifdef CONFIG_MMC_SPI_CRC_ON
2261         if (mmc_host_is_spi(mmc)) { /* enable CRC check for spi */
2262                 cmd.cmdidx = MMC_CMD_SPI_CRC_ON_OFF;
2263                 cmd.resp_type = MMC_RSP_R1;
2264                 cmd.cmdarg = 1;
2265                 err = mmc_send_cmd(mmc, &cmd, NULL);
2266                 if (err)
2267                         return err;
2268         }
2269 #endif
2270
2271         /* Put the Card in Identify Mode */
2272         cmd.cmdidx = mmc_host_is_spi(mmc) ? MMC_CMD_SEND_CID :
2273                 MMC_CMD_ALL_SEND_CID; /* cmd not supported in spi */
2274         cmd.resp_type = MMC_RSP_R2;
2275         cmd.cmdarg = 0;
2276
2277         err = mmc_send_cmd(mmc, &cmd, NULL);
2278
2279 #ifdef CONFIG_MMC_QUIRKS
2280         if (err && (mmc->quirks & MMC_QUIRK_RETRY_SEND_CID)) {
2281                 int retries = 4;
2282                 /*
2283                  * It has been seen that SEND_CID may fail on the first
2284                  * attempt, let's try a few more time
2285                  */
2286                 do {
2287                         err = mmc_send_cmd(mmc, &cmd, NULL);
2288                         if (!err)
2289                                 break;
2290                 } while (retries--);
2291         }
2292 #endif
2293
2294         if (err)
2295                 return err;
2296
2297         memcpy(mmc->cid, cmd.response, 16);
2298
2299         /*
2300          * For MMC cards, set the Relative Address.
2301          * For SD cards, get the Relatvie Address.
2302          * This also puts the cards into Standby State
2303          */
2304         if (!mmc_host_is_spi(mmc)) { /* cmd not supported in spi */
2305                 cmd.cmdidx = SD_CMD_SEND_RELATIVE_ADDR;
2306                 cmd.cmdarg = mmc->rca << 16;
2307                 cmd.resp_type = MMC_RSP_R6;
2308
2309                 err = mmc_send_cmd(mmc, &cmd, NULL);
2310
2311                 if (err)
2312                         return err;
2313
2314                 if (IS_SD(mmc))
2315                         mmc->rca = (cmd.response[0] >> 16) & 0xffff;
2316         }
2317
2318         /* Get the Card-Specific Data */
2319         cmd.cmdidx = MMC_CMD_SEND_CSD;
2320         cmd.resp_type = MMC_RSP_R2;
2321         cmd.cmdarg = mmc->rca << 16;
2322
2323         err = mmc_send_cmd(mmc, &cmd, NULL);
2324
2325         if (err)
2326                 return err;
2327
2328         mmc->csd[0] = cmd.response[0];
2329         mmc->csd[1] = cmd.response[1];
2330         mmc->csd[2] = cmd.response[2];
2331         mmc->csd[3] = cmd.response[3];
2332
2333         if (mmc->version == MMC_VERSION_UNKNOWN) {
2334                 int version = (cmd.response[0] >> 26) & 0xf;
2335
2336                 switch (version) {
2337                 case 0:
2338                         mmc->version = MMC_VERSION_1_2;
2339                         break;
2340                 case 1:
2341                         mmc->version = MMC_VERSION_1_4;
2342                         break;
2343                 case 2:
2344                         mmc->version = MMC_VERSION_2_2;
2345                         break;
2346                 case 3:
2347                         mmc->version = MMC_VERSION_3;
2348                         break;
2349                 case 4:
2350                         mmc->version = MMC_VERSION_4;
2351                         break;
2352                 default:
2353                         mmc->version = MMC_VERSION_1_2;
2354                         break;
2355                 }
2356         }
2357
2358         /* divide frequency by 10, since the mults are 10x bigger */
2359         freq = fbase[(cmd.response[0] & 0x7)];
2360         mult = multipliers[((cmd.response[0] >> 3) & 0xf)];
2361
2362         mmc->legacy_speed = freq * mult;
2363         mmc_select_mode(mmc, MMC_LEGACY);
2364
2365         mmc->dsr_imp = ((cmd.response[1] >> 12) & 0x1);
2366         mmc->read_bl_len = 1 << ((cmd.response[1] >> 16) & 0xf);
2367 #if CONFIG_IS_ENABLED(MMC_WRITE)
2368
2369         if (IS_SD(mmc))
2370                 mmc->write_bl_len = mmc->read_bl_len;
2371         else
2372                 mmc->write_bl_len = 1 << ((cmd.response[3] >> 22) & 0xf);
2373 #endif
2374
2375         if (mmc->high_capacity) {
2376                 csize = (mmc->csd[1] & 0x3f) << 16
2377                         | (mmc->csd[2] & 0xffff0000) >> 16;
2378                 cmult = 8;
2379         } else {
2380                 csize = (mmc->csd[1] & 0x3ff) << 2
2381                         | (mmc->csd[2] & 0xc0000000) >> 30;
2382                 cmult = (mmc->csd[2] & 0x00038000) >> 15;
2383         }
2384
2385         mmc->capacity_user = (csize + 1) << (cmult + 2);
2386         mmc->capacity_user *= mmc->read_bl_len;
2387         mmc->capacity_boot = 0;
2388         mmc->capacity_rpmb = 0;
2389         for (i = 0; i < 4; i++)
2390                 mmc->capacity_gp[i] = 0;
2391
2392         if (mmc->read_bl_len > MMC_MAX_BLOCK_LEN)
2393                 mmc->read_bl_len = MMC_MAX_BLOCK_LEN;
2394
2395 #if CONFIG_IS_ENABLED(MMC_WRITE)
2396         if (mmc->write_bl_len > MMC_MAX_BLOCK_LEN)
2397                 mmc->write_bl_len = MMC_MAX_BLOCK_LEN;
2398 #endif
2399
2400         if ((mmc->dsr_imp) && (0xffffffff != mmc->dsr)) {
2401                 cmd.cmdidx = MMC_CMD_SET_DSR;
2402                 cmd.cmdarg = (mmc->dsr & 0xffff) << 16;
2403                 cmd.resp_type = MMC_RSP_NONE;
2404                 if (mmc_send_cmd(mmc, &cmd, NULL))
2405                         pr_warn("MMC: SET_DSR failed\n");
2406         }
2407
2408         /* Select the card, and put it into Transfer Mode */
2409         if (!mmc_host_is_spi(mmc)) { /* cmd not supported in spi */
2410                 cmd.cmdidx = MMC_CMD_SELECT_CARD;
2411                 cmd.resp_type = MMC_RSP_R1;
2412                 cmd.cmdarg = mmc->rca << 16;
2413                 err = mmc_send_cmd(mmc, &cmd, NULL);
2414
2415                 if (err)
2416                         return err;
2417         }
2418
2419         /*
2420          * For SD, its erase group is always one sector
2421          */
2422 #if CONFIG_IS_ENABLED(MMC_WRITE)
2423         mmc->erase_grp_size = 1;
2424 #endif
2425         mmc->part_config = MMCPART_NOAVAILABLE;
2426
2427         err = mmc_startup_v4(mmc);
2428         if (err)
2429                 return err;
2430
2431         err = mmc_set_capacity(mmc, mmc_get_blk_desc(mmc)->hwpart);
2432         if (err)
2433                 return err;
2434
2435 #if CONFIG_IS_ENABLED(MMC_TINY)
2436         mmc_set_clock(mmc, mmc->legacy_speed, false);
2437         mmc_select_mode(mmc, IS_SD(mmc) ? SD_LEGACY : MMC_LEGACY);
2438         mmc_set_bus_width(mmc, 1);
2439 #else
2440         if (IS_SD(mmc)) {
2441                 err = sd_get_capabilities(mmc);
2442                 if (err)
2443                         return err;
2444                 err = sd_select_mode_and_width(mmc, mmc->card_caps);
2445         } else {
2446                 err = mmc_get_capabilities(mmc);
2447                 if (err)
2448                         return err;
2449                 mmc_select_mode_and_width(mmc, mmc->card_caps);
2450         }
2451 #endif
2452         if (err)
2453                 return err;
2454
2455         mmc->best_mode = mmc->selected_mode;
2456
2457         /* Fix the block length for DDR mode */
2458         if (mmc->ddr_mode) {
2459                 mmc->read_bl_len = MMC_MAX_BLOCK_LEN;
2460 #if CONFIG_IS_ENABLED(MMC_WRITE)
2461                 mmc->write_bl_len = MMC_MAX_BLOCK_LEN;
2462 #endif
2463         }
2464
2465         /* fill in device description */
2466         bdesc = mmc_get_blk_desc(mmc);
2467         bdesc->lun = 0;
2468         bdesc->hwpart = 0;
2469         bdesc->type = 0;
2470         bdesc->blksz = mmc->read_bl_len;
2471         bdesc->log2blksz = LOG2(bdesc->blksz);
2472         bdesc->lba = lldiv(mmc->capacity, mmc->read_bl_len);
2473 #if !defined(CONFIG_SPL_BUILD) || \
2474                 (defined(CONFIG_SPL_LIBCOMMON_SUPPORT) && \
2475                 !defined(CONFIG_USE_TINY_PRINTF))
2476         sprintf(bdesc->vendor, "Man %06x Snr %04x%04x",
2477                 mmc->cid[0] >> 24, (mmc->cid[2] & 0xffff),
2478                 (mmc->cid[3] >> 16) & 0xffff);
2479         sprintf(bdesc->product, "%c%c%c%c%c%c", mmc->cid[0] & 0xff,
2480                 (mmc->cid[1] >> 24), (mmc->cid[1] >> 16) & 0xff,
2481                 (mmc->cid[1] >> 8) & 0xff, mmc->cid[1] & 0xff,
2482                 (mmc->cid[2] >> 24) & 0xff);
2483         sprintf(bdesc->revision, "%d.%d", (mmc->cid[2] >> 20) & 0xf,
2484                 (mmc->cid[2] >> 16) & 0xf);
2485 #else
2486         bdesc->vendor[0] = 0;
2487         bdesc->product[0] = 0;
2488         bdesc->revision[0] = 0;
2489 #endif
2490
2491 #if !defined(CONFIG_DM_MMC) && (!defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBDISK_SUPPORT))
2492         part_init(bdesc);
2493 #endif
2494
2495         return 0;
2496 }
2497
2498 static int mmc_send_if_cond(struct mmc *mmc)
2499 {
2500         struct mmc_cmd cmd;
2501         int err;
2502
2503         cmd.cmdidx = SD_CMD_SEND_IF_COND;
2504         /* We set the bit if the host supports voltages between 2.7 and 3.6 V */
2505         cmd.cmdarg = ((mmc->cfg->voltages & 0xff8000) != 0) << 8 | 0xaa;
2506         cmd.resp_type = MMC_RSP_R7;
2507
2508         err = mmc_send_cmd(mmc, &cmd, NULL);
2509
2510         if (err)
2511                 return err;
2512
2513         if ((cmd.response[0] & 0xff) != 0xaa)
2514                 return -EOPNOTSUPP;
2515         else
2516                 mmc->version = SD_VERSION_2;
2517
2518         return 0;
2519 }
2520
2521 #if !CONFIG_IS_ENABLED(DM_MMC)
2522 /* board-specific MMC power initializations. */
2523 __weak void board_mmc_power_init(void)
2524 {
2525 }
2526 #endif
2527
2528 static int mmc_power_init(struct mmc *mmc)
2529 {
2530 #if CONFIG_IS_ENABLED(DM_MMC)
2531 #if CONFIG_IS_ENABLED(DM_REGULATOR)
2532         int ret;
2533
2534         ret = device_get_supply_regulator(mmc->dev, "vmmc-supply",
2535                                           &mmc->vmmc_supply);
2536         if (ret)
2537                 pr_debug("%s: No vmmc supply\n", mmc->dev->name);
2538
2539         ret = device_get_supply_regulator(mmc->dev, "vqmmc-supply",
2540                                           &mmc->vqmmc_supply);
2541         if (ret)
2542                 pr_debug("%s: No vqmmc supply\n", mmc->dev->name);
2543 #endif
2544 #else /* !CONFIG_DM_MMC */
2545         /*
2546          * Driver model should use a regulator, as above, rather than calling
2547          * out to board code.
2548          */
2549         board_mmc_power_init();
2550 #endif
2551         return 0;
2552 }
2553
2554 /*
2555  * put the host in the initial state:
2556  * - turn on Vdd (card power supply)
2557  * - configure the bus width and clock to minimal values
2558  */
2559 static void mmc_set_initial_state(struct mmc *mmc)
2560 {
2561         int err;
2562
2563         /* First try to set 3.3V. If it fails set to 1.8V */
2564         err = mmc_set_signal_voltage(mmc, MMC_SIGNAL_VOLTAGE_330);
2565         if (err != 0)
2566                 err = mmc_set_signal_voltage(mmc, MMC_SIGNAL_VOLTAGE_180);
2567         if (err != 0)
2568                 pr_warn("mmc: failed to set signal voltage\n");
2569
2570         mmc_select_mode(mmc, MMC_LEGACY);
2571         mmc_set_bus_width(mmc, 1);
2572         mmc_set_clock(mmc, 0, MMC_CLK_ENABLE);
2573 }
2574
2575 static int mmc_power_on(struct mmc *mmc)
2576 {
2577 #if CONFIG_IS_ENABLED(DM_MMC) && CONFIG_IS_ENABLED(DM_REGULATOR)
2578         if (mmc->vmmc_supply) {
2579                 int ret = regulator_set_enable(mmc->vmmc_supply, true);
2580
2581                 if (ret) {
2582                         puts("Error enabling VMMC supply\n");
2583                         return ret;
2584                 }
2585         }
2586 #endif
2587         return 0;
2588 }
2589
2590 static int mmc_power_off(struct mmc *mmc)
2591 {
2592         mmc_set_clock(mmc, 0, MMC_CLK_DISABLE);
2593 #if CONFIG_IS_ENABLED(DM_MMC) && CONFIG_IS_ENABLED(DM_REGULATOR)
2594         if (mmc->vmmc_supply) {
2595                 int ret = regulator_set_enable(mmc->vmmc_supply, false);
2596
2597                 if (ret) {
2598                         pr_debug("Error disabling VMMC supply\n");
2599                         return ret;
2600                 }
2601         }
2602 #endif
2603         return 0;
2604 }
2605
2606 static int mmc_power_cycle(struct mmc *mmc)
2607 {
2608         int ret;
2609
2610         ret = mmc_power_off(mmc);
2611         if (ret)
2612                 return ret;
2613         /*
2614          * SD spec recommends at least 1ms of delay. Let's wait for 2ms
2615          * to be on the safer side.
2616          */
2617         udelay(2000);
2618         return mmc_power_on(mmc);
2619 }
2620
2621 int mmc_get_op_cond(struct mmc *mmc)
2622 {
2623         bool uhs_en = supports_uhs(mmc->cfg->host_caps);
2624         int err;
2625
2626         if (mmc->has_init)
2627                 return 0;
2628
2629 #ifdef CONFIG_FSL_ESDHC_ADAPTER_IDENT
2630         mmc_adapter_card_type_ident();
2631 #endif
2632         err = mmc_power_init(mmc);
2633         if (err)
2634                 return err;
2635
2636 #ifdef CONFIG_MMC_QUIRKS
2637         mmc->quirks = MMC_QUIRK_RETRY_SET_BLOCKLEN |
2638                       MMC_QUIRK_RETRY_SEND_CID;
2639 #endif
2640
2641         err = mmc_power_cycle(mmc);
2642         if (err) {
2643                 /*
2644                  * if power cycling is not supported, we should not try
2645                  * to use the UHS modes, because we wouldn't be able to
2646                  * recover from an error during the UHS initialization.
2647                  */
2648                 pr_debug("Unable to do a full power cycle. Disabling the UHS modes for safety\n");
2649                 uhs_en = false;
2650                 mmc->host_caps &= ~UHS_CAPS;
2651                 err = mmc_power_on(mmc);
2652         }
2653         if (err)
2654                 return err;
2655
2656 #if CONFIG_IS_ENABLED(DM_MMC)
2657         /* The device has already been probed ready for use */
2658 #else
2659         /* made sure it's not NULL earlier */
2660         err = mmc->cfg->ops->init(mmc);
2661         if (err)
2662                 return err;
2663 #endif
2664         mmc->ddr_mode = 0;
2665
2666 retry:
2667         mmc_set_initial_state(mmc);
2668         mmc_send_init_stream(mmc);
2669
2670         /* Reset the Card */
2671         err = mmc_go_idle(mmc);
2672
2673         if (err)
2674                 return err;
2675
2676         /* The internal partition reset to user partition(0) at every CMD0*/
2677         mmc_get_blk_desc(mmc)->hwpart = 0;
2678
2679         /* Test for SD version 2 */
2680         err = mmc_send_if_cond(mmc);
2681
2682         /* Now try to get the SD card's operating condition */
2683         err = sd_send_op_cond(mmc, uhs_en);
2684         if (err && uhs_en) {
2685                 uhs_en = false;
2686                 mmc_power_cycle(mmc);
2687                 goto retry;
2688         }
2689
2690         /* If the command timed out, we check for an MMC card */
2691         if (err == -ETIMEDOUT) {
2692                 err = mmc_send_op_cond(mmc);
2693
2694                 if (err) {
2695 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
2696                         pr_err("Card did not respond to voltage select!\n");
2697 #endif
2698                         return -EOPNOTSUPP;
2699                 }
2700         }
2701
2702         return err;
2703 }
2704
2705 int mmc_start_init(struct mmc *mmc)
2706 {
2707         bool no_card;
2708         int err = 0;
2709
2710         /*
2711          * all hosts are capable of 1 bit bus-width and able to use the legacy
2712          * timings.
2713          */
2714         mmc->host_caps = mmc->cfg->host_caps | MMC_CAP(SD_LEGACY) |
2715                          MMC_CAP(MMC_LEGACY) | MMC_MODE_1BIT;
2716
2717 #if !defined(CONFIG_MMC_BROKEN_CD)
2718         /* we pretend there's no card when init is NULL */
2719         no_card = mmc_getcd(mmc) == 0;
2720 #else
2721         no_card = 0;
2722 #endif
2723 #if !CONFIG_IS_ENABLED(DM_MMC)
2724         no_card = no_card || (mmc->cfg->ops->init == NULL);
2725 #endif
2726         if (no_card) {
2727                 mmc->has_init = 0;
2728 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
2729                 pr_err("MMC: no card present\n");
2730 #endif
2731                 return -ENOMEDIUM;
2732         }
2733
2734         err = mmc_get_op_cond(mmc);
2735
2736         if (!err)
2737                 mmc->init_in_progress = 1;
2738
2739         return err;
2740 }
2741
2742 static int mmc_complete_init(struct mmc *mmc)
2743 {
2744         int err = 0;
2745
2746         mmc->init_in_progress = 0;
2747         if (mmc->op_cond_pending)
2748                 err = mmc_complete_op_cond(mmc);
2749
2750         if (!err)
2751                 err = mmc_startup(mmc);
2752         if (err)
2753                 mmc->has_init = 0;
2754         else
2755                 mmc->has_init = 1;
2756         return err;
2757 }
2758
2759 int mmc_init(struct mmc *mmc)
2760 {
2761         int err = 0;
2762         __maybe_unused ulong start;
2763 #if CONFIG_IS_ENABLED(DM_MMC)
2764         struct mmc_uclass_priv *upriv = dev_get_uclass_priv(mmc->dev);
2765
2766         upriv->mmc = mmc;
2767 #endif
2768         if (mmc->has_init)
2769                 return 0;
2770
2771         start = get_timer(0);
2772
2773         if (!mmc->init_in_progress)
2774                 err = mmc_start_init(mmc);
2775
2776         if (!err)
2777                 err = mmc_complete_init(mmc);
2778         if (err)
2779                 pr_info("%s: %d, time %lu\n", __func__, err, get_timer(start));
2780
2781         return err;
2782 }
2783
2784 #if CONFIG_IS_ENABLED(MMC_UHS_SUPPORT) || \
2785     CONFIG_IS_ENABLED(MMC_HS200_SUPPORT) || \
2786     CONFIG_IS_ENABLED(MMC_HS400_SUPPORT)
2787 int mmc_deinit(struct mmc *mmc)
2788 {
2789         u32 caps_filtered;
2790
2791         if (!mmc->has_init)
2792                 return 0;
2793
2794         if (IS_SD(mmc)) {
2795                 caps_filtered = mmc->card_caps &
2796                         ~(MMC_CAP(UHS_SDR12) | MMC_CAP(UHS_SDR25) |
2797                           MMC_CAP(UHS_SDR50) | MMC_CAP(UHS_DDR50) |
2798                           MMC_CAP(UHS_SDR104));
2799
2800                 return sd_select_mode_and_width(mmc, caps_filtered);
2801         } else {
2802                 caps_filtered = mmc->card_caps &
2803                         ~(MMC_CAP(MMC_HS_200) | MMC_CAP(MMC_HS_400));
2804
2805                 return mmc_select_mode_and_width(mmc, caps_filtered);
2806         }
2807 }
2808 #endif
2809
2810 int mmc_set_dsr(struct mmc *mmc, u16 val)
2811 {
2812         mmc->dsr = val;
2813         return 0;
2814 }
2815
2816 /* CPU-specific MMC initializations */
2817 __weak int cpu_mmc_init(bd_t *bis)
2818 {
2819         return -1;
2820 }
2821
2822 /* board-specific MMC initializations. */
2823 __weak int board_mmc_init(bd_t *bis)
2824 {
2825         return -1;
2826 }
2827
2828 void mmc_set_preinit(struct mmc *mmc, int preinit)
2829 {
2830         mmc->preinit = preinit;
2831 }
2832
2833 #if CONFIG_IS_ENABLED(DM_MMC)
2834 static int mmc_probe(bd_t *bis)
2835 {
2836         int ret, i;
2837         struct uclass *uc;
2838         struct udevice *dev;
2839
2840         ret = uclass_get(UCLASS_MMC, &uc);
2841         if (ret)
2842                 return ret;
2843
2844         /*
2845          * Try to add them in sequence order. Really with driver model we
2846          * should allow holes, but the current MMC list does not allow that.
2847          * So if we request 0, 1, 3 we will get 0, 1, 2.
2848          */
2849         for (i = 0; ; i++) {
2850                 ret = uclass_get_device_by_seq(UCLASS_MMC, i, &dev);
2851                 if (ret == -ENODEV)
2852                         break;
2853         }
2854         uclass_foreach_dev(dev, uc) {
2855                 ret = device_probe(dev);
2856                 if (ret)
2857                         pr_err("%s - probe failed: %d\n", dev->name, ret);
2858         }
2859
2860         return 0;
2861 }
2862 #else
2863 static int mmc_probe(bd_t *bis)
2864 {
2865         if (board_mmc_init(bis) < 0)
2866                 cpu_mmc_init(bis);
2867
2868         return 0;
2869 }
2870 #endif
2871
2872 int mmc_initialize(bd_t *bis)
2873 {
2874         static int initialized = 0;
2875         int ret;
2876         if (initialized)        /* Avoid initializing mmc multiple times */
2877                 return 0;
2878         initialized = 1;
2879
2880 #if !CONFIG_IS_ENABLED(BLK)
2881 #if !CONFIG_IS_ENABLED(MMC_TINY)
2882         mmc_list_init();
2883 #endif
2884 #endif
2885         ret = mmc_probe(bis);
2886         if (ret)
2887                 return ret;
2888
2889 #ifndef CONFIG_SPL_BUILD
2890         print_mmc_devices(',');
2891 #endif
2892
2893         mmc_do_preinit();
2894         return 0;
2895 }
2896
2897 #ifdef CONFIG_CMD_BKOPS_ENABLE
2898 int mmc_set_bkops_enable(struct mmc *mmc)
2899 {
2900         int err;
2901         ALLOC_CACHE_ALIGN_BUFFER(u8, ext_csd, MMC_MAX_BLOCK_LEN);
2902
2903         err = mmc_send_ext_csd(mmc, ext_csd);
2904         if (err) {
2905                 puts("Could not get ext_csd register values\n");
2906                 return err;
2907         }
2908
2909         if (!(ext_csd[EXT_CSD_BKOPS_SUPPORT] & 0x1)) {
2910                 puts("Background operations not supported on device\n");
2911                 return -EMEDIUMTYPE;
2912         }
2913
2914         if (ext_csd[EXT_CSD_BKOPS_EN] & 0x1) {
2915                 puts("Background operations already enabled\n");
2916                 return 0;
2917         }
2918
2919         err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_BKOPS_EN, 1);
2920         if (err) {
2921                 puts("Failed to enable manual background operations\n");
2922                 return err;
2923         }
2924
2925         puts("Enabled manual background operations\n");
2926
2927         return 0;
2928 }
2929 #endif