drivers/mmc/core/mmc.c

   1 /*
   2  *  linux/drivers/mmc/core/mmc.c
   3  *
   4  *  Copyright (C) 2003-2004 Russell King, All Rights Reserved.
   5  *  Copyright (C) 2005-2007 Pierre Ossman, All Rights Reserved.
   6  *  MMCv4 support Copyright (C) 2006 Philip Langdale, All Rights Reserved.
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License version 2 as
  10  * published by the Free Software Foundation.
  11  */
  12
  13 #include <linux/err.h>
  14 #include <linux/of.h>
  15 #include <linux/slab.h>
  16 #include <linux/stat.h>
  17 #include <linux/pm_runtime.h>
  18
  19 #include <linux/mmc/host.h>
  20 #include <linux/mmc/card.h>
  21 #include <linux/mmc/mmc.h>
  22
  23 #include "core.h"
  24 #include "host.h"
  25 #include "bus.h"
  26 #include "mmc_ops.h"
  27 #include "sd_ops.h"
  28
  29 static const unsigned int tran_exp[] = {
  30         10000,          100000,         1000000,        10000000,
  31         0,              0,              0,              0
  32 };
  33
  34 static const unsigned char tran_mant[] = {
  35         0,      10,     12,     13,     15,     20,     25,     30,
  36         35,     40,     45,     50,     55,     60,     70,     80,
  37 };
  38
  39 static const unsigned int tacc_exp[] = {
  40         1,      10,     100,    1000,   10000,  100000, 1000000, 10000000,
  41 };
  42
  43 static const unsigned int tacc_mant[] = {
  44         0,      10,     12,     13,     15,     20,     25,     30,
  45         35,     40,     45,     50,     55,     60,     70,     80,
  46 };
  47
  48 #define UNSTUFF_BITS(resp,start,size)                                   \
  49         ({                                                              \
  50                 const int __size = size;                                \
  51                 const u32 __mask = (__size < 32 ? 1 << __size : 0) - 1; \
  52                 const int __off = 3 - ((start) / 32);                   \
  53                 const int __shft = (start) & 31;                        \
  54                 u32 __res;                                              \
  55                                                                         \
  56                 __res = resp[__off] >> __shft;                          \
  57                 if (__size + __shft > 32)                               \
  58                         __res |= resp[__off-1] << ((32 - __shft) % 32); \
  59                 __res & __mask;                                         \
  60         })
  61
  62 /*
  63  * Given the decoded CSD structure, decode the raw CID to our CID structure.
  64  */
  65 static int mmc_decode_cid(struct mmc_card *card)
  66 {
  67         u32 *resp = card->raw_cid;
  68
  69         /*
  70          * The selection of the format here is based upon published
  71          * specs from sandisk and from what people have reported.
  72          */
  73         switch (card->csd.mmca_vsn) {
  74         case 0: /* MMC v1.0 - v1.2 */
  75         case 1: /* MMC v1.4 */
  76                 card->cid.manfid        = UNSTUFF_BITS(resp, 104, 24);
  77                 card->cid.prod_name[0]  = UNSTUFF_BITS(resp, 96, 8);
  78                 card->cid.prod_name[1]  = UNSTUFF_BITS(resp, 88, 8);
  79                 card->cid.prod_name[2]  = UNSTUFF_BITS(resp, 80, 8);
  80                 card->cid.prod_name[3]  = UNSTUFF_BITS(resp, 72, 8);
  81                 card->cid.prod_name[4]  = UNSTUFF_BITS(resp, 64, 8);
  82                 card->cid.prod_name[5]  = UNSTUFF_BITS(resp, 56, 8);
  83                 card->cid.prod_name[6]  = UNSTUFF_BITS(resp, 48, 8);
  84                 card->cid.hwrev         = UNSTUFF_BITS(resp, 44, 4);
  85                 card->cid.fwrev         = UNSTUFF_BITS(resp, 40, 4);
  86                 card->cid.serial        = UNSTUFF_BITS(resp, 16, 24);
  87                 card->cid.month         = UNSTUFF_BITS(resp, 12, 4);
  88                 card->cid.year          = UNSTUFF_BITS(resp, 8, 4) + 1997;
  89                 break;
  90
  91         case 2: /* MMC v2.0 - v2.2 */
  92         case 3: /* MMC v3.1 - v3.3 */
  93         case 4: /* MMC v4 */
  94                 card->cid.manfid        = UNSTUFF_BITS(resp, 120, 8);
  95                 card->cid.oemid         = UNSTUFF_BITS(resp, 104, 16);
  96                 card->cid.prod_name[0]  = UNSTUFF_BITS(resp, 96, 8);
  97                 card->cid.prod_name[1]  = UNSTUFF_BITS(resp, 88, 8);
  98                 card->cid.prod_name[2]  = UNSTUFF_BITS(resp, 80, 8);
  99                 card->cid.prod_name[3]  = UNSTUFF_BITS(resp, 72, 8);
 100                 card->cid.prod_name[4]  = UNSTUFF_BITS(resp, 64, 8);
 101                 card->cid.prod_name[5]  = UNSTUFF_BITS(resp, 56, 8);
 102                 card->cid.prv           = UNSTUFF_BITS(resp, 48, 8);
 103                 card->cid.serial        = UNSTUFF_BITS(resp, 16, 32);
 104                 card->cid.month         = UNSTUFF_BITS(resp, 12, 4);
 105                 card->cid.year          = UNSTUFF_BITS(resp, 8, 4) + 1997;
 106                 break;
 107
 108         default:
 109                 pr_err("%s: card has unknown MMCA version %d\n",
 110                         mmc_hostname(card->host), card->csd.mmca_vsn);
 111                 return -EINVAL;
 112         }
 113
 114         return 0;
 115 }
 116
 117 static void mmc_set_erase_size(struct mmc_card *card)
 118 {
 119         if (card->ext_csd.erase_group_def & 1)
 120                 card->erase_size = card->ext_csd.hc_erase_size;
 121         else
 122                 card->erase_size = card->csd.erase_size;
 123
 124         mmc_init_erase(card);
 125 }
 126
 127 /*
 128  * Given a 128-bit response, decode to our card CSD structure.
 129  */
 130 static int mmc_decode_csd(struct mmc_card *card)
 131 {
 132         struct mmc_csd *csd = &card->csd;
 133         unsigned int e, m, a, b;
 134         u32 *resp = card->raw_csd;
 135
 136         /*
 137          * We only understand CSD structure v1.1 and v1.2.
 138          * v1.2 has extra information in bits 15, 11 and 10.
 139          * We also support eMMC v4.4 & v4.41.
 140          */
 141         csd->structure = UNSTUFF_BITS(resp, 126, 2);
 142         if (csd->structure == 0) {
 143                 pr_err("%s: unrecognised CSD structure version %d\n",
 144                         mmc_hostname(card->host), csd->structure);
 145                 return -EINVAL;
 146         }
 147
 148         csd->mmca_vsn    = UNSTUFF_BITS(resp, 122, 4);
 149         m = UNSTUFF_BITS(resp, 115, 4);
 150         e = UNSTUFF_BITS(resp, 112, 3);
 151         csd->tacc_ns     = (tacc_exp[e] * tacc_mant[m] + 9) / 10;
 152         csd->tacc_clks   = UNSTUFF_BITS(resp, 104, 8) * 100;
 153
 154         m = UNSTUFF_BITS(resp, 99, 4);
 155         e = UNSTUFF_BITS(resp, 96, 3);
 156         csd->max_dtr      = tran_exp[e] * tran_mant[m];
 157         csd->cmdclass     = UNSTUFF_BITS(resp, 84, 12);
 158
 159         e = UNSTUFF_BITS(resp, 47, 3);
 160         m = UNSTUFF_BITS(resp, 62, 12);
 161         csd->capacity     = (1 + m) << (e + 2);
 162
 163         csd->read_blkbits = UNSTUFF_BITS(resp, 80, 4);
 164         csd->read_partial = UNSTUFF_BITS(resp, 79, 1);
 165         csd->write_misalign = UNSTUFF_BITS(resp, 78, 1);
 166         csd->read_misalign = UNSTUFF_BITS(resp, 77, 1);
 167         csd->dsr_imp = UNSTUFF_BITS(resp, 76, 1);
 168         csd->r2w_factor = UNSTUFF_BITS(resp, 26, 3);
 169         csd->write_blkbits = UNSTUFF_BITS(resp, 22, 4);
 170         csd->write_partial = UNSTUFF_BITS(resp, 21, 1);
 171
 172         if (csd->write_blkbits >= 9) {
 173                 a = UNSTUFF_BITS(resp, 42, 5);
 174                 b = UNSTUFF_BITS(resp, 37, 5);
 175                 csd->erase_size = (a + 1) * (b + 1);
 176                 csd->erase_size <<= csd->write_blkbits - 9;
 177         }
 178
 179         return 0;
 180 }
 181
 182 static void mmc_select_card_type(struct mmc_card *card)
 183 {
 184         struct mmc_host *host = card->host;
 185         u8 card_type = card->ext_csd.raw_card_type;
 186         u32 caps = host->caps, caps2 = host->caps2;
 187         unsigned int hs_max_dtr = 0, hs200_max_dtr = 0;
 188         unsigned int avail_type = 0;
 189
 190         if (caps & MMC_CAP_MMC_HIGHSPEED &&
 191             card_type & EXT_CSD_CARD_TYPE_HS_26) {
 192                 hs_max_dtr = MMC_HIGH_26_MAX_DTR;
 193                 avail_type |= EXT_CSD_CARD_TYPE_HS_26;
 194         }
 195
 196         if (caps & MMC_CAP_MMC_HIGHSPEED &&
 197             card_type & EXT_CSD_CARD_TYPE_HS_52) {
 198                 hs_max_dtr = MMC_HIGH_52_MAX_DTR;
 199                 avail_type |= EXT_CSD_CARD_TYPE_HS_52;
 200         }
 201
 202         if (caps & MMC_CAP_1_8V_DDR &&
 203             card_type & EXT_CSD_CARD_TYPE_DDR_1_8V) {
 204                 hs_max_dtr = MMC_HIGH_DDR_MAX_DTR;
 205                 avail_type |= EXT_CSD_CARD_TYPE_DDR_1_8V;
 206         }
 207
 208         if (caps & MMC_CAP_1_2V_DDR &&
 209             card_type & EXT_CSD_CARD_TYPE_DDR_1_2V) {
 210                 hs_max_dtr = MMC_HIGH_DDR_MAX_DTR;
 211                 avail_type |= EXT_CSD_CARD_TYPE_DDR_1_2V;
 212         }
 213
 214         if (caps2 & MMC_CAP2_HS200_1_8V_SDR &&
 215             card_type & EXT_CSD_CARD_TYPE_HS200_1_8V) {
 216                 hs200_max_dtr = MMC_HS200_MAX_DTR;
 217                 avail_type |= EXT_CSD_CARD_TYPE_HS200_1_8V;
 218         }
 219
 220         if (caps2 & MMC_CAP2_HS200_1_2V_SDR &&
 221             card_type & EXT_CSD_CARD_TYPE_HS200_1_2V) {
 222                 hs200_max_dtr = MMC_HS200_MAX_DTR;
 223                 avail_type |= EXT_CSD_CARD_TYPE_HS200_1_2V;
 224         }
 225
 226         if (caps2 & MMC_CAP2_HS400_1_8V &&
 227             card_type & EXT_CSD_CARD_TYPE_HS400_1_8V) {
 228                 hs200_max_dtr = MMC_HS200_MAX_DTR;
 229                 avail_type |= EXT_CSD_CARD_TYPE_HS400_1_8V;
 230         }
 231
 232         if (caps2 & MMC_CAP2_HS400_1_2V &&
 233             card_type & EXT_CSD_CARD_TYPE_HS400_1_2V) {
 234                 hs200_max_dtr = MMC_HS200_MAX_DTR;
 235                 avail_type |= EXT_CSD_CARD_TYPE_HS400_1_2V;
 236         }
 237
 238         if ((caps2 & MMC_CAP2_HS400_ES) &&
 239                 card->ext_csd.strobe_support &&
 240                 (avail_type & EXT_CSD_CARD_TYPE_HS400))
 241                 avail_type |= EXT_CSD_CARD_TYPE_HS400ES;
 242
 243         card->ext_csd.hs_max_dtr = hs_max_dtr;
 244         card->ext_csd.hs200_max_dtr = hs200_max_dtr;
 245         card->mmc_avail_type = avail_type;
 246 }
 247
 248 static void mmc_manage_enhanced_area(struct mmc_card *card, u8 *ext_csd)
 249 {
 250         u8 hc_erase_grp_sz, hc_wp_grp_sz;
 251
 252         /*
 253          * Disable these attributes by default
 254          */
 255         card->ext_csd.enhanced_area_offset = -EINVAL;
 256         card->ext_csd.enhanced_area_size = -EINVAL;
 257
 258         /*
 259          * Enhanced area feature support -- check whether the eMMC
 260          * card has the Enhanced area enabled.  If so, export enhanced
 261          * area offset and size to user by adding sysfs interface.
 262          */
 263         if ((ext_csd[EXT_CSD_PARTITION_SUPPORT] & 0x2) &&
 264             (ext_csd[EXT_CSD_PARTITION_ATTRIBUTE] & 0x1)) {
 265                 if (card->ext_csd.partition_setting_completed) {
 266                         hc_erase_grp_sz =
 267                                 ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
 268                         hc_wp_grp_sz =
 269                                 ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
 270
 271                         /*
 272                          * calculate the enhanced data area offset, in bytes
 273                          */
 274                         card->ext_csd.enhanced_area_offset =
 275                                 (((unsigned long long)ext_csd[139]) << 24) +
 276                                 (((unsigned long long)ext_csd[138]) << 16) +
 277                                 (((unsigned long long)ext_csd[137]) << 8) +
 278                                 (((unsigned long long)ext_csd[136]));
 279                         if (mmc_card_blockaddr(card))
 280                                 card->ext_csd.enhanced_area_offset <<= 9;
 281                         /*
 282                          * calculate the enhanced data area size, in kilobytes
 283                          */
 284                         card->ext_csd.enhanced_area_size =
 285                                 (ext_csd[142] << 16) + (ext_csd[141] << 8) +
 286                                 ext_csd[140];
 287                         card->ext_csd.enhanced_area_size *=
 288                                 (size_t)(hc_erase_grp_sz * hc_wp_grp_sz);
 289                         card->ext_csd.enhanced_area_size <<= 9;
 290                 } else {
 291                         pr_warn("%s: defines enhanced area without partition setting complete\n",
 292                                 mmc_hostname(card->host));
 293                 }
 294         }
 295 }
 296
 297 static void mmc_manage_gp_partitions(struct mmc_card *card, u8 *ext_csd)
 298 {
 299         int idx;
 300         u8 hc_erase_grp_sz, hc_wp_grp_sz;
 301         unsigned int part_size;
 302
 303         /*
 304          * General purpose partition feature support --
 305          * If ext_csd has the size of general purpose partitions,
 306          * set size, part_cfg, partition name in mmc_part.
 307          */
 308         if (ext_csd[EXT_CSD_PARTITION_SUPPORT] &
 309             EXT_CSD_PART_SUPPORT_PART_EN) {
 310                 hc_erase_grp_sz =
 311                         ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
 312                 hc_wp_grp_sz =
 313                         ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
 314
 315                 for (idx = 0; idx < MMC_NUM_GP_PARTITION; idx++) {
 316                         if (!ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3] &&
 317                             !ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 1] &&
 318                             !ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 2])
 319                                 continue;
 320                         if (card->ext_csd.partition_setting_completed == 0) {
 321                                 pr_warn("%s: has partition size defined without partition complete\n",
 322                                         mmc_hostname(card->host));
 323                                 break;
 324                         }
 325                         part_size =
 326                                 (ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 2]
 327                                 << 16) +
 328                                 (ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 1]
 329                                 << 8) +
 330                                 ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3];
 331                         part_size *= (size_t)(hc_erase_grp_sz *
 332                                 hc_wp_grp_sz);
 333                         mmc_part_add(card, part_size << 19,
 334                                 EXT_CSD_PART_CONFIG_ACC_GP0 + idx,
 335                                 "gp%d", idx, false,
 336                                 MMC_BLK_DATA_AREA_GP);
 337                 }
 338         }
 339 }
 340
 341 /* Minimum partition switch timeout in milliseconds */
 342 #define MMC_MIN_PART_SWITCH_TIME        300
 343
 344 /*
 345  * Decode extended CSD.
 346  */
 347 static int mmc_decode_ext_csd(struct mmc_card *card, u8 *ext_csd)
 348 {
 349         int err = 0, idx;
 350         unsigned int part_size;
 351         struct device_node *np;
 352         bool broken_hpi = false;
 353
 354         /* Version is coded in the CSD_STRUCTURE byte in the EXT_CSD register */
 355         card->ext_csd.raw_ext_csd_structure = ext_csd[EXT_CSD_STRUCTURE];
 356         if (card->csd.structure == 3) {
 357                 if (card->ext_csd.raw_ext_csd_structure > 2) {
 358                         pr_err("%s: unrecognised EXT_CSD structure "
 359                                 "version %d\n", mmc_hostname(card->host),
 360                                         card->ext_csd.raw_ext_csd_structure);
 361                         err = -EINVAL;
 362                         goto out;
 363                 }
 364         }
 365
 366         np = mmc_of_find_child_device(card->host, 0);
 367         if (np && of_device_is_compatible(np, "mmc-card"))
 368                 broken_hpi = of_property_read_bool(np, "broken-hpi");
 369         of_node_put(np);
 370
 371         /*
 372          * The EXT_CSD format is meant to be forward compatible. As long
 373          * as CSD_STRUCTURE does not change, all values for EXT_CSD_REV
 374          * are authorized, see JEDEC JESD84-B50 section B.8.
 375          */
 376         card->ext_csd.rev = ext_csd[EXT_CSD_REV];
 377
 378         card->ext_csd.raw_sectors[0] = ext_csd[EXT_CSD_SEC_CNT + 0];
 379         card->ext_csd.raw_sectors[1] = ext_csd[EXT_CSD_SEC_CNT + 1];
 380         card->ext_csd.raw_sectors[2] = ext_csd[EXT_CSD_SEC_CNT + 2];
 381         card->ext_csd.raw_sectors[3] = ext_csd[EXT_CSD_SEC_CNT + 3];
 382         if (card->ext_csd.rev >= 2) {
 383                 card->ext_csd.sectors =
 384                         ext_csd[EXT_CSD_SEC_CNT + 0] << 0 |
 385                         ext_csd[EXT_CSD_SEC_CNT + 1] << 8 |
 386                         ext_csd[EXT_CSD_SEC_CNT + 2] << 16 |
 387                         ext_csd[EXT_CSD_SEC_CNT + 3] << 24;
 388
 389                 /* Cards with density > 2GiB are sector addressed */
 390                 if (card->ext_csd.sectors > (2u * 1024 * 1024 * 1024) / 512)
 391                         mmc_card_set_blockaddr(card);
 392         }
 393
 394         /*
 395          * Enhance Strobe is supported since v5.1 which rev should be
 396          * 8 but some eMMC devices can support it with rev 7. So handle
 397          * Enhance Strobe here.
 398          */
 399         card->ext_csd.strobe_support = ext_csd[EXT_CSD_STROBE_SUPPORT];
 400
 401         card->ext_csd.raw_card_type = ext_csd[EXT_CSD_CARD_TYPE];
 402         mmc_select_card_type(card);
 403
 404         card->ext_csd.raw_s_a_timeout = ext_csd[EXT_CSD_S_A_TIMEOUT];
 405         card->ext_csd.raw_erase_timeout_mult =
 406                 ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT];
 407         card->ext_csd.raw_hc_erase_grp_size =
 408                 ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
 409         if (card->ext_csd.rev >= 3) {
 410                 u8 sa_shift = ext_csd[EXT_CSD_S_A_TIMEOUT];
 411                 card->ext_csd.part_config = ext_csd[EXT_CSD_PART_CONFIG];
 412
 413                 /* EXT_CSD value is in units of 10ms, but we store in ms */
 414                 card->ext_csd.part_time = 10 * ext_csd[EXT_CSD_PART_SWITCH_TIME];
 415                 /* Some eMMC set the value too low so set a minimum */
 416                 if (card->ext_csd.part_time &&
 417                     card->ext_csd.part_time < MMC_MIN_PART_SWITCH_TIME)
 418                         card->ext_csd.part_time = MMC_MIN_PART_SWITCH_TIME;
 419
 420                 /* Sleep / awake timeout in 100ns units */
 421                 if (sa_shift > 0 && sa_shift <= 0x17)
 422                         card->ext_csd.sa_timeout =
 423                                         1 << ext_csd[EXT_CSD_S_A_TIMEOUT];
 424                 card->ext_csd.erase_group_def =
 425                         ext_csd[EXT_CSD_ERASE_GROUP_DEF];
 426                 card->ext_csd.hc_erase_timeout = 300 *
 427                         ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT];
 428                 card->ext_csd.hc_erase_size =
 429                         ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE] << 10;
 430
 431                 card->ext_csd.rel_sectors = ext_csd[EXT_CSD_REL_WR_SEC_C];
 432
 433                 /*
 434                  * There are two boot regions of equal size, defined in
 435                  * multiples of 128K.
 436                  */
 437                 if (ext_csd[EXT_CSD_BOOT_MULT] && mmc_boot_partition_access(card->host)) {
 438                         for (idx = 0; idx < MMC_NUM_BOOT_PARTITION; idx++) {
 439                                 part_size = ext_csd[EXT_CSD_BOOT_MULT] << 17;
 440                                 mmc_part_add(card, part_size,
 441                                         EXT_CSD_PART_CONFIG_ACC_BOOT0 + idx,
 442                                         "boot%d", idx, true,
 443                                         MMC_BLK_DATA_AREA_BOOT);
 444                         }
 445                 }
 446         }
 447
 448         card->ext_csd.raw_hc_erase_gap_size =
 449                 ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
 450         card->ext_csd.raw_sec_trim_mult =
 451                 ext_csd[EXT_CSD_SEC_TRIM_MULT];
 452         card->ext_csd.raw_sec_erase_mult =
 453                 ext_csd[EXT_CSD_SEC_ERASE_MULT];
 454         card->ext_csd.raw_sec_feature_support =
 455                 ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT];
 456         card->ext_csd.raw_trim_mult =
 457                 ext_csd[EXT_CSD_TRIM_MULT];
 458         card->ext_csd.raw_partition_support = ext_csd[EXT_CSD_PARTITION_SUPPORT];
 459         card->ext_csd.raw_driver_strength = ext_csd[EXT_CSD_DRIVER_STRENGTH];
 460         if (card->ext_csd.rev >= 4) {
 461                 if (ext_csd[EXT_CSD_PARTITION_SETTING_COMPLETED] &
 462                     EXT_CSD_PART_SETTING_COMPLETED)
 463                         card->ext_csd.partition_setting_completed = 1;
 464                 else
 465                         card->ext_csd.partition_setting_completed = 0;
 466
 467                 mmc_manage_enhanced_area(card, ext_csd);
 468
 469                 mmc_manage_gp_partitions(card, ext_csd);
 470
 471                 card->ext_csd.sec_trim_mult =
 472                         ext_csd[EXT_CSD_SEC_TRIM_MULT];
 473                 card->ext_csd.sec_erase_mult =
 474                         ext_csd[EXT_CSD_SEC_ERASE_MULT];
 475                 card->ext_csd.sec_feature_support =
 476                         ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT];
 477                 card->ext_csd.trim_timeout = 300 *
 478                         ext_csd[EXT_CSD_TRIM_MULT];
 479
 480                 /*
 481                  * Note that the call to mmc_part_add above defaults to read
 482                  * only. If this default assumption is changed, the call must
 483                  * take into account the value of boot_locked below.
 484                  */
 485                 card->ext_csd.boot_ro_lock = ext_csd[EXT_CSD_BOOT_WP];
 486                 card->ext_csd.boot_ro_lockable = true;
 487
 488                 /* Save power class values */
 489                 card->ext_csd.raw_pwr_cl_52_195 =
 490                         ext_csd[EXT_CSD_PWR_CL_52_195];
 491                 card->ext_csd.raw_pwr_cl_26_195 =
 492                         ext_csd[EXT_CSD_PWR_CL_26_195];
 493                 card->ext_csd.raw_pwr_cl_52_360 =
 494                         ext_csd[EXT_CSD_PWR_CL_52_360];
 495                 card->ext_csd.raw_pwr_cl_26_360 =
 496                         ext_csd[EXT_CSD_PWR_CL_26_360];
 497                 card->ext_csd.raw_pwr_cl_200_195 =
 498                         ext_csd[EXT_CSD_PWR_CL_200_195];
 499                 card->ext_csd.raw_pwr_cl_200_360 =
 500                         ext_csd[EXT_CSD_PWR_CL_200_360];
 501                 card->ext_csd.raw_pwr_cl_ddr_52_195 =
 502                         ext_csd[EXT_CSD_PWR_CL_DDR_52_195];
 503                 card->ext_csd.raw_pwr_cl_ddr_52_360 =
 504                         ext_csd[EXT_CSD_PWR_CL_DDR_52_360];
 505                 card->ext_csd.raw_pwr_cl_ddr_200_360 =
 506                         ext_csd[EXT_CSD_PWR_CL_DDR_200_360];
 507         }
 508
 509         if (card->ext_csd.rev >= 5) {
 510                 /* Adjust production date as per JEDEC JESD84-B451 */
 511                 if (card->cid.year < 2010)
 512                         card->cid.year += 16;
 513
 514                 /* check whether the eMMC card supports BKOPS */
 515                 if (ext_csd[EXT_CSD_BKOPS_SUPPORT] & 0x1) {
 516                         card->ext_csd.bkops = 1;
 517                         card->ext_csd.man_bkops_en =
 518                                         (ext_csd[EXT_CSD_BKOPS_EN] &
 519                                                 EXT_CSD_MANUAL_BKOPS_MASK);
 520                         card->ext_csd.raw_bkops_status =
 521                                 ext_csd[EXT_CSD_BKOPS_STATUS];
 522                         if (!card->ext_csd.man_bkops_en)
 523                                 pr_info("%s: MAN_BKOPS_EN bit is not set\n",
 524                                         mmc_hostname(card->host));
 525                 }
 526
 527                 /* check whether the eMMC card supports HPI */
 528                 if (!broken_hpi && (ext_csd[EXT_CSD_HPI_FEATURES] & 0x1)) {
 529                         card->ext_csd.hpi = 1;
 530                         if (ext_csd[EXT_CSD_HPI_FEATURES] & 0x2)
 531                                 card->ext_csd.hpi_cmd = MMC_STOP_TRANSMISSION;
 532                         else
 533                                 card->ext_csd.hpi_cmd = MMC_SEND_STATUS;
 534                         /*
 535                          * Indicate the maximum timeout to close
 536                          * a command interrupted by HPI
 537                          */
 538                         card->ext_csd.out_of_int_time =
 539                                 ext_csd[EXT_CSD_OUT_OF_INTERRUPT_TIME] * 10;
 540                 }
 541
 542                 card->ext_csd.rel_param = ext_csd[EXT_CSD_WR_REL_PARAM];
 543                 card->ext_csd.rst_n_function = ext_csd[EXT_CSD_RST_N_FUNCTION];
 544
 545                 /*
 546                  * RPMB regions are defined in multiples of 128K.
 547                  */
 548                 card->ext_csd.raw_rpmb_size_mult = ext_csd[EXT_CSD_RPMB_MULT];
 549                 if (ext_csd[EXT_CSD_RPMB_MULT] && mmc_host_cmd23(card->host)) {
 550                         mmc_part_add(card, ext_csd[EXT_CSD_RPMB_MULT] << 17,
 551                                 EXT_CSD_PART_CONFIG_ACC_RPMB,
 552                                 "rpmb", 0, false,
 553                                 MMC_BLK_DATA_AREA_RPMB);
 554                 }
 555         }
 556
 557         card->ext_csd.raw_erased_mem_count = ext_csd[EXT_CSD_ERASED_MEM_CONT];
 558         if (ext_csd[EXT_CSD_ERASED_MEM_CONT])
 559                 card->erased_byte = 0xFF;
 560         else
 561                 card->erased_byte = 0x0;
 562
 563         /* eMMC v4.5 or later */
 564         if (card->ext_csd.rev >= 6) {
 565                 card->ext_csd.feature_support |= MMC_DISCARD_FEATURE;
 566
 567                 card->ext_csd.generic_cmd6_time = 10 *
 568                         ext_csd[EXT_CSD_GENERIC_CMD6_TIME];
 569                 card->ext_csd.power_off_longtime = 10 *
 570                         ext_csd[EXT_CSD_POWER_OFF_LONG_TIME];
 571
 572                 card->ext_csd.cache_size =
 573                         ext_csd[EXT_CSD_CACHE_SIZE + 0] << 0 |
 574                         ext_csd[EXT_CSD_CACHE_SIZE + 1] << 8 |
 575                         ext_csd[EXT_CSD_CACHE_SIZE + 2] << 16 |
 576                         ext_csd[EXT_CSD_CACHE_SIZE + 3] << 24;
 577
 578                 if (ext_csd[EXT_CSD_DATA_SECTOR_SIZE] == 1)
 579                         card->ext_csd.data_sector_size = 4096;
 580                 else
 581                         card->ext_csd.data_sector_size = 512;
 582
 583                 if ((ext_csd[EXT_CSD_DATA_TAG_SUPPORT] & 1) &&
 584                     (ext_csd[EXT_CSD_TAG_UNIT_SIZE] <= 8)) {
 585                         card->ext_csd.data_tag_unit_size =
 586                         ((unsigned int) 1 << ext_csd[EXT_CSD_TAG_UNIT_SIZE]) *
 587                         (card->ext_csd.data_sector_size);
 588                 } else {
 589                         card->ext_csd.data_tag_unit_size = 0;
 590                 }
 591
 592                 card->ext_csd.max_packed_writes =
 593                         ext_csd[EXT_CSD_MAX_PACKED_WRITES];
 594                 card->ext_csd.max_packed_reads =
 595                         ext_csd[EXT_CSD_MAX_PACKED_READS];
 596         } else {
 597                 card->ext_csd.data_sector_size = 512;
 598         }
 599
 600         /* eMMC v5 or later */
 601         if (card->ext_csd.rev >= 7) {
 602                 memcpy(card->ext_csd.fwrev, &ext_csd[EXT_CSD_FIRMWARE_VERSION],
 603                        MMC_FIRMWARE_LEN);
 604                 card->ext_csd.ffu_capable =
 605                         (ext_csd[EXT_CSD_SUPPORTED_MODE] & 0x1) &&
 606                         !(ext_csd[EXT_CSD_FW_CONFIG] & 0x1);
 607         }
 608 out:
 609         return err;
 610 }
 611
 612 static int mmc_read_ext_csd(struct mmc_card *card)
 613 {
 614         u8 *ext_csd;
 615         int err;
 616
 617         if (!mmc_can_ext_csd(card))
 618                 return 0;
 619
 620         err = mmc_get_ext_csd(card, &ext_csd);
 621         if (err) {
 622                 /* If the host or the card can't do the switch,
 623                  * fail more gracefully. */
 624                 if ((err != -EINVAL)
 625                  && (err != -ENOSYS)
 626                  && (err != -EFAULT))
 627                         return err;
 628
 629                 /*
 630                  * High capacity cards should have this "magic" size
 631                  * stored in their CSD.
 632                  */
 633                 if (card->csd.capacity == (4096 * 512)) {
 634                         pr_err("%s: unable to read EXT_CSD on a possible high capacity card. Card will be ignored.\n",
 635                                 mmc_hostname(card->host));
 636                 } else {
 637                         pr_warn("%s: unable to read EXT_CSD, performance might suffer\n",
 638                                 mmc_hostname(card->host));
 639                         err = 0;
 640                 }
 641
 642                 return err;
 643         }
 644
 645         err = mmc_decode_ext_csd(card, ext_csd);
 646         kfree(ext_csd);
 647         return err;
 648 }
 649
 650 static int mmc_compare_ext_csds(struct mmc_card *card, unsigned bus_width)
 651 {
 652         u8 *bw_ext_csd;
 653         int err;
 654
 655         if (bus_width == MMC_BUS_WIDTH_1)
 656                 return 0;
 657
 658         err = mmc_get_ext_csd(card, &bw_ext_csd);
 659         if (err)
 660                 return err;
 661
 662         /* only compare read only fields */
 663         err = !((card->ext_csd.raw_partition_support ==
 664                         bw_ext_csd[EXT_CSD_PARTITION_SUPPORT]) &&
 665                 (card->ext_csd.raw_erased_mem_count ==
 666                         bw_ext_csd[EXT_CSD_ERASED_MEM_CONT]) &&
 667                 (card->ext_csd.rev ==
 668                         bw_ext_csd[EXT_CSD_REV]) &&
 669                 (card->ext_csd.raw_ext_csd_structure ==
 670                         bw_ext_csd[EXT_CSD_STRUCTURE]) &&
 671                 (card->ext_csd.raw_card_type ==
 672                         bw_ext_csd[EXT_CSD_CARD_TYPE]) &&
 673                 (card->ext_csd.raw_s_a_timeout ==
 674                         bw_ext_csd[EXT_CSD_S_A_TIMEOUT]) &&
 675                 (card->ext_csd.raw_hc_erase_gap_size ==
 676                         bw_ext_csd[EXT_CSD_HC_WP_GRP_SIZE]) &&
 677                 (card->ext_csd.raw_erase_timeout_mult ==
 678                         bw_ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT]) &&
 679                 (card->ext_csd.raw_hc_erase_grp_size ==
 680                         bw_ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]) &&
 681                 (card->ext_csd.raw_sec_trim_mult ==
 682                         bw_ext_csd[EXT_CSD_SEC_TRIM_MULT]) &&
 683                 (card->ext_csd.raw_sec_erase_mult ==
 684                         bw_ext_csd[EXT_CSD_SEC_ERASE_MULT]) &&
 685                 (card->ext_csd.raw_sec_feature_support ==
 686                         bw_ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT]) &&
 687                 (card->ext_csd.raw_trim_mult ==
 688                         bw_ext_csd[EXT_CSD_TRIM_MULT]) &&
 689                 (card->ext_csd.raw_sectors[0] ==
 690                         bw_ext_csd[EXT_CSD_SEC_CNT + 0]) &&
 691                 (card->ext_csd.raw_sectors[1] ==
 692                         bw_ext_csd[EXT_CSD_SEC_CNT + 1]) &&
 693                 (card->ext_csd.raw_sectors[2] ==
 694                         bw_ext_csd[EXT_CSD_SEC_CNT + 2]) &&
 695                 (card->ext_csd.raw_sectors[3] ==
 696                         bw_ext_csd[EXT_CSD_SEC_CNT + 3]) &&
 697                 (card->ext_csd.raw_pwr_cl_52_195 ==
 698                         bw_ext_csd[EXT_CSD_PWR_CL_52_195]) &&
 699                 (card->ext_csd.raw_pwr_cl_26_195 ==
 700                         bw_ext_csd[EXT_CSD_PWR_CL_26_195]) &&
 701                 (card->ext_csd.raw_pwr_cl_52_360 ==
 702                         bw_ext_csd[EXT_CSD_PWR_CL_52_360]) &&
 703                 (card->ext_csd.raw_pwr_cl_26_360 ==
 704                         bw_ext_csd[EXT_CSD_PWR_CL_26_360]) &&
 705                 (card->ext_csd.raw_pwr_cl_200_195 ==
 706                         bw_ext_csd[EXT_CSD_PWR_CL_200_195]) &&
 707                 (card->ext_csd.raw_pwr_cl_200_360 ==
 708                         bw_ext_csd[EXT_CSD_PWR_CL_200_360]) &&
 709                 (card->ext_csd.raw_pwr_cl_ddr_52_195 ==
 710                         bw_ext_csd[EXT_CSD_PWR_CL_DDR_52_195]) &&
 711                 (card->ext_csd.raw_pwr_cl_ddr_52_360 ==
 712                         bw_ext_csd[EXT_CSD_PWR_CL_DDR_52_360]) &&
 713                 (card->ext_csd.raw_pwr_cl_ddr_200_360 ==
 714                         bw_ext_csd[EXT_CSD_PWR_CL_DDR_200_360]));
 715
 716         if (err)
 717                 err = -EINVAL;
 718
 719         kfree(bw_ext_csd);
 720         return err;
 721 }
 722
 723 MMC_DEV_ATTR(cid, "%08x%08x%08x%08x\n", card->raw_cid[0], card->raw_cid[1],
 724         card->raw_cid[2], card->raw_cid[3]);
 725 MMC_DEV_ATTR(csd, "%08x%08x%08x%08x\n", card->raw_csd[0], card->raw_csd[1],
 726         card->raw_csd[2], card->raw_csd[3]);
 727 MMC_DEV_ATTR(date, "%02d/%04d\n", card->cid.month, card->cid.year);
 728 MMC_DEV_ATTR(erase_size, "%u\n", card->erase_size << 9);
 729 MMC_DEV_ATTR(preferred_erase_size, "%u\n", card->pref_erase << 9);
 730 MMC_DEV_ATTR(ffu_capable, "%d\n", card->ext_csd.ffu_capable);
 731 MMC_DEV_ATTR(hwrev, "0x%x\n", card->cid.hwrev);
 732 MMC_DEV_ATTR(manfid, "0x%06x\n", card->cid.manfid);
 733 MMC_DEV_ATTR(name, "%s\n", card->cid.prod_name);
 734 MMC_DEV_ATTR(oemid, "0x%04x\n", card->cid.oemid);
 735 MMC_DEV_ATTR(prv, "0x%x\n", card->cid.prv);
 736 MMC_DEV_ATTR(serial, "0x%08x\n", card->cid.serial);
 737 MMC_DEV_ATTR(enhanced_area_offset, "%llu\n",
 738                 card->ext_csd.enhanced_area_offset);
 739 MMC_DEV_ATTR(enhanced_area_size, "%u\n", card->ext_csd.enhanced_area_size);
 740 MMC_DEV_ATTR(raw_rpmb_size_mult, "%#x\n", card->ext_csd.raw_rpmb_size_mult);
 741 MMC_DEV_ATTR(rel_sectors, "%#x\n", card->ext_csd.rel_sectors);
 742
 743 static ssize_t mmc_fwrev_show(struct device *dev,
 744                               struct device_attribute *attr,
 745                               char *buf)
 746 {
 747         struct mmc_card *card = mmc_dev_to_card(dev);
 748
 749         if (card->ext_csd.rev < 7) {
 750                 return sprintf(buf, "0x%x\n", card->cid.fwrev);
 751         } else {
 752                 return sprintf(buf, "0x%*phN\n", MMC_FIRMWARE_LEN,
 753                                card->ext_csd.fwrev);
 754         }
 755 }
 756
 757 static DEVICE_ATTR(fwrev, S_IRUGO, mmc_fwrev_show, NULL);
 758
 759 static struct attribute *mmc_std_attrs[] = {
 760         &dev_attr_cid.attr,
 761         &dev_attr_csd.attr,
 762         &dev_attr_date.attr,
 763         &dev_attr_erase_size.attr,
 764         &dev_attr_preferred_erase_size.attr,
 765         &dev_attr_fwrev.attr,
 766         &dev_attr_ffu_capable.attr,
 767         &dev_attr_hwrev.attr,
 768         &dev_attr_manfid.attr,
 769         &dev_attr_name.attr,
 770         &dev_attr_oemid.attr,
 771         &dev_attr_prv.attr,
 772         &dev_attr_serial.attr,
 773         &dev_attr_enhanced_area_offset.attr,
 774         &dev_attr_enhanced_area_size.attr,
 775         &dev_attr_raw_rpmb_size_mult.attr,
 776         &dev_attr_rel_sectors.attr,
 777         NULL,
 778 };
 779 ATTRIBUTE_GROUPS(mmc_std);
 780
 781 static struct device_type mmc_type = {
 782         .groups = mmc_std_groups,
 783 };
 784
 785 /*
 786  * Select the PowerClass for the current bus width
 787  * If power class is defined for 4/8 bit bus in the
 788  * extended CSD register, select it by executing the
 789  * mmc_switch command.
 790  */
 791 static int __mmc_select_powerclass(struct mmc_card *card,
 792                                    unsigned int bus_width)
 793 {
 794         struct mmc_host *host = card->host;
 795         struct mmc_ext_csd *ext_csd = &card->ext_csd;
 796         unsigned int pwrclass_val = 0;
 797         int err = 0;
 798
 799         switch (1 << host->ios.vdd) {
 800         case MMC_VDD_165_195:
 801                 if (host->ios.clock <= MMC_HIGH_26_MAX_DTR)
 802                         pwrclass_val = ext_csd->raw_pwr_cl_26_195;
 803                 else if (host->ios.clock <= MMC_HIGH_52_MAX_DTR)
 804                         pwrclass_val = (bus_width <= EXT_CSD_BUS_WIDTH_8) ?
 805                                 ext_csd->raw_pwr_cl_52_195 :
 806                                 ext_csd->raw_pwr_cl_ddr_52_195;
 807                 else if (host->ios.clock <= MMC_HS200_MAX_DTR)
 808                         pwrclass_val = ext_csd->raw_pwr_cl_200_195;
 809                 break;
 810         case MMC_VDD_27_28:
 811         case MMC_VDD_28_29:
 812         case MMC_VDD_29_30:
 813         case MMC_VDD_30_31:
 814         case MMC_VDD_31_32:
 815         case MMC_VDD_32_33:
 816         case MMC_VDD_33_34:
 817         case MMC_VDD_34_35:
 818         case MMC_VDD_35_36:
 819                 if (host->ios.clock <= MMC_HIGH_26_MAX_DTR)
 820                         pwrclass_val = ext_csd->raw_pwr_cl_26_360;
 821                 else if (host->ios.clock <= MMC_HIGH_52_MAX_DTR)
 822                         pwrclass_val = (bus_width <= EXT_CSD_BUS_WIDTH_8) ?
 823                                 ext_csd->raw_pwr_cl_52_360 :
 824                                 ext_csd->raw_pwr_cl_ddr_52_360;
 825                 else if (host->ios.clock <= MMC_HS200_MAX_DTR)
 826                         pwrclass_val = (bus_width == EXT_CSD_DDR_BUS_WIDTH_8) ?
 827                                 ext_csd->raw_pwr_cl_ddr_200_360 :
 828                                 ext_csd->raw_pwr_cl_200_360;
 829                 break;
 830         default:
 831                 pr_warn("%s: Voltage range not supported for power class\n",
 832                         mmc_hostname(host));
 833                 return -EINVAL;
 834         }
 835
 836         if (bus_width & (EXT_CSD_BUS_WIDTH_8 | EXT_CSD_DDR_BUS_WIDTH_8))
 837                 pwrclass_val = (pwrclass_val & EXT_CSD_PWR_CL_8BIT_MASK) >>
 838                                 EXT_CSD_PWR_CL_8BIT_SHIFT;
 839         else
 840                 pwrclass_val = (pwrclass_val & EXT_CSD_PWR_CL_4BIT_MASK) >>
 841                                 EXT_CSD_PWR_CL_4BIT_SHIFT;
 842
 843         /* If the power class is different from the default value */
 844         if (pwrclass_val > 0) {
 845                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
 846                                  EXT_CSD_POWER_CLASS,
 847                                  pwrclass_val,
 848                                  card->ext_csd.generic_cmd6_time);
 849         }
 850
 851         return err;
 852 }
 853
 854 static int mmc_select_powerclass(struct mmc_card *card)
 855 {
 856         struct mmc_host *host = card->host;
 857         u32 bus_width, ext_csd_bits;
 858         int err, ddr;
 859
 860         /* Power class selection is supported for versions >= 4.0 */
 861         if (!mmc_can_ext_csd(card))
 862                 return 0;
 863
 864         bus_width = host->ios.bus_width;
 865         /* Power class values are defined only for 4/8 bit bus */
 866         if (bus_width == MMC_BUS_WIDTH_1)
 867                 return 0;
 868
 869         ddr = card->mmc_avail_type & EXT_CSD_CARD_TYPE_DDR_52;
 870         if (ddr)
 871                 ext_csd_bits = (bus_width == MMC_BUS_WIDTH_8) ?
 872                         EXT_CSD_DDR_BUS_WIDTH_8 : EXT_CSD_DDR_BUS_WIDTH_4;
 873         else
 874                 ext_csd_bits = (bus_width == MMC_BUS_WIDTH_8) ?
 875                         EXT_CSD_BUS_WIDTH_8 :  EXT_CSD_BUS_WIDTH_4;
 876
 877         err = __mmc_select_powerclass(card, ext_csd_bits);
 878         if (err)
 879                 pr_warn("%s: power class selection to bus width %d ddr %d failed\n",
 880                         mmc_hostname(host), 1 << bus_width, ddr);
 881
 882         return err;
 883 }
 884
 885 /*
 886  * Set the bus speed for the selected speed mode.
 887  */
 888 static void mmc_set_bus_speed(struct mmc_card *card)
 889 {
 890         unsigned int max_dtr = (unsigned int)-1;
 891
 892         if ((mmc_card_hs200(card) || mmc_card_hs400(card)) &&
 893              max_dtr > card->ext_csd.hs200_max_dtr)
 894                 max_dtr = card->ext_csd.hs200_max_dtr;
 895         else if (mmc_card_hs(card) && max_dtr > card->ext_csd.hs_max_dtr)
 896                 max_dtr = card->ext_csd.hs_max_dtr;
 897         else if (max_dtr > card->csd.max_dtr)
 898                 max_dtr = card->csd.max_dtr;
 899
 900         mmc_set_clock(card->host, max_dtr);
 901 }
 902
 903 /*
 904  * Select the bus width amoung 4-bit and 8-bit(SDR).
 905  * If the bus width is changed successfully, return the selected width value.
 906  * Zero is returned instead of error value if the wide width is not supported.
 907  */
 908 static int mmc_select_bus_width(struct mmc_card *card)
 909 {
 910         static unsigned ext_csd_bits[] = {
 911                 EXT_CSD_BUS_WIDTH_8,
 912                 EXT_CSD_BUS_WIDTH_4,
 913         };
 914         static unsigned bus_widths[] = {
 915                 MMC_BUS_WIDTH_8,
 916                 MMC_BUS_WIDTH_4,
 917         };
 918         struct mmc_host *host = card->host;
 919         unsigned idx, bus_width = 0;
 920         int err = 0;
 921
 922         if (!mmc_can_ext_csd(card) ||
 923             !(host->caps & (MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA)))
 924                 return 0;
 925
 926         idx = (host->caps & MMC_CAP_8_BIT_DATA) ? 0 : 1;
 927
 928         /*
 929          * Unlike SD, MMC cards dont have a configuration register to notify
 930          * supported bus width. So bus test command should be run to identify
 931          * the supported bus width or compare the ext csd values of current
 932          * bus width and ext csd values of 1 bit mode read earlier.
 933          */
 934         for (; idx < ARRAY_SIZE(bus_widths); idx++) {
 935                 /*
 936                  * Host is capable of 8bit transfer, then switch
 937                  * the device to work in 8bit transfer mode. If the
 938                  * mmc switch command returns error then switch to
 939                  * 4bit transfer mode. On success set the corresponding
 940                  * bus width on the host.
 941                  */
 942                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
 943                                  EXT_CSD_BUS_WIDTH,
 944                                  ext_csd_bits[idx],
 945                                  card->ext_csd.generic_cmd6_time);
 946                 if (err)
 947                         continue;
 948
 949                 bus_width = bus_widths[idx];
 950                 mmc_set_bus_width(host, bus_width);
 951
 952                 /*
 953                  * If controller can't handle bus width test,
 954                  * compare ext_csd previously read in 1 bit mode
 955                  * against ext_csd at new bus width
 956                  */
 957                 if (!(host->caps & MMC_CAP_BUS_WIDTH_TEST))
 958                         err = mmc_compare_ext_csds(card, bus_width);
 959                 else
 960                         err = mmc_bus_test(card, bus_width);
 961
 962                 if (!err) {
 963                         err = bus_width;
 964                         break;
 965                 } else {
 966                         pr_warn("%s: switch to bus width %d failed\n",
 967                                 mmc_hostname(host), ext_csd_bits[idx]);
 968                 }
 969         }
 970
 971         return err;
 972 }
 973
 974 /*
 975  * Switch to the high-speed mode
 976  */
 977 static int mmc_select_hs(struct mmc_card *card)
 978 {
 979         int err;
 980
 981         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
 982                            EXT_CSD_HS_TIMING, EXT_CSD_TIMING_HS,
 983                            card->ext_csd.generic_cmd6_time,
 984                            true, true, true);
 985         if (!err)
 986                 mmc_set_timing(card->host, MMC_TIMING_MMC_HS);
 987
 988         return err;
 989 }
 990
 991 /*
 992  * Activate wide bus and DDR if supported.
 993  */
 994 static int mmc_select_hs_ddr(struct mmc_card *card)
 995 {
 996         struct mmc_host *host = card->host;
 997         u32 bus_width, ext_csd_bits;
 998         int err = 0;
 999
1000         if (!(card->mmc_avail_type & EXT_CSD_CARD_TYPE_DDR_52))
1001                 return 0;
1002
1003         bus_width = host->ios.bus_width;
1004         if (bus_width == MMC_BUS_WIDTH_1)
1005                 return 0;
1006
1007         ext_csd_bits = (bus_width == MMC_BUS_WIDTH_8) ?
1008                 EXT_CSD_DDR_BUS_WIDTH_8 : EXT_CSD_DDR_BUS_WIDTH_4;
1009
1010         err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1011                         EXT_CSD_BUS_WIDTH,
1012                         ext_csd_bits,
1013                         card->ext_csd.generic_cmd6_time);
1014         if (err) {
1015                 pr_err("%s: switch to bus width %d ddr failed\n",
1016                         mmc_hostname(host), 1 << bus_width);
1017                 return err;
1018         }
1019
1020         /*
1021          * eMMC cards can support 3.3V to 1.2V i/o (vccq)
1022          * signaling.
1023          *
1024          * EXT_CSD_CARD_TYPE_DDR_1_8V means 3.3V or 1.8V vccq.
1025          *
1026          * 1.8V vccq at 3.3V core voltage (vcc) is not required
1027          * in the JEDEC spec for DDR.
1028          *
1029          * Even (e)MMC card can support 3.3v to 1.2v vccq, but not all
1030          * host controller can support this, like some of the SDHCI
1031          * controller which connect to an eMMC device. Some of these
1032          * host controller still needs to use 1.8v vccq for supporting
1033          * DDR mode.
1034          *
1035          * So the sequence will be:
1036          * if (host and device can both support 1.2v IO)
1037          *      use 1.2v IO;
1038          * else if (host and device can both support 1.8v IO)
1039          *      use 1.8v IO;
1040          * so if host and device can only support 3.3v IO, this is the
1041          * last choice.
1042          *
1043          * WARNING: eMMC rules are NOT the same as SD DDR
1044          */
1045         err = -EINVAL;
1046         if (card->mmc_avail_type & EXT_CSD_CARD_TYPE_DDR_1_2V)
1047                 err = __mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_120);
1048
1049         if (err && (card->mmc_avail_type & EXT_CSD_CARD_TYPE_DDR_1_8V))
1050                 err = __mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_180);
1051
1052         /* make sure vccq is 3.3v after switching disaster */
1053         if (err)
1054                 err = __mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_330);
1055
1056         if (!err)
1057                 mmc_set_timing(host, MMC_TIMING_MMC_DDR52);
1058
1059         return err;
1060 }
1061
1062 /* Caller must hold re-tuning */
1063 static int mmc_switch_status(struct mmc_card *card)
1064 {
1065         u32 status;
1066         int err;
1067
1068         err = mmc_send_status(card, &status);
1069         if (err)
1070                 return err;
1071
1072         return mmc_switch_status_error(card->host, status);
1073 }
1074
1075 static int mmc_select_hs400(struct mmc_card *card)
1076 {
1077         struct mmc_host *host = card->host;
1078         bool send_status = true;
1079         unsigned int max_dtr;
1080         int err = 0;
1081         u8 val;
1082
1083         /*
1084          * HS400 mode requires 8-bit bus width
1085          */
1086         if (!(card->mmc_avail_type & EXT_CSD_CARD_TYPE_HS400 &&
1087               host->ios.bus_width == MMC_BUS_WIDTH_8))
1088                 return 0;
1089
1090         if (host->caps & MMC_CAP_WAIT_WHILE_BUSY)
1091                 send_status = false;
1092
1093         /* Switch card to HS mode */
1094         val = EXT_CSD_TIMING_HS;
1095         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1096                            EXT_CSD_HS_TIMING, val,
1097                            card->ext_csd.generic_cmd6_time,
1098                            true, false, true);
1099         if (err) {
1100                 pr_err("%s: switch to high-speed from hs200 failed, err:%d\n",
1101                         mmc_hostname(host), err);
1102                 return err;
1103         }
1104
1105         /* Set host controller to HS timing */
1106         mmc_set_timing(card->host, MMC_TIMING_MMC_HS);
1107
1108         /* Reduce frequency to HS frequency */
1109         max_dtr = card->ext_csd.hs_max_dtr;
1110         mmc_set_clock(host, max_dtr);
1111
1112         if (!send_status) {
1113                 err = mmc_switch_status(card);
1114                 if (err)
1115                         goto out_err;
1116         }
1117
1118         /* Switch card to DDR */
1119         err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1120                          EXT_CSD_BUS_WIDTH,
1121                          EXT_CSD_DDR_BUS_WIDTH_8,
1122                          card->ext_csd.generic_cmd6_time);
1123         if (err) {
1124                 pr_err("%s: switch to bus width for hs400 failed, err:%d\n",
1125                         mmc_hostname(host), err);
1126                 return err;
1127         }
1128
1129         /* Switch card to HS400 */
1130         val = EXT_CSD_TIMING_HS400 |
1131               card->drive_strength << EXT_CSD_DRV_STR_SHIFT;
1132         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1133                            EXT_CSD_HS_TIMING, val,
1134                            card->ext_csd.generic_cmd6_time,
1135                            true, send_status, true);
1136         if (err) {
1137                 pr_err("%s: switch to hs400 failed, err:%d\n",
1138                          mmc_hostname(host), err);
1139                 return err;
1140         }
1141
1142         /* Set host controller to HS400 timing and frequency */
1143         mmc_set_timing(host, MMC_TIMING_MMC_HS400);
1144         mmc_set_bus_speed(card);
1145
1146         if (!send_status) {
1147                 err = mmc_switch_status(card);
1148                 if (err)
1149                         goto out_err;
1150         }
1151
1152         return 0;
1153
1154 out_err:
1155         pr_err("%s: %s failed, error %d\n", mmc_hostname(card->host),
1156                __func__, err);
1157         return err;
1158 }
1159
1160 int mmc_hs200_to_hs400(struct mmc_card *card)
1161 {
1162         return mmc_select_hs400(card);
1163 }
1164
1165 int mmc_hs400_to_hs200(struct mmc_card *card)
1166 {
1167         struct mmc_host *host = card->host;
1168         bool send_status = true;
1169         unsigned int max_dtr;
1170         int err;
1171         u8 val;
1172
1173         if (host->caps & MMC_CAP_WAIT_WHILE_BUSY)
1174                 send_status = false;
1175
1176         /* Reduce frequency to HS */
1177         max_dtr = card->ext_csd.hs_max_dtr;
1178         mmc_set_clock(host, max_dtr);
1179
1180         /* Switch HS400 to HS DDR */
1181         val = EXT_CSD_TIMING_HS;
1182         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_HS_TIMING,
1183                            val, card->ext_csd.generic_cmd6_time,
1184                            true, false, true);
1185         if (err)
1186                 goto out_err;
1187
1188         mmc_set_timing(host, MMC_TIMING_MMC_DDR52);
1189
1190         if (!send_status) {
1191                 err = mmc_switch_status(card);
1192                 if (err)
1193                         goto out_err;
1194         }
1195
1196         /* Switch HS DDR to HS */
1197         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_BUS_WIDTH,
1198                            EXT_CSD_BUS_WIDTH_8, card->ext_csd.generic_cmd6_time,
1199                            true, send_status, true);
1200         if (err)
1201                 goto out_err;
1202
1203         mmc_set_timing(host, MMC_TIMING_MMC_HS);
1204
1205         if (!send_status) {
1206                 err = mmc_switch_status(card);
1207                 if (err)
1208                         goto out_err;
1209         }
1210
1211         /* Switch HS to HS200 */
1212         val = EXT_CSD_TIMING_HS200 |
1213               card->drive_strength << EXT_CSD_DRV_STR_SHIFT;
1214         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_HS_TIMING,
1215                            val, card->ext_csd.generic_cmd6_time, true,
1216                            send_status, true);
1217         if (err)
1218                 goto out_err;
1219
1220         mmc_set_timing(host, MMC_TIMING_MMC_HS200);
1221
1222         if (!send_status) {
1223                 err = mmc_switch_status(card);
1224                 if (err)
1225                         goto out_err;
1226         }
1227
1228         mmc_set_bus_speed(card);
1229
1230         return 0;
1231
1232 out_err:
1233         pr_err("%s: %s failed, error %d\n", mmc_hostname(card->host),
1234                __func__, err);
1235         return err;
1236 }
1237
1238 static void mmc_select_driver_type(struct mmc_card *card)
1239 {
1240         int card_drv_type, drive_strength, drv_type;
1241
1242         card_drv_type = card->ext_csd.raw_driver_strength |
1243                         mmc_driver_type_mask(0);
1244
1245         drive_strength = mmc_select_drive_strength(card,
1246                                                    card->ext_csd.hs200_max_dtr,
1247                                                    card_drv_type, &drv_type);
1248
1249         card->drive_strength = drive_strength;
1250
1251         if (drv_type)
1252                 mmc_set_driver_type(card->host, drv_type);
1253 }
1254
1255 /*
1256  * For device supporting HS200 mode, the following sequence
1257  * should be done before executing the tuning process.
1258  * 1. set the desired bus width(4-bit or 8-bit, 1-bit is not supported)
1259  * 2. switch to HS200 mode
1260  * 3. set the clock to > 52Mhz and <=200MHz
1261  */
1262 static int mmc_select_hs200(struct mmc_card *card)
1263 {
1264         struct mmc_host *host = card->host;
1265         bool send_status = true;
1266         unsigned int old_timing;
1267         int err = -EINVAL;
1268         u8 val;
1269
1270         if (card->mmc_avail_type & EXT_CSD_CARD_TYPE_HS200_1_2V)
1271                 err = __mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_120);
1272
1273         if (err && card->mmc_avail_type & EXT_CSD_CARD_TYPE_HS200_1_8V)
1274                 err = __mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_180);
1275
1276         /* If fails try again during next card power cycle */
1277         if (err)
1278                 goto err;
1279
1280         mmc_select_driver_type(card);
1281
1282         if (host->caps & MMC_CAP_WAIT_WHILE_BUSY)
1283                 send_status = false;
1284
1285         /*
1286          * Set the bus width(4 or 8) with host's support and
1287          * switch to HS200 mode if bus width is set successfully.
1288          */
1289         err = mmc_select_bus_width(card);
1290         if (!IS_ERR_VALUE(err)) {
1291                 val = EXT_CSD_TIMING_HS200 |
1292                       card->drive_strength << EXT_CSD_DRV_STR_SHIFT;
1293                 err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1294                                    EXT_CSD_HS_TIMING, val,
1295                                    card->ext_csd.generic_cmd6_time,
1296                                    true, false, true);
1297                 if (err)
1298                         goto err;
1299                 old_timing = host->ios.timing;
1300                 mmc_set_timing(host, MMC_TIMING_MMC_HS200);
1301                 if (!send_status) {
1302                         err = mmc_switch_status(card);
1303                         /*
1304                          * mmc_select_timing() assumes timing has not changed if
1305                          * it is a switch error.
1306                          */
1307                         if (err == -EBADMSG)
1308                                 mmc_set_timing(host, old_timing);
1309                 }
1310         }
1311 err:
1312         if (err)
1313                 pr_err("%s: %s failed, error %d\n", mmc_hostname(card->host),
1314                        __func__, err);
1315         return err;
1316 }
1317
1318 static int mmc_select_hs400es(struct mmc_card *card)
1319 {
1320         struct mmc_host *host = card->host;
1321         int err = 0;
1322         u8 val;
1323
1324         if (!(host->caps & MMC_CAP_8_BIT_DATA)) {
1325                 err = -ENOTSUPP;
1326                 goto out_err;
1327         }
1328
1329         err = mmc_select_bus_width(card);
1330         if (IS_ERR_VALUE(err))
1331                 goto out_err;
1332
1333         /* Switch card to HS mode */
1334         err = mmc_select_hs(card);
1335         if (err) {
1336                 pr_err("%s: switch to high-speed failed, err:%d\n",
1337                         mmc_hostname(host), err);
1338                 goto out_err;
1339         }
1340
1341         err = mmc_switch_status(card);
1342         if (err)
1343                 goto out_err;
1344
1345         /* Switch card to DDR with strobe bit */
1346         val = EXT_CSD_DDR_BUS_WIDTH_8 | EXT_CSD_BUS_WIDTH_STROBE;
1347
1348         err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1349                          EXT_CSD_BUS_WIDTH,
1350                          val,
1351                          card->ext_csd.generic_cmd6_time);
1352         if (err) {
1353                 pr_err("%s: switch to bus width for hs400es failed, err:%d\n",
1354                         mmc_hostname(host), err);
1355                 goto out_err;
1356         }
1357
1358         /* Switch card to HS400 */
1359         val = EXT_CSD_TIMING_HS400 |
1360               card->drive_strength << EXT_CSD_DRV_STR_SHIFT;
1361         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1362                            EXT_CSD_HS_TIMING, val,
1363                            card->ext_csd.generic_cmd6_time,
1364                            true, false, true);
1365         if (err) {
1366                 pr_err("%s: switch to hs400es failed, err:%d\n",
1367                          mmc_hostname(host), err);
1368                 goto out_err;
1369         }
1370
1371         /* Set host controller to HS400 timing and frequency */
1372         mmc_set_timing(host, MMC_TIMING_MMC_HS400);
1373
1374         /* Controller enable enhanced strobe function */
1375         host->ios.enhanced_strobe = true;
1376         if (host->ops->hs400_enhanced_strobe)
1377                 host->ops->hs400_enhanced_strobe(host, &host->ios);
1378
1379         err = mmc_switch_status(card);
1380         if (err)
1381                 goto out_err;
1382
1383         return 0;
1384
1385 out_err:
1386         pr_err("%s: %s failed, error %d\n", mmc_hostname(card->host),
1387                __func__, err);
1388         return err;
1389 }
1390
1391 /*
1392  * Activate High Speed or HS200 or HS400ES mode if supported.
1393  */
1394 static int mmc_select_timing(struct mmc_card *card)
1395 {
1396         int err = 0;
1397
1398         if (!mmc_can_ext_csd(card))
1399                 goto bus_speed;
1400
1401         if (card->mmc_avail_type & EXT_CSD_CARD_TYPE_HS400ES)
1402                 err = mmc_select_hs400es(card);
1403         else if (card->mmc_avail_type & EXT_CSD_CARD_TYPE_HS200)
1404                 err = mmc_select_hs200(card);
1405         else if (card->mmc_avail_type & EXT_CSD_CARD_TYPE_HS)
1406                 err = mmc_select_hs(card);
1407
1408         if (err && err != -EBADMSG)
1409                 return err;
1410
1411         if (err) {
1412                 pr_warn("%s: switch to %s failed\n",
1413                         mmc_card_hs(card) ? "high-speed" :
1414                         (mmc_card_hs200(card) ? "hs200" : ""),
1415                         mmc_hostname(card->host));
1416                 err = 0;
1417         }
1418
1419 bus_speed:
1420         /*
1421          * Set the bus speed to the selected bus timing.
1422          * If timing is not selected, backward compatible is the default.
1423          */
1424         mmc_set_bus_speed(card);
1425         return err;
1426 }
1427
1428 /*
1429  * Execute tuning sequence to seek the proper bus operating
1430  * conditions for HS200 and HS400, which sends CMD21 to the device.
1431  */
1432 static int mmc_hs200_tuning(struct mmc_card *card)
1433 {
1434         struct mmc_host *host = card->host;
1435
1436         /*
1437          * Timing should be adjusted to the HS400 target
1438          * operation frequency for tuning process
1439          */
1440         if (card->mmc_avail_type & EXT_CSD_CARD_TYPE_HS400 &&
1441             host->ios.bus_width == MMC_BUS_WIDTH_8)
1442                 if (host->ops->prepare_hs400_tuning)
1443                         host->ops->prepare_hs400_tuning(host, &host->ios);
1444
1445         return mmc_execute_tuning(card);
1446 }
1447
1448 /*
1449  * Handle the detection and initialisation of a card.
1450  *
1451  * In the case of a resume, "oldcard" will contain the card
1452  * we're trying to reinitialise.
1453  */
1454 static int mmc_init_card(struct mmc_host *host, u32 ocr,
1455         struct mmc_card *oldcard)
1456 {
1457         struct mmc_card *card;
1458         int err;
1459         u32 cid[4];
1460         u32 rocr;
1461
1462         BUG_ON(!host);
1463         WARN_ON(!host->claimed);
1464
1465         /* Set correct bus mode for MMC before attempting init */
1466         if (!mmc_host_is_spi(host))
1467                 mmc_set_bus_mode(host, MMC_BUSMODE_OPENDRAIN);
1468
1469         /*
1470          * Since we're changing the OCR value, we seem to
1471          * need to tell some cards to go back to the idle
1472          * state.  We wait 1ms to give cards time to
1473          * respond.
1474          * mmc_go_idle is needed for eMMC that are asleep
1475          */
1476         mmc_go_idle(host);
1477
1478         /* The extra bit indicates that we support high capacity */
1479         err = mmc_send_op_cond(host, ocr | (1 << 30), &rocr);
1480         if (err)
1481                 goto err;
1482
1483         /*
1484          * For SPI, enable CRC as appropriate.
1485          */
1486         if (mmc_host_is_spi(host)) {
1487                 err = mmc_spi_set_crc(host, use_spi_crc);
1488                 if (err)
1489                         goto err;
1490         }
1491
1492         /*
1493          * Fetch CID from card.
1494          */
1495         if (mmc_host_is_spi(host))
1496                 err = mmc_send_cid(host, cid);
1497         else
1498                 err = mmc_all_send_cid(host, cid);
1499         if (err)
1500                 goto err;
1501
1502         if (oldcard) {
1503                 if (memcmp(cid, oldcard->raw_cid, sizeof(cid)) != 0) {
1504                         err = -ENOENT;
1505                         goto err;
1506                 }
1507
1508                 card = oldcard;
1509         } else {
1510                 /*
1511                  * Allocate card structure.
1512                  */
1513                 card = mmc_alloc_card(host, &mmc_type);
1514                 if (IS_ERR(card)) {
1515                         err = PTR_ERR(card);
1516                         goto err;
1517                 }
1518
1519                 card->ocr = ocr;
1520                 card->type = MMC_TYPE_MMC;
1521                 card->rca = 1;
1522                 memcpy(card->raw_cid, cid, sizeof(card->raw_cid));
1523         }
1524
1525         /*
1526          * Call the optional HC's init_card function to handle quirks.
1527          */
1528         if (host->ops->init_card)
1529                 host->ops->init_card(host, card);
1530
1531         /*
1532          * For native busses:  set card RCA and quit open drain mode.
1533          */
1534         if (!mmc_host_is_spi(host)) {
1535                 err = mmc_set_relative_addr(card);
1536                 if (err)
1537                         goto free_card;
1538
1539                 mmc_set_bus_mode(host, MMC_BUSMODE_PUSHPULL);
1540         }
1541
1542         if (!oldcard) {
1543                 /*
1544                  * Fetch CSD from card.
1545                  */
1546                 err = mmc_send_csd(card, card->raw_csd);
1547                 if (err)
1548                         goto free_card;
1549
1550                 err = mmc_decode_csd(card);
1551                 if (err)
1552                         goto free_card;
1553                 err = mmc_decode_cid(card);
1554                 if (err)
1555                         goto free_card;
1556         }
1557
1558         /*
1559          * handling only for cards supporting DSR and hosts requesting
1560          * DSR configuration
1561          */
1562         if (card->csd.dsr_imp && host->dsr_req)
1563                 mmc_set_dsr(host);
1564
1565         /*
1566          * Select card, as all following commands rely on that.
1567          */
1568         if (!mmc_host_is_spi(host)) {
1569                 err = mmc_select_card(card);
1570                 if (err)
1571                         goto free_card;
1572         }
1573
1574         if (!oldcard) {
1575                 /* Read extended CSD. */
1576                 err = mmc_read_ext_csd(card);
1577                 if (err)
1578                         goto free_card;
1579
1580                 /* If doing byte addressing, check if required to do sector
1581                  * addressing.  Handle the case of <2GB cards needing sector
1582                  * addressing.  See section 8.1 JEDEC Standard JED84-A441;
1583                  * ocr register has bit 30 set for sector addressing.
1584                  */
1585                 if (!(mmc_card_blockaddr(card)) && (rocr & (1<<30)))
1586                         mmc_card_set_blockaddr(card);
1587
1588                 /* Erase size depends on CSD and Extended CSD */
1589                 mmc_set_erase_size(card);
1590         }
1591
1592         /*
1593          * If enhanced_area_en is TRUE, host needs to enable ERASE_GRP_DEF
1594          * bit.  This bit will be lost every time after a reset or power off.
1595          */
1596         if (card->ext_csd.partition_setting_completed ||
1597             (card->ext_csd.rev >= 3 && (host->caps2 & MMC_CAP2_HC_ERASE_SZ))) {
1598                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1599                                  EXT_CSD_ERASE_GROUP_DEF, 1,
1600                                  card->ext_csd.generic_cmd6_time);
1601
1602                 if (err && err != -EBADMSG)
1603                         goto free_card;
1604
1605                 if (err) {
1606                         err = 0;
1607                         /*
1608                          * Just disable enhanced area off & sz
1609                          * will try to enable ERASE_GROUP_DEF
1610                          * during next time reinit
1611                          */
1612                         card->ext_csd.enhanced_area_offset = -EINVAL;
1613                         card->ext_csd.enhanced_area_size = -EINVAL;
1614                 } else {
1615                         card->ext_csd.erase_group_def = 1;
1616                         /*
1617                          * enable ERASE_GRP_DEF successfully.
1618                          * This will affect the erase size, so
1619                          * here need to reset erase size
1620                          */
1621                         mmc_set_erase_size(card);
1622                 }
1623         }
1624
1625         /*
1626          * Ensure eMMC user default partition is enabled
1627          */
1628         if (card->ext_csd.part_config & EXT_CSD_PART_CONFIG_ACC_MASK) {
1629                 card->ext_csd.part_config &= ~EXT_CSD_PART_CONFIG_ACC_MASK;
1630                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_PART_CONFIG,
1631                                  card->ext_csd.part_config,
1632                                  card->ext_csd.part_time);
1633                 if (err && err != -EBADMSG)
1634                         goto free_card;
1635         }
1636
1637         /*
1638          * Enable power_off_notification byte in the ext_csd register
1639          */
1640         if (card->ext_csd.rev >= 6) {
1641                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1642                                  EXT_CSD_POWER_OFF_NOTIFICATION,
1643                                  EXT_CSD_POWER_ON,
1644                                  card->ext_csd.generic_cmd6_time);
1645                 if (err && err != -EBADMSG)
1646                         goto free_card;
1647
1648                 /*
1649                  * The err can be -EBADMSG or 0,
1650                  * so check for success and update the flag
1651                  */
1652                 if (!err)
1653                         card->ext_csd.power_off_notification = EXT_CSD_POWER_ON;
1654         }
1655
1656         /*
1657          * Select timing interface
1658          */
1659         err = mmc_select_timing(card);
1660         if (err)
1661                 goto free_card;
1662
1663         if (mmc_card_hs200(card)) {
1664                 err = mmc_hs200_tuning(card);
1665                 if (err)
1666                         goto free_card;
1667
1668                 err = mmc_select_hs400(card);
1669                 if (err)
1670                         goto free_card;
1671         } else if (mmc_card_hs(card)) {
1672                 /* Select the desired bus width optionally */
1673                 err = mmc_select_bus_width(card);
1674                 if (!IS_ERR_VALUE(err)) {
1675                         err = mmc_select_hs_ddr(card);
1676                         if (err)
1677                                 goto free_card;
1678                 }
1679         }
1680
1681         /*
1682          * Choose the power class with selected bus interface
1683          */
1684         mmc_select_powerclass(card);
1685
1686         /*
1687          * Enable HPI feature (if supported)
1688          */
1689         if (card->ext_csd.hpi) {
1690                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1691                                 EXT_CSD_HPI_MGMT, 1,
1692                                 card->ext_csd.generic_cmd6_time);
1693                 if (err && err != -EBADMSG)
1694                         goto free_card;
1695                 if (err) {
1696                         pr_warn("%s: Enabling HPI failed\n",
1697                                 mmc_hostname(card->host));
1698                         err = 0;
1699                 } else
1700                         card->ext_csd.hpi_en = 1;
1701         }
1702
1703         /*
1704          * If cache size is higher than 0, this indicates
1705          * the existence of cache and it can be turned on.
1706          */
1707         if (card->ext_csd.cache_size > 0) {
1708                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1709                                 EXT_CSD_CACHE_CTRL, 1,
1710                                 card->ext_csd.generic_cmd6_time);
1711                 if (err && err != -EBADMSG)
1712                         goto free_card;
1713
1714                 /*
1715                  * Only if no error, cache is turned on successfully.
1716                  */
1717                 if (err) {
1718                         pr_warn("%s: Cache is supported, but failed to turn on (%d)\n",
1719                                 mmc_hostname(card->host), err);
1720                         card->ext_csd.cache_ctrl = 0;
1721                         err = 0;
1722                 } else {
1723                         card->ext_csd.cache_ctrl = 1;
1724                 }
1725         }
1726
1727         /*
1728          * The mandatory minimum values are defined for packed command.
1729          * read: 5, write: 3
1730          */
1731         if (card->ext_csd.max_packed_writes >= 3 &&
1732             card->ext_csd.max_packed_reads >= 5 &&
1733             host->caps2 & MMC_CAP2_PACKED_CMD) {
1734                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1735                                 EXT_CSD_EXP_EVENTS_CTRL,
1736                                 EXT_CSD_PACKED_EVENT_EN,
1737                                 card->ext_csd.generic_cmd6_time);
1738                 if (err && err != -EBADMSG)
1739                         goto free_card;
1740                 if (err) {
1741                         pr_warn("%s: Enabling packed event failed\n",
1742                                 mmc_hostname(card->host));
1743                         card->ext_csd.packed_event_en = 0;
1744                         err = 0;
1745                 } else {
1746                         card->ext_csd.packed_event_en = 1;
1747                 }
1748         }
1749
1750         if (!oldcard)
1751                 host->card = card;
1752
1753         return 0;
1754
1755 free_card:
1756         if (!oldcard)
1757                 mmc_remove_card(card);
1758 err:
1759         return err;
1760 }
1761
1762 static int mmc_can_sleep(struct mmc_card *card)
1763 {
1764         return (card && card->ext_csd.rev >= 3);
1765 }
1766
1767 static int mmc_sleep(struct mmc_host *host)
1768 {
1769         struct mmc_command cmd = {0};
1770         struct mmc_card *card = host->card;
1771         unsigned int timeout_ms = DIV_ROUND_UP(card->ext_csd.sa_timeout, 10000);
1772         int err;
1773
1774         /* Re-tuning can't be done once the card is deselected */
1775         mmc_retune_hold(host);
1776
1777         err = mmc_deselect_cards(host);
1778         if (err)
1779                 goto out_release;
1780
1781         cmd.opcode = MMC_SLEEP_AWAKE;
1782         cmd.arg = card->rca << 16;
1783         cmd.arg |= 1 << 15;
1784
1785         /*
1786          * If the max_busy_timeout of the host is specified, validate it against
1787          * the sleep cmd timeout. A failure means we need to prevent the host
1788          * from doing hw busy detection, which is done by converting to a R1
1789          * response instead of a R1B.
1790          */
1791         if (host->max_busy_timeout && (timeout_ms > host->max_busy_timeout)) {
1792                 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
1793         } else {
1794                 cmd.flags = MMC_RSP_R1B | MMC_CMD_AC;
1795                 cmd.busy_timeout = timeout_ms;
1796         }
1797
1798         err = mmc_wait_for_cmd(host, &cmd, 0);
1799         if (err)
1800                 goto out_release;
1801
1802         /*
1803          * If the host does not wait while the card signals busy, then we will
1804          * will have to wait the sleep/awake timeout.  Note, we cannot use the
1805          * SEND_STATUS command to poll the status because that command (and most
1806          * others) is invalid while the card sleeps.
1807          */
1808         if (!cmd.busy_timeout || !(host->caps & MMC_CAP_WAIT_WHILE_BUSY))
1809                 mmc_delay(timeout_ms);
1810
1811 out_release:
1812         mmc_retune_release(host);
1813         return err;
1814 }
1815
1816 static int mmc_can_poweroff_notify(const struct mmc_card *card)
1817 {
1818         return card &&
1819                 mmc_card_mmc(card) &&
1820                 (card->ext_csd.power_off_notification == EXT_CSD_POWER_ON);
1821 }
1822
1823 static int mmc_poweroff_notify(struct mmc_card *card, unsigned int notify_type)
1824 {
1825         unsigned int timeout = card->ext_csd.generic_cmd6_time;
1826         int err;
1827
1828         /* Use EXT_CSD_POWER_OFF_SHORT as default notification type. */
1829         if (notify_type == EXT_CSD_POWER_OFF_LONG)
1830                 timeout = card->ext_csd.power_off_longtime;
1831
1832         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1833                         EXT_CSD_POWER_OFF_NOTIFICATION,
1834                         notify_type, timeout, true, false, false);
1835         if (err)
1836                 pr_err("%s: Power Off Notification timed out, %u\n",
1837                        mmc_hostname(card->host), timeout);
1838
1839         /* Disable the power off notification after the switch operation. */
1840         card->ext_csd.power_off_notification = EXT_CSD_NO_POWER_NOTIFICATION;
1841
1842         return err;
1843 }
1844
1845 /*
1846  * Host is being removed. Free up the current card.
1847  */
1848 static void mmc_remove(struct mmc_host *host)
1849 {
1850         BUG_ON(!host);
1851         BUG_ON(!host->card);
1852
1853         mmc_remove_card(host->card);
1854         host->card = NULL;
1855 }
1856
1857 /*
1858  * Card detection - card is alive.
1859  */
1860 static int mmc_alive(struct mmc_host *host)
1861 {
1862         return mmc_send_status(host->card, NULL);
1863 }
1864
1865 /*
1866  * Card detection callback from host.
1867  */
1868 static void mmc_detect(struct mmc_host *host)
1869 {
1870         int err;
1871
1872         BUG_ON(!host);
1873         BUG_ON(!host->card);
1874
1875         mmc_get_card(host->card);
1876
1877         /*
1878          * Just check if our card has been removed.
1879          */
1880         err = _mmc_detect_card_removed(host);
1881
1882         mmc_put_card(host->card);
1883
1884         if (err) {
1885                 mmc_remove(host);
1886
1887                 mmc_claim_host(host);
1888                 mmc_detach_bus(host);
1889                 mmc_power_off(host);
1890                 mmc_release_host(host);
1891         }
1892 }
1893
1894 static int _mmc_suspend(struct mmc_host *host, bool is_suspend)
1895 {
1896         int err = 0;
1897         unsigned int notify_type = is_suspend ? EXT_CSD_POWER_OFF_SHORT :
1898                                         EXT_CSD_POWER_OFF_LONG;
1899
1900         BUG_ON(!host);
1901         BUG_ON(!host->card);
1902
1903         mmc_claim_host(host);
1904
1905         if (mmc_card_suspended(host->card))
1906                 goto out;
1907
1908         if (mmc_card_doing_bkops(host->card)) {
1909                 err = mmc_stop_bkops(host->card);
1910                 if (err)
1911                         goto out;
1912         }
1913
1914         err = mmc_flush_cache(host->card);
1915         if (err)
1916                 goto out;
1917
1918         if (mmc_can_poweroff_notify(host->card) &&
1919                 ((host->caps2 & MMC_CAP2_FULL_PWR_CYCLE) || !is_suspend))
1920                 err = mmc_poweroff_notify(host->card, notify_type);
1921         else if (mmc_can_sleep(host->card))
1922                 err = mmc_sleep(host);
1923         else if (!mmc_host_is_spi(host))
1924                 err = mmc_deselect_cards(host);
1925
1926         if (!err) {
1927                 mmc_power_off(host);
1928                 mmc_card_set_suspended(host->card);
1929         }
1930 out:
1931         mmc_release_host(host);
1932         return err;
1933 }
1934
1935 /*
1936  * Suspend callback
1937  */
1938 static int mmc_suspend(struct mmc_host *host)
1939 {
1940         int err;
1941
1942         err = _mmc_suspend(host, true);
1943         if (!err) {
1944                 pm_runtime_disable(&host->card->dev);
1945                 pm_runtime_set_suspended(&host->card->dev);
1946         }
1947
1948         return err;
1949 }
1950
1951 /*
1952  * This function tries to determine if the same card is still present
1953  * and, if so, restore all state to it.
1954  */
1955 static int _mmc_resume(struct mmc_host *host)
1956 {
1957         int err = 0;
1958
1959         BUG_ON(!host);
1960         BUG_ON(!host->card);
1961
1962         mmc_claim_host(host);
1963
1964         if (!mmc_card_suspended(host->card))
1965                 goto out;
1966
1967         mmc_power_up(host, host->card->ocr);
1968         err = mmc_init_card(host, host->card->ocr, host->card);
1969         mmc_card_clr_suspended(host->card);
1970
1971 out:
1972         mmc_release_host(host);
1973         return err;
1974 }
1975
1976 /*
1977  * Shutdown callback
1978  */
1979 static int mmc_shutdown(struct mmc_host *host)
1980 {
1981         int err = 0;
1982
1983         /*
1984          * In a specific case for poweroff notify, we need to resume the card
1985          * before we can shutdown it properly.
1986          */
1987         if (mmc_can_poweroff_notify(host->card) &&
1988                 !(host->caps2 & MMC_CAP2_FULL_PWR_CYCLE))
1989                 err = _mmc_resume(host);
1990
1991         if (!err)
1992                 err = _mmc_suspend(host, false);
1993
1994         return err;
1995 }
1996
1997 /*
1998  * Callback for resume.
1999  */
2000 static int mmc_resume(struct mmc_host *host)
2001 {
2002         int err = 0;
2003
2004         if (!(host->caps & MMC_CAP_RUNTIME_RESUME)) {
2005                 err = _mmc_resume(host);
2006                 pm_runtime_set_active(&host->card->dev);
2007                 pm_runtime_mark_last_busy(&host->card->dev);
2008         }
2009         pm_runtime_enable(&host->card->dev);
2010
2011         return err;
2012 }
2013
2014 /*
2015  * Callback for runtime_suspend.
2016  */
2017 static int mmc_runtime_suspend(struct mmc_host *host)
2018 {
2019         int err;
2020
2021         if (!(host->caps & MMC_CAP_AGGRESSIVE_PM))
2022                 return 0;
2023
2024         err = _mmc_suspend(host, true);
2025         if (err)
2026                 pr_err("%s: error %d doing aggressive suspend\n",
2027                         mmc_hostname(host), err);
2028
2029         return err;
2030 }
2031
2032 /*
2033  * Callback for runtime_resume.
2034  */
2035 static int mmc_runtime_resume(struct mmc_host *host)
2036 {
2037         int err;
2038
2039         if (!(host->caps & (MMC_CAP_AGGRESSIVE_PM | MMC_CAP_RUNTIME_RESUME)))
2040                 return 0;
2041
2042         err = _mmc_resume(host);
2043         if (err)
2044                 pr_err("%s: error %d doing aggressive resume\n",
2045                         mmc_hostname(host), err);
2046
2047         return 0;
2048 }
2049
2050 int mmc_can_reset(struct mmc_card *card)
2051 {
2052         u8 rst_n_function;
2053
2054         rst_n_function = card->ext_csd.rst_n_function;
2055         if ((rst_n_function & EXT_CSD_RST_N_EN_MASK) != EXT_CSD_RST_N_ENABLED)
2056                 return 0;
2057         return 1;
2058 }
2059 EXPORT_SYMBOL(mmc_can_reset);
2060
2061 static int mmc_reset(struct mmc_host *host)
2062 {
2063         struct mmc_card *card = host->card;
2064
2065         if (!(host->caps & MMC_CAP_HW_RESET) || !host->ops->hw_reset)
2066                 return -EOPNOTSUPP;
2067
2068         if (!mmc_can_reset(card))
2069                 return -EOPNOTSUPP;
2070
2071         mmc_set_clock(host, host->f_init);
2072
2073         host->ops->hw_reset(host);
2074
2075         /* Set initial state and call mmc_set_ios */
2076         mmc_set_initial_state(host);
2077
2078         return mmc_init_card(host, card->ocr, card);
2079 }
2080
2081 static const struct mmc_bus_ops mmc_ops = {
2082         .remove = mmc_remove,
2083         .detect = mmc_detect,
2084         .suspend = mmc_suspend,
2085         .resume = mmc_resume,
2086         .runtime_suspend = mmc_runtime_suspend,
2087         .runtime_resume = mmc_runtime_resume,
2088         .alive = mmc_alive,
2089         .shutdown = mmc_shutdown,
2090         .reset = mmc_reset,
2091 };
2092
2093 /*
2094  * Starting point for MMC card init.
2095  */
2096 int mmc_attach_mmc(struct mmc_host *host)
2097 {
2098         int err;
2099         u32 ocr, rocr;
2100
2101         BUG_ON(!host);
2102         WARN_ON(!host->claimed);
2103
2104         /* Set correct bus mode for MMC before attempting attach */
2105         if (!mmc_host_is_spi(host))
2106                 mmc_set_bus_mode(host, MMC_BUSMODE_OPENDRAIN);
2107
2108         err = mmc_send_op_cond(host, 0, &ocr);
2109         if (err)
2110                 return err;
2111
2112         mmc_attach_bus(host, &mmc_ops);
2113         if (host->ocr_avail_mmc)
2114                 host->ocr_avail = host->ocr_avail_mmc;
2115
2116         /*
2117          * We need to get OCR a different way for SPI.
2118          */
2119         if (mmc_host_is_spi(host)) {
2120                 err = mmc_spi_read_ocr(host, 1, &ocr);
2121                 if (err)
2122                         goto err;
2123         }
2124
2125         rocr = mmc_select_voltage(host, ocr);
2126
2127         /*
2128          * Can we support the voltage of the card?
2129          */
2130         if (!rocr) {
2131                 err = -EINVAL;
2132                 goto err;
2133         }
2134
2135         /*
2136          * Detect and init the card.
2137          */
2138         err = mmc_init_card(host, rocr, NULL);
2139         if (err)
2140                 goto err;
2141
2142         mmc_release_host(host);
2143         err = mmc_add_card(host->card);
2144         if (err)
2145                 goto remove_card;
2146
2147         mmc_claim_host(host);
2148         return 0;
2149
2150 remove_card:
2151         mmc_remove_card(host->card);
2152         mmc_claim_host(host);
2153         host->card = NULL;
2154 err:
2155         mmc_detach_bus(host);
2156
2157         pr_err("%s: error %d whilst initialising MMC card\n",
2158                 mmc_hostname(host), err);
2159
2160         return err;
2161 }