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