]> git.karo-electronics.de Git - linux-beck.git/blob - drivers/mmc/core/mmc.c
mmc: core: general purpose MMC partition support.
[linux-beck.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/slab.h>
15
16 #include <linux/mmc/host.h>
17 #include <linux/mmc/card.h>
18 #include <linux/mmc/mmc.h>
19
20 #include "core.h"
21 #include "bus.h"
22 #include "mmc_ops.h"
23 #include "sd_ops.h"
24
25 static const unsigned int tran_exp[] = {
26         10000,          100000,         1000000,        10000000,
27         0,              0,              0,              0
28 };
29
30 static const unsigned char tran_mant[] = {
31         0,      10,     12,     13,     15,     20,     25,     30,
32         35,     40,     45,     50,     55,     60,     70,     80,
33 };
34
35 static const unsigned int tacc_exp[] = {
36         1,      10,     100,    1000,   10000,  100000, 1000000, 10000000,
37 };
38
39 static const unsigned int tacc_mant[] = {
40         0,      10,     12,     13,     15,     20,     25,     30,
41         35,     40,     45,     50,     55,     60,     70,     80,
42 };
43
44 #define UNSTUFF_BITS(resp,start,size)                                   \
45         ({                                                              \
46                 const int __size = size;                                \
47                 const u32 __mask = (__size < 32 ? 1 << __size : 0) - 1; \
48                 const int __off = 3 - ((start) / 32);                   \
49                 const int __shft = (start) & 31;                        \
50                 u32 __res;                                              \
51                                                                         \
52                 __res = resp[__off] >> __shft;                          \
53                 if (__size + __shft > 32)                               \
54                         __res |= resp[__off-1] << ((32 - __shft) % 32); \
55                 __res & __mask;                                         \
56         })
57
58 /*
59  * Given the decoded CSD structure, decode the raw CID to our CID structure.
60  */
61 static int mmc_decode_cid(struct mmc_card *card)
62 {
63         u32 *resp = card->raw_cid;
64
65         /*
66          * The selection of the format here is based upon published
67          * specs from sandisk and from what people have reported.
68          */
69         switch (card->csd.mmca_vsn) {
70         case 0: /* MMC v1.0 - v1.2 */
71         case 1: /* MMC v1.4 */
72                 card->cid.manfid        = UNSTUFF_BITS(resp, 104, 24);
73                 card->cid.prod_name[0]  = UNSTUFF_BITS(resp, 96, 8);
74                 card->cid.prod_name[1]  = UNSTUFF_BITS(resp, 88, 8);
75                 card->cid.prod_name[2]  = UNSTUFF_BITS(resp, 80, 8);
76                 card->cid.prod_name[3]  = UNSTUFF_BITS(resp, 72, 8);
77                 card->cid.prod_name[4]  = UNSTUFF_BITS(resp, 64, 8);
78                 card->cid.prod_name[5]  = UNSTUFF_BITS(resp, 56, 8);
79                 card->cid.prod_name[6]  = UNSTUFF_BITS(resp, 48, 8);
80                 card->cid.hwrev         = UNSTUFF_BITS(resp, 44, 4);
81                 card->cid.fwrev         = UNSTUFF_BITS(resp, 40, 4);
82                 card->cid.serial        = UNSTUFF_BITS(resp, 16, 24);
83                 card->cid.month         = UNSTUFF_BITS(resp, 12, 4);
84                 card->cid.year          = UNSTUFF_BITS(resp, 8, 4) + 1997;
85                 break;
86
87         case 2: /* MMC v2.0 - v2.2 */
88         case 3: /* MMC v3.1 - v3.3 */
89         case 4: /* MMC v4 */
90                 card->cid.manfid        = UNSTUFF_BITS(resp, 120, 8);
91                 card->cid.oemid         = UNSTUFF_BITS(resp, 104, 16);
92                 card->cid.prod_name[0]  = UNSTUFF_BITS(resp, 96, 8);
93                 card->cid.prod_name[1]  = UNSTUFF_BITS(resp, 88, 8);
94                 card->cid.prod_name[2]  = UNSTUFF_BITS(resp, 80, 8);
95                 card->cid.prod_name[3]  = UNSTUFF_BITS(resp, 72, 8);
96                 card->cid.prod_name[4]  = UNSTUFF_BITS(resp, 64, 8);
97                 card->cid.prod_name[5]  = UNSTUFF_BITS(resp, 56, 8);
98                 card->cid.serial        = UNSTUFF_BITS(resp, 16, 32);
99                 card->cid.month         = UNSTUFF_BITS(resp, 12, 4);
100                 card->cid.year          = UNSTUFF_BITS(resp, 8, 4) + 1997;
101                 break;
102
103         default:
104                 printk(KERN_ERR "%s: card has unknown MMCA version %d\n",
105                         mmc_hostname(card->host), card->csd.mmca_vsn);
106                 return -EINVAL;
107         }
108
109         return 0;
110 }
111
112 static void mmc_set_erase_size(struct mmc_card *card)
113 {
114         if (card->ext_csd.erase_group_def & 1)
115                 card->erase_size = card->ext_csd.hc_erase_size;
116         else
117                 card->erase_size = card->csd.erase_size;
118
119         mmc_init_erase(card);
120 }
121
122 /*
123  * Given a 128-bit response, decode to our card CSD structure.
124  */
125 static int mmc_decode_csd(struct mmc_card *card)
126 {
127         struct mmc_csd *csd = &card->csd;
128         unsigned int e, m, a, b;
129         u32 *resp = card->raw_csd;
130
131         /*
132          * We only understand CSD structure v1.1 and v1.2.
133          * v1.2 has extra information in bits 15, 11 and 10.
134          * We also support eMMC v4.4 & v4.41.
135          */
136         csd->structure = UNSTUFF_BITS(resp, 126, 2);
137         if (csd->structure == 0) {
138                 printk(KERN_ERR "%s: unrecognised CSD structure version %d\n",
139                         mmc_hostname(card->host), csd->structure);
140                 return -EINVAL;
141         }
142
143         csd->mmca_vsn    = UNSTUFF_BITS(resp, 122, 4);
144         m = UNSTUFF_BITS(resp, 115, 4);
145         e = UNSTUFF_BITS(resp, 112, 3);
146         csd->tacc_ns     = (tacc_exp[e] * tacc_mant[m] + 9) / 10;
147         csd->tacc_clks   = UNSTUFF_BITS(resp, 104, 8) * 100;
148
149         m = UNSTUFF_BITS(resp, 99, 4);
150         e = UNSTUFF_BITS(resp, 96, 3);
151         csd->max_dtr      = tran_exp[e] * tran_mant[m];
152         csd->cmdclass     = UNSTUFF_BITS(resp, 84, 12);
153
154         e = UNSTUFF_BITS(resp, 47, 3);
155         m = UNSTUFF_BITS(resp, 62, 12);
156         csd->capacity     = (1 + m) << (e + 2);
157
158         csd->read_blkbits = UNSTUFF_BITS(resp, 80, 4);
159         csd->read_partial = UNSTUFF_BITS(resp, 79, 1);
160         csd->write_misalign = UNSTUFF_BITS(resp, 78, 1);
161         csd->read_misalign = UNSTUFF_BITS(resp, 77, 1);
162         csd->r2w_factor = UNSTUFF_BITS(resp, 26, 3);
163         csd->write_blkbits = UNSTUFF_BITS(resp, 22, 4);
164         csd->write_partial = UNSTUFF_BITS(resp, 21, 1);
165
166         if (csd->write_blkbits >= 9) {
167                 a = UNSTUFF_BITS(resp, 42, 5);
168                 b = UNSTUFF_BITS(resp, 37, 5);
169                 csd->erase_size = (a + 1) * (b + 1);
170                 csd->erase_size <<= csd->write_blkbits - 9;
171         }
172
173         return 0;
174 }
175
176 /*
177  * Read extended CSD.
178  */
179 static int mmc_get_ext_csd(struct mmc_card *card, u8 **new_ext_csd)
180 {
181         int err;
182         u8 *ext_csd;
183
184         BUG_ON(!card);
185         BUG_ON(!new_ext_csd);
186
187         *new_ext_csd = NULL;
188
189         if (card->csd.mmca_vsn < CSD_SPEC_VER_4)
190                 return 0;
191
192         /*
193          * As the ext_csd is so large and mostly unused, we don't store the
194          * raw block in mmc_card.
195          */
196         ext_csd = kmalloc(512, GFP_KERNEL);
197         if (!ext_csd) {
198                 printk(KERN_ERR "%s: could not allocate a buffer to "
199                         "receive the ext_csd.\n", mmc_hostname(card->host));
200                 return -ENOMEM;
201         }
202
203         err = mmc_send_ext_csd(card, ext_csd);
204         if (err) {
205                 kfree(ext_csd);
206                 *new_ext_csd = NULL;
207
208                 /* If the host or the card can't do the switch,
209                  * fail more gracefully. */
210                 if ((err != -EINVAL)
211                  && (err != -ENOSYS)
212                  && (err != -EFAULT))
213                         return err;
214
215                 /*
216                  * High capacity cards should have this "magic" size
217                  * stored in their CSD.
218                  */
219                 if (card->csd.capacity == (4096 * 512)) {
220                         printk(KERN_ERR "%s: unable to read EXT_CSD "
221                                 "on a possible high capacity card. "
222                                 "Card will be ignored.\n",
223                                 mmc_hostname(card->host));
224                 } else {
225                         printk(KERN_WARNING "%s: unable to read "
226                                 "EXT_CSD, performance might "
227                                 "suffer.\n",
228                                 mmc_hostname(card->host));
229                         err = 0;
230                 }
231         } else
232                 *new_ext_csd = ext_csd;
233
234         return err;
235 }
236
237 /*
238  * Decode extended CSD.
239  */
240 static int mmc_read_ext_csd(struct mmc_card *card, u8 *ext_csd)
241 {
242         int err = 0, idx;
243         unsigned int part_size;
244         u8 hc_erase_grp_sz = 0, hc_wp_grp_sz = 0;
245
246         BUG_ON(!card);
247
248         if (!ext_csd)
249                 return 0;
250
251         /* Version is coded in the CSD_STRUCTURE byte in the EXT_CSD register */
252         card->ext_csd.raw_ext_csd_structure = ext_csd[EXT_CSD_STRUCTURE];
253         if (card->csd.structure == 3) {
254                 if (card->ext_csd.raw_ext_csd_structure > 2) {
255                         printk(KERN_ERR "%s: unrecognised EXT_CSD structure "
256                                 "version %d\n", mmc_hostname(card->host),
257                                         card->ext_csd.raw_ext_csd_structure);
258                         err = -EINVAL;
259                         goto out;
260                 }
261         }
262
263         card->ext_csd.rev = ext_csd[EXT_CSD_REV];
264         if (card->ext_csd.rev > 6) {
265                 printk(KERN_ERR "%s: unrecognised EXT_CSD revision %d\n",
266                         mmc_hostname(card->host), card->ext_csd.rev);
267                 err = -EINVAL;
268                 goto out;
269         }
270
271         card->ext_csd.raw_sectors[0] = ext_csd[EXT_CSD_SEC_CNT + 0];
272         card->ext_csd.raw_sectors[1] = ext_csd[EXT_CSD_SEC_CNT + 1];
273         card->ext_csd.raw_sectors[2] = ext_csd[EXT_CSD_SEC_CNT + 2];
274         card->ext_csd.raw_sectors[3] = ext_csd[EXT_CSD_SEC_CNT + 3];
275         if (card->ext_csd.rev >= 2) {
276                 card->ext_csd.sectors =
277                         ext_csd[EXT_CSD_SEC_CNT + 0] << 0 |
278                         ext_csd[EXT_CSD_SEC_CNT + 1] << 8 |
279                         ext_csd[EXT_CSD_SEC_CNT + 2] << 16 |
280                         ext_csd[EXT_CSD_SEC_CNT + 3] << 24;
281
282                 /* Cards with density > 2GiB are sector addressed */
283                 if (card->ext_csd.sectors > (2u * 1024 * 1024 * 1024) / 512)
284                         mmc_card_set_blockaddr(card);
285         }
286         card->ext_csd.raw_card_type = ext_csd[EXT_CSD_CARD_TYPE];
287         switch (ext_csd[EXT_CSD_CARD_TYPE] & EXT_CSD_CARD_TYPE_MASK) {
288         case EXT_CSD_CARD_TYPE_DDR_52 | EXT_CSD_CARD_TYPE_52 |
289              EXT_CSD_CARD_TYPE_26:
290                 card->ext_csd.hs_max_dtr = 52000000;
291                 card->ext_csd.card_type = EXT_CSD_CARD_TYPE_DDR_52;
292                 break;
293         case EXT_CSD_CARD_TYPE_DDR_1_2V | EXT_CSD_CARD_TYPE_52 |
294              EXT_CSD_CARD_TYPE_26:
295                 card->ext_csd.hs_max_dtr = 52000000;
296                 card->ext_csd.card_type = EXT_CSD_CARD_TYPE_DDR_1_2V;
297                 break;
298         case EXT_CSD_CARD_TYPE_DDR_1_8V | EXT_CSD_CARD_TYPE_52 |
299              EXT_CSD_CARD_TYPE_26:
300                 card->ext_csd.hs_max_dtr = 52000000;
301                 card->ext_csd.card_type = EXT_CSD_CARD_TYPE_DDR_1_8V;
302                 break;
303         case EXT_CSD_CARD_TYPE_52 | EXT_CSD_CARD_TYPE_26:
304                 card->ext_csd.hs_max_dtr = 52000000;
305                 break;
306         case EXT_CSD_CARD_TYPE_26:
307                 card->ext_csd.hs_max_dtr = 26000000;
308                 break;
309         default:
310                 /* MMC v4 spec says this cannot happen */
311                 printk(KERN_WARNING "%s: card is mmc v4 but doesn't "
312                         "support any high-speed modes.\n",
313                         mmc_hostname(card->host));
314         }
315
316         card->ext_csd.raw_s_a_timeout = ext_csd[EXT_CSD_S_A_TIMEOUT];
317         card->ext_csd.raw_erase_timeout_mult =
318                 ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT];
319         card->ext_csd.raw_hc_erase_grp_size =
320                 ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
321         if (card->ext_csd.rev >= 3) {
322                 u8 sa_shift = ext_csd[EXT_CSD_S_A_TIMEOUT];
323                 card->ext_csd.part_config = ext_csd[EXT_CSD_PART_CONFIG];
324
325                 /* EXT_CSD value is in units of 10ms, but we store in ms */
326                 card->ext_csd.part_time = 10 * ext_csd[EXT_CSD_PART_SWITCH_TIME];
327
328                 /* Sleep / awake timeout in 100ns units */
329                 if (sa_shift > 0 && sa_shift <= 0x17)
330                         card->ext_csd.sa_timeout =
331                                         1 << ext_csd[EXT_CSD_S_A_TIMEOUT];
332                 card->ext_csd.erase_group_def =
333                         ext_csd[EXT_CSD_ERASE_GROUP_DEF];
334                 card->ext_csd.hc_erase_timeout = 300 *
335                         ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT];
336                 card->ext_csd.hc_erase_size =
337                         ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE] << 10;
338
339                 card->ext_csd.rel_sectors = ext_csd[EXT_CSD_REL_WR_SEC_C];
340
341                 /*
342                  * There are two boot regions of equal size, defined in
343                  * multiples of 128K.
344                  */
345                 if (ext_csd[EXT_CSD_BOOT_MULT] && mmc_boot_partition_access(card->host)) {
346                         for (idx = 0; idx < MMC_NUM_BOOT_PARTITION; idx++) {
347                                 part_size = ext_csd[EXT_CSD_BOOT_MULT] << 17;
348                                 mmc_part_add(card, part_size,
349                                         EXT_CSD_PART_CONFIG_ACC_BOOT0 + idx,
350                                         "boot%d", idx, true);
351                         }
352                 }
353         }
354
355         card->ext_csd.raw_hc_erase_gap_size =
356                 ext_csd[EXT_CSD_PARTITION_ATTRIBUTE];
357         card->ext_csd.raw_sec_trim_mult =
358                 ext_csd[EXT_CSD_SEC_TRIM_MULT];
359         card->ext_csd.raw_sec_erase_mult =
360                 ext_csd[EXT_CSD_SEC_ERASE_MULT];
361         card->ext_csd.raw_sec_feature_support =
362                 ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT];
363         card->ext_csd.raw_trim_mult =
364                 ext_csd[EXT_CSD_TRIM_MULT];
365         if (card->ext_csd.rev >= 4) {
366                 /*
367                  * Enhanced area feature support -- check whether the eMMC
368                  * card has the Enhanced area enabled.  If so, export enhanced
369                  * area offset and size to user by adding sysfs interface.
370                  */
371                 card->ext_csd.raw_partition_support = ext_csd[EXT_CSD_PARTITION_SUPPORT];
372                 if ((ext_csd[EXT_CSD_PARTITION_SUPPORT] & 0x2) &&
373                     (ext_csd[EXT_CSD_PARTITION_ATTRIBUTE] & 0x1)) {
374                         hc_erase_grp_sz =
375                                 ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
376                         hc_wp_grp_sz =
377                                 ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
378
379                         card->ext_csd.enhanced_area_en = 1;
380                         /*
381                          * calculate the enhanced data area offset, in bytes
382                          */
383                         card->ext_csd.enhanced_area_offset =
384                                 (ext_csd[139] << 24) + (ext_csd[138] << 16) +
385                                 (ext_csd[137] << 8) + ext_csd[136];
386                         if (mmc_card_blockaddr(card))
387                                 card->ext_csd.enhanced_area_offset <<= 9;
388                         /*
389                          * calculate the enhanced data area size, in kilobytes
390                          */
391                         card->ext_csd.enhanced_area_size =
392                                 (ext_csd[142] << 16) + (ext_csd[141] << 8) +
393                                 ext_csd[140];
394                         card->ext_csd.enhanced_area_size *=
395                                 (size_t)(hc_erase_grp_sz * hc_wp_grp_sz);
396                         card->ext_csd.enhanced_area_size <<= 9;
397                 } else {
398                         /*
399                          * If the enhanced area is not enabled, disable these
400                          * device attributes.
401                          */
402                         card->ext_csd.enhanced_area_offset = -EINVAL;
403                         card->ext_csd.enhanced_area_size = -EINVAL;
404                 }
405
406                 /*
407                  * General purpose partition feature support --
408                  * If ext_csd has the size of general purpose partitions,
409                  * set size, part_cfg, partition name in mmc_part.
410                  */
411                 if (ext_csd[EXT_CSD_PARTITION_SUPPORT] &
412                         EXT_CSD_PART_SUPPORT_PART_EN) {
413                         if (card->ext_csd.enhanced_area_en != 1) {
414                                 hc_erase_grp_sz =
415                                         ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
416                                 hc_wp_grp_sz =
417                                         ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
418
419                                 card->ext_csd.enhanced_area_en = 1;
420                         }
421
422                         for (idx = 0; idx < MMC_NUM_GP_PARTITION; idx++) {
423                                 if (!ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3] &&
424                                 !ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 1] &&
425                                 !ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 2])
426                                         continue;
427                                 part_size =
428                                 (ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 2]
429                                         << 16) +
430                                 (ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 1]
431                                         << 8) +
432                                 ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3];
433                                 part_size *= (size_t)(hc_erase_grp_sz *
434                                         hc_wp_grp_sz);
435                                 mmc_part_add(card, part_size << 19,
436                                         EXT_CSD_PART_CONFIG_ACC_GP0 + idx,
437                                         "gp%d", idx, false);
438                         }
439                 }
440                 card->ext_csd.sec_trim_mult =
441                         ext_csd[EXT_CSD_SEC_TRIM_MULT];
442                 card->ext_csd.sec_erase_mult =
443                         ext_csd[EXT_CSD_SEC_ERASE_MULT];
444                 card->ext_csd.sec_feature_support =
445                         ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT];
446                 card->ext_csd.trim_timeout = 300 *
447                         ext_csd[EXT_CSD_TRIM_MULT];
448         }
449
450         if (card->ext_csd.rev >= 5) {
451                 card->ext_csd.rel_param = ext_csd[EXT_CSD_WR_REL_PARAM];
452                 card->ext_csd.rst_n_function = ext_csd[EXT_CSD_RST_N_FUNCTION];
453         }
454
455         card->ext_csd.raw_erased_mem_count = ext_csd[EXT_CSD_ERASED_MEM_CONT];
456         if (ext_csd[EXT_CSD_ERASED_MEM_CONT])
457                 card->erased_byte = 0xFF;
458         else
459                 card->erased_byte = 0x0;
460
461 out:
462         return err;
463 }
464
465 static inline void mmc_free_ext_csd(u8 *ext_csd)
466 {
467         kfree(ext_csd);
468 }
469
470
471 static int mmc_compare_ext_csds(struct mmc_card *card, unsigned bus_width)
472 {
473         u8 *bw_ext_csd;
474         int err;
475
476         if (bus_width == MMC_BUS_WIDTH_1)
477                 return 0;
478
479         err = mmc_get_ext_csd(card, &bw_ext_csd);
480
481         if (err || bw_ext_csd == NULL) {
482                 if (bus_width != MMC_BUS_WIDTH_1)
483                         err = -EINVAL;
484                 goto out;
485         }
486
487         if (bus_width == MMC_BUS_WIDTH_1)
488                 goto out;
489
490         /* only compare read only fields */
491         err = (!(card->ext_csd.raw_partition_support ==
492                         bw_ext_csd[EXT_CSD_PARTITION_SUPPORT]) &&
493                 (card->ext_csd.raw_erased_mem_count ==
494                         bw_ext_csd[EXT_CSD_ERASED_MEM_CONT]) &&
495                 (card->ext_csd.rev ==
496                         bw_ext_csd[EXT_CSD_REV]) &&
497                 (card->ext_csd.raw_ext_csd_structure ==
498                         bw_ext_csd[EXT_CSD_STRUCTURE]) &&
499                 (card->ext_csd.raw_card_type ==
500                         bw_ext_csd[EXT_CSD_CARD_TYPE]) &&
501                 (card->ext_csd.raw_s_a_timeout ==
502                         bw_ext_csd[EXT_CSD_S_A_TIMEOUT]) &&
503                 (card->ext_csd.raw_hc_erase_gap_size ==
504                         bw_ext_csd[EXT_CSD_HC_WP_GRP_SIZE]) &&
505                 (card->ext_csd.raw_erase_timeout_mult ==
506                         bw_ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT]) &&
507                 (card->ext_csd.raw_hc_erase_grp_size ==
508                         bw_ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]) &&
509                 (card->ext_csd.raw_sec_trim_mult ==
510                         bw_ext_csd[EXT_CSD_SEC_TRIM_MULT]) &&
511                 (card->ext_csd.raw_sec_erase_mult ==
512                         bw_ext_csd[EXT_CSD_SEC_ERASE_MULT]) &&
513                 (card->ext_csd.raw_sec_feature_support ==
514                         bw_ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT]) &&
515                 (card->ext_csd.raw_trim_mult ==
516                         bw_ext_csd[EXT_CSD_TRIM_MULT]) &&
517                 (card->ext_csd.raw_sectors[0] ==
518                         bw_ext_csd[EXT_CSD_SEC_CNT + 0]) &&
519                 (card->ext_csd.raw_sectors[1] ==
520                         bw_ext_csd[EXT_CSD_SEC_CNT + 1]) &&
521                 (card->ext_csd.raw_sectors[2] ==
522                         bw_ext_csd[EXT_CSD_SEC_CNT + 2]) &&
523                 (card->ext_csd.raw_sectors[3] ==
524                         bw_ext_csd[EXT_CSD_SEC_CNT + 3]));
525         if (err)
526                 err = -EINVAL;
527
528 out:
529         mmc_free_ext_csd(bw_ext_csd);
530         return err;
531 }
532
533 MMC_DEV_ATTR(cid, "%08x%08x%08x%08x\n", card->raw_cid[0], card->raw_cid[1],
534         card->raw_cid[2], card->raw_cid[3]);
535 MMC_DEV_ATTR(csd, "%08x%08x%08x%08x\n", card->raw_csd[0], card->raw_csd[1],
536         card->raw_csd[2], card->raw_csd[3]);
537 MMC_DEV_ATTR(date, "%02d/%04d\n", card->cid.month, card->cid.year);
538 MMC_DEV_ATTR(erase_size, "%u\n", card->erase_size << 9);
539 MMC_DEV_ATTR(preferred_erase_size, "%u\n", card->pref_erase << 9);
540 MMC_DEV_ATTR(fwrev, "0x%x\n", card->cid.fwrev);
541 MMC_DEV_ATTR(hwrev, "0x%x\n", card->cid.hwrev);
542 MMC_DEV_ATTR(manfid, "0x%06x\n", card->cid.manfid);
543 MMC_DEV_ATTR(name, "%s\n", card->cid.prod_name);
544 MMC_DEV_ATTR(oemid, "0x%04x\n", card->cid.oemid);
545 MMC_DEV_ATTR(serial, "0x%08x\n", card->cid.serial);
546 MMC_DEV_ATTR(enhanced_area_offset, "%llu\n",
547                 card->ext_csd.enhanced_area_offset);
548 MMC_DEV_ATTR(enhanced_area_size, "%u\n", card->ext_csd.enhanced_area_size);
549
550 static struct attribute *mmc_std_attrs[] = {
551         &dev_attr_cid.attr,
552         &dev_attr_csd.attr,
553         &dev_attr_date.attr,
554         &dev_attr_erase_size.attr,
555         &dev_attr_preferred_erase_size.attr,
556         &dev_attr_fwrev.attr,
557         &dev_attr_hwrev.attr,
558         &dev_attr_manfid.attr,
559         &dev_attr_name.attr,
560         &dev_attr_oemid.attr,
561         &dev_attr_serial.attr,
562         &dev_attr_enhanced_area_offset.attr,
563         &dev_attr_enhanced_area_size.attr,
564         NULL,
565 };
566
567 static struct attribute_group mmc_std_attr_group = {
568         .attrs = mmc_std_attrs,
569 };
570
571 static const struct attribute_group *mmc_attr_groups[] = {
572         &mmc_std_attr_group,
573         NULL,
574 };
575
576 static struct device_type mmc_type = {
577         .groups = mmc_attr_groups,
578 };
579
580 /*
581  * Select the PowerClass for the current bus width
582  * If power class is defined for 4/8 bit bus in the
583  * extended CSD register, select it by executing the
584  * mmc_switch command.
585  */
586 static int mmc_select_powerclass(struct mmc_card *card,
587                 unsigned int bus_width, u8 *ext_csd)
588 {
589         int err = 0;
590         unsigned int pwrclass_val;
591         unsigned int index = 0;
592         struct mmc_host *host;
593
594         BUG_ON(!card);
595
596         host = card->host;
597         BUG_ON(!host);
598
599         if (ext_csd == NULL)
600                 return 0;
601
602         /* Power class selection is supported for versions >= 4.0 */
603         if (card->csd.mmca_vsn < CSD_SPEC_VER_4)
604                 return 0;
605
606         /* Power class values are defined only for 4/8 bit bus */
607         if (bus_width == EXT_CSD_BUS_WIDTH_1)
608                 return 0;
609
610         switch (1 << host->ios.vdd) {
611         case MMC_VDD_165_195:
612                 if (host->ios.clock <= 26000000)
613                         index = EXT_CSD_PWR_CL_26_195;
614                 else if (host->ios.clock <= 52000000)
615                         index = (bus_width <= EXT_CSD_BUS_WIDTH_8) ?
616                                 EXT_CSD_PWR_CL_52_195 :
617                                 EXT_CSD_PWR_CL_DDR_52_195;
618                 else if (host->ios.clock <= 200000000)
619                         index = EXT_CSD_PWR_CL_200_195;
620                 break;
621         case MMC_VDD_32_33:
622         case MMC_VDD_33_34:
623         case MMC_VDD_34_35:
624         case MMC_VDD_35_36:
625                 if (host->ios.clock <= 26000000)
626                         index = EXT_CSD_PWR_CL_26_360;
627                 else if (host->ios.clock <= 52000000)
628                         index = (bus_width <= EXT_CSD_BUS_WIDTH_8) ?
629                                 EXT_CSD_PWR_CL_52_360 :
630                                 EXT_CSD_PWR_CL_DDR_52_360;
631                 else if (host->ios.clock <= 200000000)
632                         index = EXT_CSD_PWR_CL_200_360;
633                 break;
634         default:
635                 pr_warning("%s: Voltage range not supported "
636                            "for power class.\n", mmc_hostname(host));
637                 return -EINVAL;
638         }
639
640         pwrclass_val = ext_csd[index];
641
642         if (bus_width & (EXT_CSD_BUS_WIDTH_8 | EXT_CSD_DDR_BUS_WIDTH_8))
643                 pwrclass_val = (pwrclass_val & EXT_CSD_PWR_CL_8BIT_MASK) >>
644                                 EXT_CSD_PWR_CL_8BIT_SHIFT;
645         else
646                 pwrclass_val = (pwrclass_val & EXT_CSD_PWR_CL_4BIT_MASK) >>
647                                 EXT_CSD_PWR_CL_4BIT_SHIFT;
648
649         /* If the power class is different from the default value */
650         if (pwrclass_val > 0) {
651                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
652                                  EXT_CSD_POWER_CLASS,
653                                  pwrclass_val,
654                                  0);
655         }
656
657         return err;
658 }
659
660 /*
661  * Handle the detection and initialisation of a card.
662  *
663  * In the case of a resume, "oldcard" will contain the card
664  * we're trying to reinitialise.
665  */
666 static int mmc_init_card(struct mmc_host *host, u32 ocr,
667         struct mmc_card *oldcard)
668 {
669         struct mmc_card *card;
670         int err, ddr = 0;
671         u32 cid[4];
672         unsigned int max_dtr;
673         u32 rocr;
674         u8 *ext_csd = NULL;
675
676         BUG_ON(!host);
677         WARN_ON(!host->claimed);
678
679         /* Set correct bus mode for MMC before attempting init */
680         if (!mmc_host_is_spi(host))
681                 mmc_set_bus_mode(host, MMC_BUSMODE_OPENDRAIN);
682
683         /*
684          * Since we're changing the OCR value, we seem to
685          * need to tell some cards to go back to the idle
686          * state.  We wait 1ms to give cards time to
687          * respond.
688          * mmc_go_idle is needed for eMMC that are asleep
689          */
690         mmc_go_idle(host);
691
692         /* The extra bit indicates that we support high capacity */
693         err = mmc_send_op_cond(host, ocr | (1 << 30), &rocr);
694         if (err)
695                 goto err;
696
697         /*
698          * For SPI, enable CRC as appropriate.
699          */
700         if (mmc_host_is_spi(host)) {
701                 err = mmc_spi_set_crc(host, use_spi_crc);
702                 if (err)
703                         goto err;
704         }
705
706         /*
707          * Fetch CID from card.
708          */
709         if (mmc_host_is_spi(host))
710                 err = mmc_send_cid(host, cid);
711         else
712                 err = mmc_all_send_cid(host, cid);
713         if (err)
714                 goto err;
715
716         if (oldcard) {
717                 if (memcmp(cid, oldcard->raw_cid, sizeof(cid)) != 0) {
718                         err = -ENOENT;
719                         goto err;
720                 }
721
722                 card = oldcard;
723         } else {
724                 /*
725                  * Allocate card structure.
726                  */
727                 card = mmc_alloc_card(host, &mmc_type);
728                 if (IS_ERR(card)) {
729                         err = PTR_ERR(card);
730                         goto err;
731                 }
732
733                 card->type = MMC_TYPE_MMC;
734                 card->rca = 1;
735                 memcpy(card->raw_cid, cid, sizeof(card->raw_cid));
736         }
737
738         /*
739          * For native busses:  set card RCA and quit open drain mode.
740          */
741         if (!mmc_host_is_spi(host)) {
742                 err = mmc_set_relative_addr(card);
743                 if (err)
744                         goto free_card;
745
746                 mmc_set_bus_mode(host, MMC_BUSMODE_PUSHPULL);
747         }
748
749         if (!oldcard) {
750                 /*
751                  * Fetch CSD from card.
752                  */
753                 err = mmc_send_csd(card, card->raw_csd);
754                 if (err)
755                         goto free_card;
756
757                 err = mmc_decode_csd(card);
758                 if (err)
759                         goto free_card;
760                 err = mmc_decode_cid(card);
761                 if (err)
762                         goto free_card;
763         }
764
765         /*
766          * Select card, as all following commands rely on that.
767          */
768         if (!mmc_host_is_spi(host)) {
769                 err = mmc_select_card(card);
770                 if (err)
771                         goto free_card;
772         }
773
774         if (!oldcard) {
775                 /*
776                  * Fetch and process extended CSD.
777                  */
778
779                 err = mmc_get_ext_csd(card, &ext_csd);
780                 if (err)
781                         goto free_card;
782                 err = mmc_read_ext_csd(card, ext_csd);
783                 if (err)
784                         goto free_card;
785
786                 /* If doing byte addressing, check if required to do sector
787                  * addressing.  Handle the case of <2GB cards needing sector
788                  * addressing.  See section 8.1 JEDEC Standard JED84-A441;
789                  * ocr register has bit 30 set for sector addressing.
790                  */
791                 if (!(mmc_card_blockaddr(card)) && (rocr & (1<<30)))
792                         mmc_card_set_blockaddr(card);
793
794                 /* Erase size depends on CSD and Extended CSD */
795                 mmc_set_erase_size(card);
796         }
797
798         /*
799          * If enhanced_area_en is TRUE, host needs to enable ERASE_GRP_DEF
800          * bit.  This bit will be lost every time after a reset or power off.
801          */
802         if (card->ext_csd.enhanced_area_en) {
803                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
804                                  EXT_CSD_ERASE_GROUP_DEF, 1, 0);
805
806                 if (err && err != -EBADMSG)
807                         goto free_card;
808
809                 if (err) {
810                         err = 0;
811                         /*
812                          * Just disable enhanced area off & sz
813                          * will try to enable ERASE_GROUP_DEF
814                          * during next time reinit
815                          */
816                         card->ext_csd.enhanced_area_offset = -EINVAL;
817                         card->ext_csd.enhanced_area_size = -EINVAL;
818                 } else {
819                         card->ext_csd.erase_group_def = 1;
820                         /*
821                          * enable ERASE_GRP_DEF successfully.
822                          * This will affect the erase size, so
823                          * here need to reset erase size
824                          */
825                         mmc_set_erase_size(card);
826                 }
827         }
828
829         /*
830          * Ensure eMMC user default partition is enabled
831          */
832         if (card->ext_csd.part_config & EXT_CSD_PART_CONFIG_ACC_MASK) {
833                 card->ext_csd.part_config &= ~EXT_CSD_PART_CONFIG_ACC_MASK;
834                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_PART_CONFIG,
835                                  card->ext_csd.part_config,
836                                  card->ext_csd.part_time);
837                 if (err && err != -EBADMSG)
838                         goto free_card;
839         }
840
841         /*
842          * Activate high speed (if supported)
843          */
844         if ((card->ext_csd.hs_max_dtr != 0) &&
845                 (host->caps & MMC_CAP_MMC_HIGHSPEED)) {
846                 err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
847                                  EXT_CSD_HS_TIMING, 1, 0);
848                 if (err && err != -EBADMSG)
849                         goto free_card;
850
851                 if (err) {
852                         printk(KERN_WARNING "%s: switch to highspeed failed\n",
853                                mmc_hostname(card->host));
854                         err = 0;
855                 } else {
856                         mmc_card_set_highspeed(card);
857                         mmc_set_timing(card->host, MMC_TIMING_MMC_HS);
858                 }
859         }
860
861         /*
862          * Compute bus speed.
863          */
864         max_dtr = (unsigned int)-1;
865
866         if (mmc_card_highspeed(card)) {
867                 if (max_dtr > card->ext_csd.hs_max_dtr)
868                         max_dtr = card->ext_csd.hs_max_dtr;
869         } else if (max_dtr > card->csd.max_dtr) {
870                 max_dtr = card->csd.max_dtr;
871         }
872
873         mmc_set_clock(host, max_dtr);
874
875         /*
876          * Indicate DDR mode (if supported).
877          */
878         if (mmc_card_highspeed(card)) {
879                 if ((card->ext_csd.card_type & EXT_CSD_CARD_TYPE_DDR_1_8V)
880                         && ((host->caps & (MMC_CAP_1_8V_DDR |
881                              MMC_CAP_UHS_DDR50))
882                                 == (MMC_CAP_1_8V_DDR | MMC_CAP_UHS_DDR50)))
883                                 ddr = MMC_1_8V_DDR_MODE;
884                 else if ((card->ext_csd.card_type & EXT_CSD_CARD_TYPE_DDR_1_2V)
885                         && ((host->caps & (MMC_CAP_1_2V_DDR |
886                              MMC_CAP_UHS_DDR50))
887                                 == (MMC_CAP_1_2V_DDR | MMC_CAP_UHS_DDR50)))
888                                 ddr = MMC_1_2V_DDR_MODE;
889         }
890
891         /*
892          * Activate wide bus and DDR (if supported).
893          */
894         if ((card->csd.mmca_vsn >= CSD_SPEC_VER_4) &&
895             (host->caps & (MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA))) {
896                 static unsigned ext_csd_bits[][2] = {
897                         { EXT_CSD_BUS_WIDTH_8, EXT_CSD_DDR_BUS_WIDTH_8 },
898                         { EXT_CSD_BUS_WIDTH_4, EXT_CSD_DDR_BUS_WIDTH_4 },
899                         { EXT_CSD_BUS_WIDTH_1, EXT_CSD_BUS_WIDTH_1 },
900                 };
901                 static unsigned bus_widths[] = {
902                         MMC_BUS_WIDTH_8,
903                         MMC_BUS_WIDTH_4,
904                         MMC_BUS_WIDTH_1
905                 };
906                 unsigned idx, bus_width = 0;
907
908                 if (host->caps & MMC_CAP_8_BIT_DATA)
909                         idx = 0;
910                 else
911                         idx = 1;
912                 for (; idx < ARRAY_SIZE(bus_widths); idx++) {
913                         bus_width = bus_widths[idx];
914                         if (bus_width == MMC_BUS_WIDTH_1)
915                                 ddr = 0; /* no DDR for 1-bit width */
916                         err = mmc_select_powerclass(card, ext_csd_bits[idx][0],
917                                                     ext_csd);
918                         if (err)
919                                 pr_err("%s: power class selection to "
920                                        "bus width %d failed\n",
921                                        mmc_hostname(card->host),
922                                        1 << bus_width);
923
924                         err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
925                                          EXT_CSD_BUS_WIDTH,
926                                          ext_csd_bits[idx][0],
927                                          0);
928                         if (!err) {
929                                 mmc_set_bus_width(card->host, bus_width);
930
931                                 /*
932                                  * If controller can't handle bus width test,
933                                  * compare ext_csd previously read in 1 bit mode
934                                  * against ext_csd at new bus width
935                                  */
936                                 if (!(host->caps & MMC_CAP_BUS_WIDTH_TEST))
937                                         err = mmc_compare_ext_csds(card,
938                                                 bus_width);
939                                 else
940                                         err = mmc_bus_test(card, bus_width);
941                                 if (!err)
942                                         break;
943                         }
944                 }
945
946                 if (!err && ddr) {
947                         err = mmc_select_powerclass(card, ext_csd_bits[idx][1],
948                                                     ext_csd);
949                         if (err)
950                                 pr_err("%s: power class selection to "
951                                        "bus width %d ddr %d failed\n",
952                                        mmc_hostname(card->host),
953                                        1 << bus_width, ddr);
954
955                         err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
956                                          EXT_CSD_BUS_WIDTH,
957                                          ext_csd_bits[idx][1],
958                                          0);
959                 }
960                 if (err) {
961                         printk(KERN_WARNING "%s: switch to bus width %d ddr %d "
962                                 "failed\n", mmc_hostname(card->host),
963                                 1 << bus_width, ddr);
964                         goto free_card;
965                 } else if (ddr) {
966                         /*
967                          * eMMC cards can support 3.3V to 1.2V i/o (vccq)
968                          * signaling.
969                          *
970                          * EXT_CSD_CARD_TYPE_DDR_1_8V means 3.3V or 1.8V vccq.
971                          *
972                          * 1.8V vccq at 3.3V core voltage (vcc) is not required
973                          * in the JEDEC spec for DDR.
974                          *
975                          * Do not force change in vccq since we are obviously
976                          * working and no change to vccq is needed.
977                          *
978                          * WARNING: eMMC rules are NOT the same as SD DDR
979                          */
980                         if (ddr == EXT_CSD_CARD_TYPE_DDR_1_2V) {
981                                 err = mmc_set_signal_voltage(host,
982                                         MMC_SIGNAL_VOLTAGE_120, 0);
983                                 if (err)
984                                         goto err;
985                         }
986                         mmc_card_set_ddr_mode(card);
987                         mmc_set_timing(card->host, MMC_TIMING_UHS_DDR50);
988                         mmc_set_bus_width(card->host, bus_width);
989                 }
990         }
991
992         if (!oldcard)
993                 host->card = card;
994
995         mmc_free_ext_csd(ext_csd);
996         return 0;
997
998 free_card:
999         if (!oldcard)
1000                 mmc_remove_card(card);
1001 err:
1002         mmc_free_ext_csd(ext_csd);
1003
1004         return err;
1005 }
1006
1007 /*
1008  * Host is being removed. Free up the current card.
1009  */
1010 static void mmc_remove(struct mmc_host *host)
1011 {
1012         BUG_ON(!host);
1013         BUG_ON(!host->card);
1014
1015         mmc_remove_card(host->card);
1016         host->card = NULL;
1017 }
1018
1019 /*
1020  * Card detection callback from host.
1021  */
1022 static void mmc_detect(struct mmc_host *host)
1023 {
1024         int err;
1025
1026         BUG_ON(!host);
1027         BUG_ON(!host->card);
1028
1029         mmc_claim_host(host);
1030
1031         /*
1032          * Just check if our card has been removed.
1033          */
1034         err = mmc_send_status(host->card, NULL);
1035
1036         mmc_release_host(host);
1037
1038         if (err) {
1039                 mmc_remove(host);
1040
1041                 mmc_claim_host(host);
1042                 mmc_detach_bus(host);
1043                 mmc_power_off(host);
1044                 mmc_release_host(host);
1045         }
1046 }
1047
1048 /*
1049  * Suspend callback from host.
1050  */
1051 static int mmc_suspend(struct mmc_host *host)
1052 {
1053         int err = 0;
1054
1055         BUG_ON(!host);
1056         BUG_ON(!host->card);
1057
1058         mmc_claim_host(host);
1059         if (mmc_card_can_sleep(host))
1060                 err = mmc_card_sleep(host);
1061         else if (!mmc_host_is_spi(host))
1062                 mmc_deselect_cards(host);
1063         host->card->state &= ~MMC_STATE_HIGHSPEED;
1064         mmc_release_host(host);
1065
1066         return err;
1067 }
1068
1069 /*
1070  * Resume callback from host.
1071  *
1072  * This function tries to determine if the same card is still present
1073  * and, if so, restore all state to it.
1074  */
1075 static int mmc_resume(struct mmc_host *host)
1076 {
1077         int err;
1078
1079         BUG_ON(!host);
1080         BUG_ON(!host->card);
1081
1082         mmc_claim_host(host);
1083         err = mmc_init_card(host, host->ocr, host->card);
1084         mmc_release_host(host);
1085
1086         return err;
1087 }
1088
1089 static int mmc_power_restore(struct mmc_host *host)
1090 {
1091         int ret;
1092
1093         host->card->state &= ~MMC_STATE_HIGHSPEED;
1094         mmc_claim_host(host);
1095         ret = mmc_init_card(host, host->ocr, host->card);
1096         mmc_release_host(host);
1097
1098         return ret;
1099 }
1100
1101 static int mmc_sleep(struct mmc_host *host)
1102 {
1103         struct mmc_card *card = host->card;
1104         int err = -ENOSYS;
1105
1106         if (card && card->ext_csd.rev >= 3) {
1107                 err = mmc_card_sleepawake(host, 1);
1108                 if (err < 0)
1109                         pr_debug("%s: Error %d while putting card into sleep",
1110                                  mmc_hostname(host), err);
1111         }
1112
1113         return err;
1114 }
1115
1116 static int mmc_awake(struct mmc_host *host)
1117 {
1118         struct mmc_card *card = host->card;
1119         int err = -ENOSYS;
1120
1121         if (card && card->ext_csd.rev >= 3) {
1122                 err = mmc_card_sleepawake(host, 0);
1123                 if (err < 0)
1124                         pr_debug("%s: Error %d while awaking sleeping card",
1125                                  mmc_hostname(host), err);
1126         }
1127
1128         return err;
1129 }
1130
1131 static const struct mmc_bus_ops mmc_ops = {
1132         .awake = mmc_awake,
1133         .sleep = mmc_sleep,
1134         .remove = mmc_remove,
1135         .detect = mmc_detect,
1136         .suspend = NULL,
1137         .resume = NULL,
1138         .power_restore = mmc_power_restore,
1139 };
1140
1141 static const struct mmc_bus_ops mmc_ops_unsafe = {
1142         .awake = mmc_awake,
1143         .sleep = mmc_sleep,
1144         .remove = mmc_remove,
1145         .detect = mmc_detect,
1146         .suspend = mmc_suspend,
1147         .resume = mmc_resume,
1148         .power_restore = mmc_power_restore,
1149 };
1150
1151 static void mmc_attach_bus_ops(struct mmc_host *host)
1152 {
1153         const struct mmc_bus_ops *bus_ops;
1154
1155         if (!mmc_card_is_removable(host))
1156                 bus_ops = &mmc_ops_unsafe;
1157         else
1158                 bus_ops = &mmc_ops;
1159         mmc_attach_bus(host, bus_ops);
1160 }
1161
1162 /*
1163  * Starting point for MMC card init.
1164  */
1165 int mmc_attach_mmc(struct mmc_host *host)
1166 {
1167         int err;
1168         u32 ocr;
1169
1170         BUG_ON(!host);
1171         WARN_ON(!host->claimed);
1172
1173         /* Set correct bus mode for MMC before attempting attach */
1174         if (!mmc_host_is_spi(host))
1175                 mmc_set_bus_mode(host, MMC_BUSMODE_OPENDRAIN);
1176
1177         err = mmc_send_op_cond(host, 0, &ocr);
1178         if (err)
1179                 return err;
1180
1181         mmc_attach_bus_ops(host);
1182         if (host->ocr_avail_mmc)
1183                 host->ocr_avail = host->ocr_avail_mmc;
1184
1185         /*
1186          * We need to get OCR a different way for SPI.
1187          */
1188         if (mmc_host_is_spi(host)) {
1189                 err = mmc_spi_read_ocr(host, 1, &ocr);
1190                 if (err)
1191                         goto err;
1192         }
1193
1194         /*
1195          * Sanity check the voltages that the card claims to
1196          * support.
1197          */
1198         if (ocr & 0x7F) {
1199                 printk(KERN_WARNING "%s: card claims to support voltages "
1200                        "below the defined range. These will be ignored.\n",
1201                        mmc_hostname(host));
1202                 ocr &= ~0x7F;
1203         }
1204
1205         host->ocr = mmc_select_voltage(host, ocr);
1206
1207         /*
1208          * Can we support the voltage of the card?
1209          */
1210         if (!host->ocr) {
1211                 err = -EINVAL;
1212                 goto err;
1213         }
1214
1215         /*
1216          * Detect and init the card.
1217          */
1218         err = mmc_init_card(host, host->ocr, NULL);
1219         if (err)
1220                 goto err;
1221
1222         mmc_release_host(host);
1223         err = mmc_add_card(host->card);
1224         mmc_claim_host(host);
1225         if (err)
1226                 goto remove_card;
1227
1228         return 0;
1229
1230 remove_card:
1231         mmc_release_host(host);
1232         mmc_remove_card(host->card);
1233         mmc_claim_host(host);
1234         host->card = NULL;
1235 err:
1236         mmc_detach_bus(host);
1237
1238         printk(KERN_ERR "%s: error %d whilst initialising MMC card\n",
1239                 mmc_hostname(host), err);
1240
1241         return err;
1242 }