UPSTREAM: PCI: rockchip: Set vendor ID from local core config space
[firefly-linux-kernel-4.4.55.git] / 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_info("%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 MMC_DEV_ATTR(ocr, "%08x\n", card->ocr);
737
738 static ssize_t mmc_fwrev_show(struct device *dev,
739                               struct device_attribute *attr,
740                               char *buf)
741 {
742         struct mmc_card *card = mmc_dev_to_card(dev);
743
744         if (card->ext_csd.rev < 7) {
745                 return sprintf(buf, "0x%x\n", card->cid.fwrev);
746         } else {
747                 return sprintf(buf, "0x%*phN\n", MMC_FIRMWARE_LEN,
748                                card->ext_csd.fwrev);
749         }
750 }
751
752 static DEVICE_ATTR(fwrev, S_IRUGO, mmc_fwrev_show, NULL);
753
754 static ssize_t mmc_dsr_show(struct device *dev,
755                             struct device_attribute *attr,
756                             char *buf)
757 {
758         struct mmc_card *card = mmc_dev_to_card(dev);
759         struct mmc_host *host = card->host;
760
761         if (card->csd.dsr_imp && host->dsr_req)
762                 return sprintf(buf, "0x%x\n", host->dsr);
763         else
764                 /* return default DSR value */
765                 return sprintf(buf, "0x%x\n", 0x404);
766 }
767
768 static DEVICE_ATTR(dsr, S_IRUGO, mmc_dsr_show, NULL);
769
770 static struct attribute *mmc_std_attrs[] = {
771         &dev_attr_cid.attr,
772         &dev_attr_csd.attr,
773         &dev_attr_date.attr,
774         &dev_attr_erase_size.attr,
775         &dev_attr_preferred_erase_size.attr,
776         &dev_attr_fwrev.attr,
777         &dev_attr_ffu_capable.attr,
778         &dev_attr_hwrev.attr,
779         &dev_attr_manfid.attr,
780         &dev_attr_name.attr,
781         &dev_attr_oemid.attr,
782         &dev_attr_prv.attr,
783         &dev_attr_serial.attr,
784         &dev_attr_enhanced_area_offset.attr,
785         &dev_attr_enhanced_area_size.attr,
786         &dev_attr_raw_rpmb_size_mult.attr,
787         &dev_attr_rel_sectors.attr,
788         &dev_attr_ocr.attr,
789         &dev_attr_dsr.attr,
790         NULL,
791 };
792 ATTRIBUTE_GROUPS(mmc_std);
793
794 static struct device_type mmc_type = {
795         .groups = mmc_std_groups,
796 };
797
798 /*
799  * Select the PowerClass for the current bus width
800  * If power class is defined for 4/8 bit bus in the
801  * extended CSD register, select it by executing the
802  * mmc_switch command.
803  */
804 static int __mmc_select_powerclass(struct mmc_card *card,
805                                    unsigned int bus_width)
806 {
807         struct mmc_host *host = card->host;
808         struct mmc_ext_csd *ext_csd = &card->ext_csd;
809         unsigned int pwrclass_val = 0;
810         int err = 0;
811
812         switch (1 << host->ios.vdd) {
813         case MMC_VDD_165_195:
814                 if (host->ios.clock <= MMC_HIGH_26_MAX_DTR)
815                         pwrclass_val = ext_csd->raw_pwr_cl_26_195;
816                 else if (host->ios.clock <= MMC_HIGH_52_MAX_DTR)
817                         pwrclass_val = (bus_width <= EXT_CSD_BUS_WIDTH_8) ?
818                                 ext_csd->raw_pwr_cl_52_195 :
819                                 ext_csd->raw_pwr_cl_ddr_52_195;
820                 else if (host->ios.clock <= MMC_HS200_MAX_DTR)
821                         pwrclass_val = ext_csd->raw_pwr_cl_200_195;
822                 break;
823         case MMC_VDD_27_28:
824         case MMC_VDD_28_29:
825         case MMC_VDD_29_30:
826         case MMC_VDD_30_31:
827         case MMC_VDD_31_32:
828         case MMC_VDD_32_33:
829         case MMC_VDD_33_34:
830         case MMC_VDD_34_35:
831         case MMC_VDD_35_36:
832                 if (host->ios.clock <= MMC_HIGH_26_MAX_DTR)
833                         pwrclass_val = ext_csd->raw_pwr_cl_26_360;
834                 else if (host->ios.clock <= MMC_HIGH_52_MAX_DTR)
835                         pwrclass_val = (bus_width <= EXT_CSD_BUS_WIDTH_8) ?
836                                 ext_csd->raw_pwr_cl_52_360 :
837                                 ext_csd->raw_pwr_cl_ddr_52_360;
838                 else if (host->ios.clock <= MMC_HS200_MAX_DTR)
839                         pwrclass_val = (bus_width == EXT_CSD_DDR_BUS_WIDTH_8) ?
840                                 ext_csd->raw_pwr_cl_ddr_200_360 :
841                                 ext_csd->raw_pwr_cl_200_360;
842                 break;
843         default:
844                 pr_warn("%s: Voltage range not supported for power class\n",
845                         mmc_hostname(host));
846                 return -EINVAL;
847         }
848
849         if (bus_width & (EXT_CSD_BUS_WIDTH_8 | EXT_CSD_DDR_BUS_WIDTH_8))
850                 pwrclass_val = (pwrclass_val & EXT_CSD_PWR_CL_8BIT_MASK) >>
851                                 EXT_CSD_PWR_CL_8BIT_SHIFT;
852         else
853                 pwrclass_val = (pwrclass_val & EXT_CSD_PWR_CL_4BIT_MASK) >>
854                                 EXT_CSD_PWR_CL_4BIT_SHIFT;
855
856         /* If the power class is different from the default value */
857         if (pwrclass_val > 0) {
858                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
859                                  EXT_CSD_POWER_CLASS,
860                                  pwrclass_val,
861                                  card->ext_csd.generic_cmd6_time);
862         }
863
864         return err;
865 }
866
867 static int mmc_select_powerclass(struct mmc_card *card)
868 {
869         struct mmc_host *host = card->host;
870         u32 bus_width, ext_csd_bits;
871         int err, ddr;
872
873         /* Power class selection is supported for versions >= 4.0 */
874         if (!mmc_can_ext_csd(card))
875                 return 0;
876
877         bus_width = host->ios.bus_width;
878         /* Power class values are defined only for 4/8 bit bus */
879         if (bus_width == MMC_BUS_WIDTH_1)
880                 return 0;
881
882         ddr = card->mmc_avail_type & EXT_CSD_CARD_TYPE_DDR_52;
883         if (ddr)
884                 ext_csd_bits = (bus_width == MMC_BUS_WIDTH_8) ?
885                         EXT_CSD_DDR_BUS_WIDTH_8 : EXT_CSD_DDR_BUS_WIDTH_4;
886         else
887                 ext_csd_bits = (bus_width == MMC_BUS_WIDTH_8) ?
888                         EXT_CSD_BUS_WIDTH_8 :  EXT_CSD_BUS_WIDTH_4;
889
890         err = __mmc_select_powerclass(card, ext_csd_bits);
891         if (err)
892                 pr_warn("%s: power class selection to bus width %d ddr %d failed\n",
893                         mmc_hostname(host), 1 << bus_width, ddr);
894
895         return err;
896 }
897
898 /*
899  * Set the bus speed for the selected speed mode.
900  */
901 static void mmc_set_bus_speed(struct mmc_card *card)
902 {
903         unsigned int max_dtr = (unsigned int)-1;
904
905         if ((mmc_card_hs200(card) || mmc_card_hs400(card)) &&
906              max_dtr > card->ext_csd.hs200_max_dtr)
907                 max_dtr = card->ext_csd.hs200_max_dtr;
908         else if (mmc_card_hs(card) && max_dtr > card->ext_csd.hs_max_dtr)
909                 max_dtr = card->ext_csd.hs_max_dtr;
910         else if (max_dtr > card->csd.max_dtr)
911                 max_dtr = card->csd.max_dtr;
912
913         mmc_set_clock(card->host, max_dtr);
914 }
915
916 /*
917  * Select the bus width amoung 4-bit and 8-bit(SDR).
918  * If the bus width is changed successfully, return the selected width value.
919  * Zero is returned instead of error value if the wide width is not supported.
920  */
921 static int mmc_select_bus_width(struct mmc_card *card)
922 {
923         static unsigned ext_csd_bits[] = {
924                 EXT_CSD_BUS_WIDTH_8,
925                 EXT_CSD_BUS_WIDTH_4,
926         };
927         static unsigned bus_widths[] = {
928                 MMC_BUS_WIDTH_8,
929                 MMC_BUS_WIDTH_4,
930         };
931         struct mmc_host *host = card->host;
932         unsigned idx, bus_width = 0;
933         int err = 0;
934
935         if (!mmc_can_ext_csd(card) ||
936             !(host->caps & (MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA)))
937                 return 0;
938
939         idx = (host->caps & MMC_CAP_8_BIT_DATA) ? 0 : 1;
940
941         /*
942          * Unlike SD, MMC cards dont have a configuration register to notify
943          * supported bus width. So bus test command should be run to identify
944          * the supported bus width or compare the ext csd values of current
945          * bus width and ext csd values of 1 bit mode read earlier.
946          */
947         for (; idx < ARRAY_SIZE(bus_widths); idx++) {
948                 /*
949                  * Host is capable of 8bit transfer, then switch
950                  * the device to work in 8bit transfer mode. If the
951                  * mmc switch command returns error then switch to
952                  * 4bit transfer mode. On success set the corresponding
953                  * bus width on the host.
954                  */
955                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
956                                  EXT_CSD_BUS_WIDTH,
957                                  ext_csd_bits[idx],
958                                  card->ext_csd.generic_cmd6_time);
959                 if (err)
960                         continue;
961
962                 bus_width = bus_widths[idx];
963                 mmc_set_bus_width(host, bus_width);
964
965                 /*
966                  * If controller can't handle bus width test,
967                  * compare ext_csd previously read in 1 bit mode
968                  * against ext_csd at new bus width
969                  */
970                 if (!(host->caps & MMC_CAP_BUS_WIDTH_TEST))
971                         err = mmc_compare_ext_csds(card, bus_width);
972                 else
973                         err = mmc_bus_test(card, bus_width);
974
975                 if (!err) {
976                         err = bus_width;
977                         break;
978                 } else {
979                         pr_warn("%s: switch to bus width %d failed\n",
980                                 mmc_hostname(host), 1 << bus_width);
981                 }
982         }
983
984         return err;
985 }
986
987 /* Caller must hold re-tuning */
988 static int mmc_switch_status(struct mmc_card *card)
989 {
990         u32 status;
991         int err;
992
993         err = mmc_send_status(card, &status);
994         if (err)
995                 return err;
996
997         return mmc_switch_status_error(card->host, status);
998 }
999
1000 /*
1001  * Switch to the high-speed mode
1002  */
1003 static int mmc_select_hs(struct mmc_card *card)
1004 {
1005         int err;
1006
1007         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1008                            EXT_CSD_HS_TIMING, EXT_CSD_TIMING_HS,
1009                            card->ext_csd.generic_cmd6_time,
1010                            true, false, true);
1011         if (!err)
1012                 mmc_set_timing(card->host, MMC_TIMING_MMC_HS);
1013
1014         if (err)
1015                 pr_warn("%s: switch to high-speed failed, err:%d\n",
1016                         mmc_hostname(card->host), err);
1017
1018         return err;
1019 }
1020
1021 /*
1022  * Activate wide bus and DDR if supported.
1023  */
1024 static int mmc_select_hs_ddr(struct mmc_card *card)
1025 {
1026         struct mmc_host *host = card->host;
1027         u32 bus_width, ext_csd_bits;
1028         int err = 0;
1029
1030         if (!(card->mmc_avail_type & EXT_CSD_CARD_TYPE_DDR_52))
1031                 return 0;
1032
1033         bus_width = host->ios.bus_width;
1034         if (bus_width == MMC_BUS_WIDTH_1)
1035                 return 0;
1036
1037         ext_csd_bits = (bus_width == MMC_BUS_WIDTH_8) ?
1038                 EXT_CSD_DDR_BUS_WIDTH_8 : EXT_CSD_DDR_BUS_WIDTH_4;
1039
1040         err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1041                         EXT_CSD_BUS_WIDTH,
1042                         ext_csd_bits,
1043                         card->ext_csd.generic_cmd6_time);
1044         if (err) {
1045                 pr_err("%s: switch to bus width %d ddr failed\n",
1046                         mmc_hostname(host), 1 << bus_width);
1047                 return err;
1048         }
1049
1050         /*
1051          * eMMC cards can support 3.3V to 1.2V i/o (vccq)
1052          * signaling.
1053          *
1054          * EXT_CSD_CARD_TYPE_DDR_1_8V means 3.3V or 1.8V vccq.
1055          *
1056          * 1.8V vccq at 3.3V core voltage (vcc) is not required
1057          * in the JEDEC spec for DDR.
1058          *
1059          * Even (e)MMC card can support 3.3v to 1.2v vccq, but not all
1060          * host controller can support this, like some of the SDHCI
1061          * controller which connect to an eMMC device. Some of these
1062          * host controller still needs to use 1.8v vccq for supporting
1063          * DDR mode.
1064          *
1065          * So the sequence will be:
1066          * if (host and device can both support 1.2v IO)
1067          *      use 1.2v IO;
1068          * else if (host and device can both support 1.8v IO)
1069          *      use 1.8v IO;
1070          * so if host and device can only support 3.3v IO, this is the
1071          * last choice.
1072          *
1073          * WARNING: eMMC rules are NOT the same as SD DDR
1074          */
1075         err = -EINVAL;
1076         if (card->mmc_avail_type & EXT_CSD_CARD_TYPE_DDR_1_2V)
1077                 err = __mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_120);
1078
1079         if (err && (card->mmc_avail_type & EXT_CSD_CARD_TYPE_DDR_1_8V))
1080                 err = __mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_180);
1081
1082         /* make sure vccq is 3.3v after switching disaster */
1083         if (err)
1084                 err = __mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_330);
1085
1086         if (!err)
1087                 mmc_set_timing(host, MMC_TIMING_MMC_DDR52);
1088
1089         return err;
1090 }
1091
1092 static int mmc_select_hs400(struct mmc_card *card)
1093 {
1094         struct mmc_host *host = card->host;
1095         unsigned int max_dtr;
1096         int err = 0;
1097         u8 val;
1098
1099         /*
1100          * HS400 mode requires 8-bit bus width
1101          */
1102         if (!(card->mmc_avail_type & EXT_CSD_CARD_TYPE_HS400 &&
1103               host->ios.bus_width == MMC_BUS_WIDTH_8))
1104                 return 0;
1105
1106         /* Switch card to HS mode */
1107         val = EXT_CSD_TIMING_HS;
1108         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1109                            EXT_CSD_HS_TIMING, val,
1110                            card->ext_csd.generic_cmd6_time,
1111                            true, false, true);
1112         if (err) {
1113                 pr_err("%s: switch to high-speed from hs200 failed, err:%d\n",
1114                         mmc_hostname(host), err);
1115                 return err;
1116         }
1117
1118         /* Set host controller to HS timing */
1119         mmc_set_timing(card->host, MMC_TIMING_MMC_HS);
1120
1121         /* Reduce frequency to HS frequency */
1122         max_dtr = card->ext_csd.hs_max_dtr;
1123         mmc_set_clock(host, max_dtr);
1124
1125         err = mmc_switch_status(card);
1126         if (err)
1127                 goto out_err;
1128
1129         /* Switch card to DDR */
1130         err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1131                          EXT_CSD_BUS_WIDTH,
1132                          EXT_CSD_DDR_BUS_WIDTH_8,
1133                          card->ext_csd.generic_cmd6_time);
1134         if (err) {
1135                 pr_err("%s: switch to bus width for hs400 failed, err:%d\n",
1136                         mmc_hostname(host), err);
1137                 return err;
1138         }
1139
1140         /* Switch card to HS400 */
1141         val = EXT_CSD_TIMING_HS400 |
1142               card->drive_strength << EXT_CSD_DRV_STR_SHIFT;
1143         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1144                            EXT_CSD_HS_TIMING, val,
1145                            card->ext_csd.generic_cmd6_time,
1146                            true, false, true);
1147         if (err) {
1148                 pr_err("%s: switch to hs400 failed, err:%d\n",
1149                          mmc_hostname(host), err);
1150                 return err;
1151         }
1152
1153         /* Set host controller to HS400 timing and frequency */
1154         mmc_set_timing(host, MMC_TIMING_MMC_HS400);
1155         mmc_set_bus_speed(card);
1156
1157         err = mmc_switch_status(card);
1158         if (err)
1159                 goto out_err;
1160
1161         return 0;
1162
1163 out_err:
1164         pr_err("%s: %s failed, error %d\n", mmc_hostname(card->host),
1165                __func__, err);
1166         return err;
1167 }
1168
1169 int mmc_hs200_to_hs400(struct mmc_card *card)
1170 {
1171         return mmc_select_hs400(card);
1172 }
1173
1174 int mmc_hs400_to_hs200(struct mmc_card *card)
1175 {
1176         struct mmc_host *host = card->host;
1177         unsigned int max_dtr;
1178         int err;
1179         u8 val;
1180
1181         /* Reduce frequency to HS */
1182         max_dtr = card->ext_csd.hs_max_dtr;
1183         mmc_set_clock(host, max_dtr);
1184
1185         /* Switch HS400 to HS DDR */
1186         val = EXT_CSD_TIMING_HS;
1187         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_HS_TIMING,
1188                            val, card->ext_csd.generic_cmd6_time,
1189                            true, false, true);
1190         if (err)
1191                 goto out_err;
1192
1193         mmc_set_timing(host, MMC_TIMING_MMC_DDR52);
1194
1195         err = mmc_switch_status(card);
1196         if (err)
1197                 goto out_err;
1198
1199         /* Switch HS DDR to HS */
1200         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_BUS_WIDTH,
1201                            EXT_CSD_BUS_WIDTH_8, card->ext_csd.generic_cmd6_time,
1202                            true, false, true);
1203         if (err)
1204                 goto out_err;
1205
1206         mmc_set_timing(host, MMC_TIMING_MMC_HS);
1207
1208         err = mmc_switch_status(card);
1209         if (err)
1210                 goto out_err;
1211
1212         /* Switch HS to HS200 */
1213         val = EXT_CSD_TIMING_HS200 |
1214               card->drive_strength << EXT_CSD_DRV_STR_SHIFT;
1215         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_HS_TIMING,
1216                            val, card->ext_csd.generic_cmd6_time,
1217                            true, false, true);
1218         if (err)
1219                 goto out_err;
1220
1221         mmc_set_timing(host, MMC_TIMING_MMC_HS200);
1222
1223         err = mmc_switch_status(card);
1224         if (err)
1225                 goto out_err;
1226
1227         mmc_set_bus_speed(card);
1228
1229         return 0;
1230
1231 out_err:
1232         pr_err("%s: %s failed, error %d\n", mmc_hostname(card->host),
1233                __func__, err);
1234         return err;
1235 }
1236
1237 static int mmc_select_hs400es(struct mmc_card *card)
1238 {
1239         struct mmc_host *host = card->host;
1240         int err = 0;
1241         u8 val;
1242
1243         if (!(host->caps & MMC_CAP_8_BIT_DATA)) {
1244                 err = -ENOTSUPP;
1245                 goto out_err;
1246         }
1247
1248         if (card->mmc_avail_type & EXT_CSD_CARD_TYPE_HS200_1_2V)
1249                 err = __mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_120);
1250
1251         if (err && card->mmc_avail_type & EXT_CSD_CARD_TYPE_HS200_1_8V)
1252                 err = __mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_180);
1253
1254         /* If fails try again during next card power cycle */
1255         if (err)
1256                 goto out_err;
1257
1258         err = mmc_select_bus_width(card);
1259         if (err < 0)
1260                 goto out_err;
1261
1262         /* Switch card to HS mode */
1263         err = mmc_select_hs(card);
1264         if (err)
1265                 goto out_err;
1266
1267         mmc_set_clock(host, card->ext_csd.hs_max_dtr);
1268
1269         err = mmc_switch_status(card);
1270         if (err)
1271                 goto out_err;
1272
1273         /* Switch card to DDR with strobe bit */
1274         val = EXT_CSD_DDR_BUS_WIDTH_8 | EXT_CSD_BUS_WIDTH_STROBE;
1275         err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1276                          EXT_CSD_BUS_WIDTH,
1277                          val,
1278                          card->ext_csd.generic_cmd6_time);
1279         if (err) {
1280                 pr_err("%s: switch to bus width for hs400es failed, err:%d\n",
1281                         mmc_hostname(host), err);
1282                 goto out_err;
1283         }
1284
1285         /* Switch card to HS400 */
1286         val = EXT_CSD_TIMING_HS400 |
1287               card->drive_strength << EXT_CSD_DRV_STR_SHIFT;
1288         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1289                            EXT_CSD_HS_TIMING, val,
1290                            card->ext_csd.generic_cmd6_time,
1291                            true, false, true);
1292         if (err) {
1293                 pr_err("%s: switch to hs400es failed, err:%d\n",
1294                         mmc_hostname(host), err);
1295                 goto out_err;
1296         }
1297
1298         /* Set host controller to HS400 timing and frequency */
1299         mmc_set_timing(host, MMC_TIMING_MMC_HS400);
1300
1301         /* Controller enable enhanced strobe function */
1302         host->ios.enhanced_strobe = true;
1303         if (host->ops->hs400_enhanced_strobe)
1304                 host->ops->hs400_enhanced_strobe(host, &host->ios);
1305
1306         err = mmc_switch_status(card);
1307         if (err)
1308                 goto out_err;
1309
1310         return 0;
1311
1312 out_err:
1313         pr_err("%s: %s failed, error %d\n", mmc_hostname(card->host),
1314                __func__, err);
1315         return err;
1316 }
1317
1318 static void mmc_select_driver_type(struct mmc_card *card)
1319 {
1320         int card_drv_type, drive_strength, drv_type;
1321
1322         card_drv_type = card->ext_csd.raw_driver_strength |
1323                         mmc_driver_type_mask(0);
1324
1325         drive_strength = mmc_select_drive_strength(card,
1326                                                    card->ext_csd.hs200_max_dtr,
1327                                                    card_drv_type, &drv_type);
1328
1329         card->drive_strength = drive_strength;
1330
1331         if (drv_type)
1332                 mmc_set_driver_type(card->host, drv_type);
1333 }
1334
1335 /*
1336  * For device supporting HS200 mode, the following sequence
1337  * should be done before executing the tuning process.
1338  * 1. set the desired bus width(4-bit or 8-bit, 1-bit is not supported)
1339  * 2. switch to HS200 mode
1340  * 3. set the clock to > 52Mhz and <=200MHz
1341  */
1342 static int mmc_select_hs200(struct mmc_card *card)
1343 {
1344         struct mmc_host *host = card->host;
1345         unsigned int old_timing, old_signal_voltage;
1346         int err = -EINVAL;
1347         u8 val;
1348
1349         old_signal_voltage = host->ios.signal_voltage;
1350         if (card->mmc_avail_type & EXT_CSD_CARD_TYPE_HS200_1_2V)
1351                 err = __mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_120);
1352
1353         if (err && card->mmc_avail_type & EXT_CSD_CARD_TYPE_HS200_1_8V)
1354                 err = __mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_180);
1355
1356         /* If fails try again during next card power cycle */
1357         if (err)
1358                 return err;
1359
1360         mmc_select_driver_type(card);
1361
1362         /*
1363          * Set the bus width(4 or 8) with host's support and
1364          * switch to HS200 mode if bus width is set successfully.
1365          */
1366         err = mmc_select_bus_width(card);
1367         if (err > 0) {
1368                 val = EXT_CSD_TIMING_HS200 |
1369                       card->drive_strength << EXT_CSD_DRV_STR_SHIFT;
1370                 err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1371                                    EXT_CSD_HS_TIMING, val,
1372                                    card->ext_csd.generic_cmd6_time,
1373                                    true, false, true);
1374                 if (err)
1375                         goto err;
1376                 old_timing = host->ios.timing;
1377                 mmc_set_timing(host, MMC_TIMING_MMC_HS200);
1378         }
1379 err:
1380         if (err) {
1381                 /* fall back to the old signal voltage, if fails report error */
1382                 if (__mmc_set_signal_voltage(host, old_signal_voltage))
1383                         err = -EIO;
1384
1385                 pr_err("%s: %s failed, error %d\n", mmc_hostname(card->host),
1386                        __func__, err);
1387         }
1388         return err;
1389 }
1390
1391 /*
1392  * Activate High Speed, 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 bus_speed:
1412         /*
1413          * Set the bus speed to the selected bus timing.
1414          * If timing is not selected, backward compatible is the default.
1415          */
1416         mmc_set_bus_speed(card);
1417         return 0;
1418 }
1419
1420 /*
1421  * Execute tuning sequence to seek the proper bus operating
1422  * conditions for HS200 and HS400, which sends CMD21 to the device.
1423  */
1424 static int mmc_hs200_tuning(struct mmc_card *card)
1425 {
1426         struct mmc_host *host = card->host;
1427
1428         /*
1429          * Timing should be adjusted to the HS400 target
1430          * operation frequency for tuning process
1431          */
1432         if (card->mmc_avail_type & EXT_CSD_CARD_TYPE_HS400 &&
1433             host->ios.bus_width == MMC_BUS_WIDTH_8)
1434                 if (host->ops->prepare_hs400_tuning)
1435                         host->ops->prepare_hs400_tuning(host, &host->ios);
1436
1437         return mmc_execute_tuning(card);
1438 }
1439
1440 /*
1441  * Handle the detection and initialisation of a card.
1442  *
1443  * In the case of a resume, "oldcard" will contain the card
1444  * we're trying to reinitialise.
1445  */
1446 static int mmc_init_card(struct mmc_host *host, u32 ocr,
1447         struct mmc_card *oldcard)
1448 {
1449         struct mmc_card *card;
1450         int err;
1451         u32 cid[4];
1452         u32 rocr;
1453
1454         BUG_ON(!host);
1455         WARN_ON(!host->claimed);
1456
1457         /* Set correct bus mode for MMC before attempting init */
1458         if (!mmc_host_is_spi(host))
1459                 mmc_set_bus_mode(host, MMC_BUSMODE_OPENDRAIN);
1460
1461         /*
1462          * Since we're changing the OCR value, we seem to
1463          * need to tell some cards to go back to the idle
1464          * state.  We wait 1ms to give cards time to
1465          * respond.
1466          * mmc_go_idle is needed for eMMC that are asleep
1467          */
1468         mmc_go_idle(host);
1469
1470         /* The extra bit indicates that we support high capacity */
1471         err = mmc_send_op_cond(host, ocr | (1 << 30), &rocr);
1472         if (err)
1473                 goto err;
1474
1475         /*
1476          * For SPI, enable CRC as appropriate.
1477          */
1478         if (mmc_host_is_spi(host)) {
1479                 err = mmc_spi_set_crc(host, use_spi_crc);
1480                 if (err)
1481                         goto err;
1482         }
1483
1484         /*
1485          * Fetch CID from card.
1486          */
1487         if (mmc_host_is_spi(host))
1488                 err = mmc_send_cid(host, cid);
1489         else
1490                 err = mmc_all_send_cid(host, cid);
1491         if (err)
1492                 goto err;
1493
1494         if (oldcard) {
1495                 if (memcmp(cid, oldcard->raw_cid, sizeof(cid)) != 0) {
1496                         err = -ENOENT;
1497                         goto err;
1498                 }
1499
1500                 card = oldcard;
1501         } else {
1502                 /*
1503                  * Allocate card structure.
1504                  */
1505                 card = mmc_alloc_card(host, &mmc_type);
1506                 if (IS_ERR(card)) {
1507                         err = PTR_ERR(card);
1508                         goto err;
1509                 }
1510
1511                 card->ocr = ocr;
1512                 card->type = MMC_TYPE_MMC;
1513                 card->rca = 1;
1514                 memcpy(card->raw_cid, cid, sizeof(card->raw_cid));
1515         }
1516
1517         /*
1518          * Call the optional HC's init_card function to handle quirks.
1519          */
1520         if (host->ops->init_card)
1521                 host->ops->init_card(host, card);
1522
1523         /*
1524          * For native busses:  set card RCA and quit open drain mode.
1525          */
1526         if (!mmc_host_is_spi(host)) {
1527                 err = mmc_set_relative_addr(card);
1528                 if (err)
1529                         goto free_card;
1530
1531                 mmc_set_bus_mode(host, MMC_BUSMODE_PUSHPULL);
1532         }
1533
1534         if (!oldcard) {
1535                 /*
1536                  * Fetch CSD from card.
1537                  */
1538                 err = mmc_send_csd(card, card->raw_csd);
1539                 if (err)
1540                         goto free_card;
1541
1542                 err = mmc_decode_csd(card);
1543                 if (err)
1544                         goto free_card;
1545                 err = mmc_decode_cid(card);
1546                 if (err)
1547                         goto free_card;
1548         }
1549
1550         /*
1551          * handling only for cards supporting DSR and hosts requesting
1552          * DSR configuration
1553          */
1554         if (card->csd.dsr_imp && host->dsr_req)
1555                 mmc_set_dsr(host);
1556
1557         /*
1558          * Select card, as all following commands rely on that.
1559          */
1560         if (!mmc_host_is_spi(host)) {
1561                 err = mmc_select_card(card);
1562                 if (err)
1563                         goto free_card;
1564         }
1565
1566         if (!oldcard) {
1567                 /* Read extended CSD. */
1568                 err = mmc_read_ext_csd(card);
1569                 if (err)
1570                         goto free_card;
1571
1572                 /*
1573                  * If doing byte addressing, check if required to do sector
1574                  * addressing.  Handle the case of <2GB cards needing sector
1575                  * addressing.  See section 8.1 JEDEC Standard JED84-A441;
1576                  * ocr register has bit 30 set for sector addressing.
1577                  */
1578                 if (rocr & BIT(30))
1579                         mmc_card_set_blockaddr(card);
1580
1581                 /* Erase size depends on CSD and Extended CSD */
1582                 mmc_set_erase_size(card);
1583         }
1584
1585         /*
1586          * If enhanced_area_en is TRUE, host needs to enable ERASE_GRP_DEF
1587          * bit.  This bit will be lost every time after a reset or power off.
1588          */
1589         if (card->ext_csd.partition_setting_completed ||
1590             (card->ext_csd.rev >= 3 && (host->caps2 & MMC_CAP2_HC_ERASE_SZ))) {
1591                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1592                                  EXT_CSD_ERASE_GROUP_DEF, 1,
1593                                  card->ext_csd.generic_cmd6_time);
1594
1595                 if (err && err != -EBADMSG)
1596                         goto free_card;
1597
1598                 if (err) {
1599                         err = 0;
1600                         /*
1601                          * Just disable enhanced area off & sz
1602                          * will try to enable ERASE_GROUP_DEF
1603                          * during next time reinit
1604                          */
1605                         card->ext_csd.enhanced_area_offset = -EINVAL;
1606                         card->ext_csd.enhanced_area_size = -EINVAL;
1607                 } else {
1608                         card->ext_csd.erase_group_def = 1;
1609                         /*
1610                          * enable ERASE_GRP_DEF successfully.
1611                          * This will affect the erase size, so
1612                          * here need to reset erase size
1613                          */
1614                         mmc_set_erase_size(card);
1615                 }
1616         }
1617
1618         /*
1619          * Ensure eMMC user default partition is enabled
1620          */
1621         if (card->ext_csd.part_config & EXT_CSD_PART_CONFIG_ACC_MASK) {
1622                 card->ext_csd.part_config &= ~EXT_CSD_PART_CONFIG_ACC_MASK;
1623                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_PART_CONFIG,
1624                                  card->ext_csd.part_config,
1625                                  card->ext_csd.part_time);
1626                 if (err && err != -EBADMSG)
1627                         goto free_card;
1628         }
1629
1630         /*
1631          * Enable power_off_notification byte in the ext_csd register
1632          */
1633         if (card->ext_csd.rev >= 6) {
1634                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1635                                  EXT_CSD_POWER_OFF_NOTIFICATION,
1636                                  EXT_CSD_POWER_ON,
1637                                  card->ext_csd.generic_cmd6_time);
1638                 if (err && err != -EBADMSG)
1639                         goto free_card;
1640
1641                 /*
1642                  * The err can be -EBADMSG or 0,
1643                  * so check for success and update the flag
1644                  */
1645                 if (!err)
1646                         card->ext_csd.power_off_notification = EXT_CSD_POWER_ON;
1647         }
1648
1649         /*
1650          * Select timing interface
1651          */
1652         err = mmc_select_timing(card);
1653         if (err)
1654                 goto free_card;
1655
1656         if (mmc_card_hs200(card)) {
1657                 err = mmc_hs200_tuning(card);
1658                 if (err)
1659                         goto free_card;
1660
1661                 err = mmc_select_hs400(card);
1662                 if (err)
1663                         goto free_card;
1664         } else if (mmc_card_hs(card)) {
1665                 /* Select the desired bus width optionally */
1666                 err = mmc_select_bus_width(card);
1667                 if (err > 0) {
1668                         err = mmc_select_hs_ddr(card);
1669                         if (err)
1670                                 goto free_card;
1671                 }
1672         }
1673
1674         /*
1675          * Choose the power class with selected bus interface
1676          */
1677         mmc_select_powerclass(card);
1678
1679         /*
1680          * Enable HPI feature (if supported)
1681          */
1682         if (card->ext_csd.hpi) {
1683                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1684                                 EXT_CSD_HPI_MGMT, 1,
1685                                 card->ext_csd.generic_cmd6_time);
1686                 if (err && err != -EBADMSG)
1687                         goto free_card;
1688                 if (err) {
1689                         pr_warn("%s: Enabling HPI failed\n",
1690                                 mmc_hostname(card->host));
1691                         err = 0;
1692                 } else
1693                         card->ext_csd.hpi_en = 1;
1694         }
1695
1696         /*
1697          * If cache size is higher than 0, this indicates
1698          * the existence of cache and it can be turned on.
1699          */
1700         if (card->ext_csd.cache_size > 0) {
1701                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1702                                 EXT_CSD_CACHE_CTRL, 1,
1703                                 card->ext_csd.generic_cmd6_time);
1704                 if (err && err != -EBADMSG)
1705                         goto free_card;
1706
1707                 /*
1708                  * Only if no error, cache is turned on successfully.
1709                  */
1710                 if (err) {
1711                         pr_warn("%s: Cache is supported, but failed to turn on (%d)\n",
1712                                 mmc_hostname(card->host), err);
1713                         card->ext_csd.cache_ctrl = 0;
1714                         err = 0;
1715                 } else {
1716                         card->ext_csd.cache_ctrl = 1;
1717                 }
1718         }
1719
1720         /*
1721          * The mandatory minimum values are defined for packed command.
1722          * read: 5, write: 3
1723          */
1724         if (card->ext_csd.max_packed_writes >= 3 &&
1725             card->ext_csd.max_packed_reads >= 5 &&
1726             host->caps2 & MMC_CAP2_PACKED_CMD) {
1727                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1728                                 EXT_CSD_EXP_EVENTS_CTRL,
1729                                 EXT_CSD_PACKED_EVENT_EN,
1730                                 card->ext_csd.generic_cmd6_time);
1731                 if (err && err != -EBADMSG)
1732                         goto free_card;
1733                 if (err) {
1734                         pr_warn("%s: Enabling packed event failed\n",
1735                                 mmc_hostname(card->host));
1736                         card->ext_csd.packed_event_en = 0;
1737                         err = 0;
1738                 } else {
1739                         card->ext_csd.packed_event_en = 1;
1740                 }
1741         }
1742
1743         if (!oldcard)
1744                 host->card = card;
1745
1746         return 0;
1747
1748 free_card:
1749         if (!oldcard)
1750                 mmc_remove_card(card);
1751 err:
1752         return err;
1753 }
1754
1755 static int mmc_can_sleep(struct mmc_card *card)
1756 {
1757         return (card && card->ext_csd.rev >= 3);
1758 }
1759
1760 static int mmc_sleep(struct mmc_host *host)
1761 {
1762         struct mmc_command cmd = {0};
1763         struct mmc_card *card = host->card;
1764         unsigned int timeout_ms = DIV_ROUND_UP(card->ext_csd.sa_timeout, 10000);
1765         int err;
1766
1767         /* Re-tuning can't be done once the card is deselected */
1768         mmc_retune_hold(host);
1769
1770         err = mmc_deselect_cards(host);
1771         if (err)
1772                 goto out_release;
1773
1774         cmd.opcode = MMC_SLEEP_AWAKE;
1775         cmd.arg = card->rca << 16;
1776         cmd.arg |= 1 << 15;
1777
1778         /*
1779          * If the max_busy_timeout of the host is specified, validate it against
1780          * the sleep cmd timeout. A failure means we need to prevent the host
1781          * from doing hw busy detection, which is done by converting to a R1
1782          * response instead of a R1B.
1783          */
1784         if (host->max_busy_timeout && (timeout_ms > host->max_busy_timeout)) {
1785                 cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
1786         } else {
1787                 cmd.flags = MMC_RSP_R1B | MMC_CMD_AC;
1788                 cmd.busy_timeout = timeout_ms;
1789         }
1790
1791         err = mmc_wait_for_cmd(host, &cmd, 0);
1792         if (err)
1793                 goto out_release;
1794
1795         /*
1796          * If the host does not wait while the card signals busy, then we will
1797          * will have to wait the sleep/awake timeout.  Note, we cannot use the
1798          * SEND_STATUS command to poll the status because that command (and most
1799          * others) is invalid while the card sleeps.
1800          */
1801         if (!cmd.busy_timeout || !(host->caps & MMC_CAP_WAIT_WHILE_BUSY))
1802                 mmc_delay(timeout_ms);
1803
1804 out_release:
1805         mmc_retune_release(host);
1806         return err;
1807 }
1808
1809 static int mmc_can_poweroff_notify(const struct mmc_card *card)
1810 {
1811         return card &&
1812                 mmc_card_mmc(card) &&
1813                 (card->ext_csd.power_off_notification == EXT_CSD_POWER_ON);
1814 }
1815
1816 static int mmc_poweroff_notify(struct mmc_card *card, unsigned int notify_type)
1817 {
1818         unsigned int timeout = card->ext_csd.generic_cmd6_time;
1819         int err;
1820
1821         /* Use EXT_CSD_POWER_OFF_SHORT as default notification type. */
1822         if (notify_type == EXT_CSD_POWER_OFF_LONG)
1823                 timeout = card->ext_csd.power_off_longtime;
1824
1825         err = __mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1826                         EXT_CSD_POWER_OFF_NOTIFICATION,
1827                         notify_type, timeout, true, false, false);
1828         if (err)
1829                 pr_err("%s: Power Off Notification timed out, %u\n",
1830                        mmc_hostname(card->host), timeout);
1831
1832         /* Disable the power off notification after the switch operation. */
1833         card->ext_csd.power_off_notification = EXT_CSD_NO_POWER_NOTIFICATION;
1834
1835         return err;
1836 }
1837
1838 /*
1839  * Host is being removed. Free up the current card.
1840  */
1841 static void mmc_remove(struct mmc_host *host)
1842 {
1843         BUG_ON(!host);
1844         BUG_ON(!host->card);
1845
1846         mmc_remove_card(host->card);
1847         host->card = NULL;
1848 }
1849
1850 /*
1851  * Card detection - card is alive.
1852  */
1853 static int mmc_alive(struct mmc_host *host)
1854 {
1855         return mmc_send_status(host->card, NULL);
1856 }
1857
1858 /*
1859  * Card detection callback from host.
1860  */
1861 static void mmc_detect(struct mmc_host *host)
1862 {
1863         int err;
1864
1865         BUG_ON(!host);
1866         BUG_ON(!host->card);
1867
1868         mmc_get_card(host->card);
1869
1870         /*
1871          * Just check if our card has been removed.
1872          */
1873         err = _mmc_detect_card_removed(host);
1874
1875         mmc_put_card(host->card);
1876
1877         if (err) {
1878                 mmc_remove(host);
1879
1880                 mmc_claim_host(host);
1881                 mmc_detach_bus(host);
1882                 mmc_power_off(host);
1883                 mmc_release_host(host);
1884         }
1885 }
1886
1887 static int _mmc_suspend(struct mmc_host *host, bool is_suspend)
1888 {
1889         int err = 0;
1890         unsigned int notify_type = is_suspend ? EXT_CSD_POWER_OFF_SHORT :
1891                                         EXT_CSD_POWER_OFF_LONG;
1892
1893         BUG_ON(!host);
1894         BUG_ON(!host->card);
1895
1896         mmc_claim_host(host);
1897
1898         if (mmc_card_suspended(host->card))
1899                 goto out;
1900
1901         if (mmc_card_doing_bkops(host->card)) {
1902                 err = mmc_stop_bkops(host->card);
1903                 if (err)
1904                         goto out;
1905         }
1906
1907         err = mmc_flush_cache(host->card);
1908         if (err)
1909                 goto out;
1910
1911         if (mmc_can_poweroff_notify(host->card) &&
1912                 ((host->caps2 & MMC_CAP2_FULL_PWR_CYCLE) || !is_suspend))
1913                 err = mmc_poweroff_notify(host->card, notify_type);
1914         else if (mmc_can_sleep(host->card))
1915                 err = mmc_sleep(host);
1916         else if (!mmc_host_is_spi(host))
1917                 err = mmc_deselect_cards(host);
1918
1919         if (!err) {
1920                 mmc_power_off(host);
1921                 mmc_card_set_suspended(host->card);
1922         }
1923 out:
1924         mmc_release_host(host);
1925         return err;
1926 }
1927
1928 /*
1929  * Suspend callback
1930  */
1931 static int mmc_suspend(struct mmc_host *host)
1932 {
1933         int err;
1934
1935         err = _mmc_suspend(host, true);
1936         if (!err) {
1937                 pm_runtime_disable(&host->card->dev);
1938                 pm_runtime_set_suspended(&host->card->dev);
1939         }
1940
1941         return err;
1942 }
1943
1944 /*
1945  * This function tries to determine if the same card is still present
1946  * and, if so, restore all state to it.
1947  */
1948 static int _mmc_resume(struct mmc_host *host)
1949 {
1950         int err = 0;
1951         int i;
1952
1953         BUG_ON(!host);
1954         BUG_ON(!host->card);
1955
1956         mmc_claim_host(host);
1957
1958         if (!mmc_card_suspended(host->card))
1959                 goto out;
1960
1961         /*
1962          * Let's try to fallback the host->f_init
1963          * if failing to init mmc card after resume.
1964          */
1965         for (i = 0; i < ARRAY_SIZE(freqs); i++) {
1966                 if (host->f_init < max(freqs[i], host->f_min))
1967                         continue;
1968                 else
1969                         host->f_init = max(freqs[i], host->f_min);
1970
1971                 mmc_power_up(host, host->card->ocr);
1972                 err = mmc_init_card(host, host->card->ocr, host->card);
1973                 if (!err)
1974                         break;
1975         }
1976
1977         mmc_card_clr_suspended(host->card);
1978
1979 out:
1980         mmc_release_host(host);
1981         return err;
1982 }
1983
1984 /*
1985  * Shutdown callback
1986  */
1987 static int mmc_shutdown(struct mmc_host *host)
1988 {
1989         int err = 0;
1990
1991         /*
1992          * In a specific case for poweroff notify, we need to resume the card
1993          * before we can shutdown it properly.
1994          */
1995         if (mmc_can_poweroff_notify(host->card) &&
1996                 !(host->caps2 & MMC_CAP2_FULL_PWR_CYCLE))
1997                 err = _mmc_resume(host);
1998
1999         if (!err)
2000                 err = _mmc_suspend(host, false);
2001
2002         return err;
2003 }
2004
2005 /*
2006  * Callback for resume.
2007  */
2008 static int mmc_resume(struct mmc_host *host)
2009 {
2010         pm_runtime_enable(&host->card->dev);
2011         return 0;
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         err = _mmc_resume(host);
2040         if (err && err != -ENOMEDIUM)
2041                 pr_err("%s: error %d doing runtime resume\n",
2042                         mmc_hostname(host), err);
2043
2044         return 0;
2045 }
2046
2047 int mmc_can_reset(struct mmc_card *card)
2048 {
2049         u8 rst_n_function;
2050
2051         rst_n_function = card->ext_csd.rst_n_function;
2052         if ((rst_n_function & EXT_CSD_RST_N_EN_MASK) != EXT_CSD_RST_N_ENABLED)
2053                 return 0;
2054         return 1;
2055 }
2056 EXPORT_SYMBOL(mmc_can_reset);
2057
2058 static int mmc_reset(struct mmc_host *host)
2059 {
2060         struct mmc_card *card = host->card;
2061
2062         if (!(host->caps & MMC_CAP_HW_RESET) || !host->ops->hw_reset)
2063                 return -EOPNOTSUPP;
2064
2065         if (!mmc_can_reset(card))
2066                 return -EOPNOTSUPP;
2067
2068         mmc_set_clock(host, host->f_init);
2069
2070         host->ops->hw_reset(host);
2071
2072         /* Set initial state and call mmc_set_ios */
2073         mmc_set_initial_state(host);
2074
2075         return mmc_init_card(host, card->ocr, card);
2076 }
2077
2078 static const struct mmc_bus_ops mmc_ops = {
2079         .remove = mmc_remove,
2080         .detect = mmc_detect,
2081         .suspend = mmc_suspend,
2082         .resume = mmc_resume,
2083         .runtime_suspend = mmc_runtime_suspend,
2084         .runtime_resume = mmc_runtime_resume,
2085         .alive = mmc_alive,
2086         .shutdown = mmc_shutdown,
2087         .reset = mmc_reset,
2088 };
2089
2090 /*
2091  * Starting point for MMC card init.
2092  */
2093 int mmc_attach_mmc(struct mmc_host *host)
2094 {
2095         int err;
2096         u32 ocr, rocr;
2097
2098         BUG_ON(!host);
2099         WARN_ON(!host->claimed);
2100
2101         /* Set correct bus mode for MMC before attempting attach */
2102         if (!mmc_host_is_spi(host))
2103                 mmc_set_bus_mode(host, MMC_BUSMODE_OPENDRAIN);
2104
2105         err = mmc_send_op_cond(host, 0, &ocr);
2106         if (err)
2107                 return err;
2108
2109         mmc_attach_bus(host, &mmc_ops);
2110         if (host->ocr_avail_mmc)
2111                 host->ocr_avail = host->ocr_avail_mmc;
2112
2113         /*
2114          * We need to get OCR a different way for SPI.
2115          */
2116         if (mmc_host_is_spi(host)) {
2117                 err = mmc_spi_read_ocr(host, 1, &ocr);
2118                 if (err)
2119                         goto err;
2120         }
2121
2122         rocr = mmc_select_voltage(host, ocr);
2123
2124         /*
2125          * Can we support the voltage of the card?
2126          */
2127         if (!rocr) {
2128                 err = -EINVAL;
2129                 goto err;
2130         }
2131
2132         /*
2133          * Detect and init the card.
2134          */
2135         err = mmc_init_card(host, rocr, NULL);
2136         if (err)
2137                 goto err;
2138
2139         mmc_release_host(host);
2140         err = mmc_add_card(host->card);
2141         if (err)
2142                 goto remove_card;
2143
2144         mmc_claim_host(host);
2145         return 0;
2146
2147 remove_card:
2148         mmc_remove_card(host->card);
2149         mmc_claim_host(host);
2150         host->card = NULL;
2151 err:
2152         mmc_detach_bus(host);
2153
2154         pr_err("%s: error %d whilst initialising MMC card\n",
2155                 mmc_hostname(host), err);
2156
2157         return err;
2158 }