Merge tag 'for_linus' of git://git.kernel.org/pub/scm/linux/kernel/git/mst/vhost
[deliverable/linux.git] / drivers / mmc / core / sd.c
CommitLineData
7ea239d9 1/*
70f10482 2 * linux/drivers/mmc/core/sd.c
7ea239d9
PO
3 *
4 * Copyright (C) 2003-2004 Russell King, All Rights Reserved.
5 * SD support Copyright (C) 2004 Ian Molton, All Rights Reserved.
6 * Copyright (C) 2005-2007 Pierre Ossman, 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>
9288cac0 14#include <linux/sizes.h>
5a0e3ad6 15#include <linux/slab.h>
0205a904 16#include <linux/stat.h>
0cb403a2 17#include <linux/pm_runtime.h>
7ea239d9
PO
18
19#include <linux/mmc/host.h>
20#include <linux/mmc/card.h>
21#include <linux/mmc/mmc.h>
3373c0ae 22#include <linux/mmc/sd.h>
7ea239d9
PO
23
24#include "core.h"
4101c16a 25#include "bus.h"
7ea239d9 26#include "mmc_ops.h"
ce101496 27#include "sd.h"
7ea239d9
PO
28#include "sd_ops.h"
29
7ea239d9
PO
30static const unsigned int tran_exp[] = {
31 10000, 100000, 1000000, 10000000,
32 0, 0, 0, 0
33};
34
35static const unsigned char tran_mant[] = {
36 0, 10, 12, 13, 15, 20, 25, 30,
37 35, 40, 45, 50, 55, 60, 70, 80,
38};
39
40static const unsigned int tacc_exp[] = {
41 1, 10, 100, 1000, 10000, 100000, 1000000, 10000000,
42};
43
44static const unsigned int tacc_mant[] = {
45 0, 10, 12, 13, 15, 20, 25, 30,
46 35, 40, 45, 50, 55, 60, 70, 80,
47};
48
9288cac0
WS
49static const unsigned int sd_au_size[] = {
50 0, SZ_16K / 512, SZ_32K / 512, SZ_64K / 512,
51 SZ_128K / 512, SZ_256K / 512, SZ_512K / 512, SZ_1M / 512,
52 SZ_2M / 512, SZ_4M / 512, SZ_8M / 512, (SZ_8M + SZ_4M) / 512,
53 SZ_16M / 512, (SZ_16M + SZ_8M) / 512, SZ_32M / 512, SZ_64M / 512,
54};
55
7ea239d9
PO
56#define UNSTUFF_BITS(resp,start,size) \
57 ({ \
58 const int __size = size; \
59 const u32 __mask = (__size < 32 ? 1 << __size : 0) - 1; \
60 const int __off = 3 - ((start) / 32); \
61 const int __shft = (start) & 31; \
62 u32 __res; \
63 \
64 __res = resp[__off] >> __shft; \
65 if (__size + __shft > 32) \
66 __res |= resp[__off-1] << ((32 - __shft) % 32); \
67 __res & __mask; \
68 })
69
70/*
71 * Given the decoded CSD structure, decode the raw CID to our CID structure.
72 */
71578a1e 73void mmc_decode_cid(struct mmc_card *card)
7ea239d9
PO
74{
75 u32 *resp = card->raw_cid;
76
7ea239d9
PO
77 /*
78 * SD doesn't currently have a version field so we will
79 * have to assume we can parse this.
80 */
81 card->cid.manfid = UNSTUFF_BITS(resp, 120, 8);
82 card->cid.oemid = UNSTUFF_BITS(resp, 104, 16);
83 card->cid.prod_name[0] = UNSTUFF_BITS(resp, 96, 8);
84 card->cid.prod_name[1] = UNSTUFF_BITS(resp, 88, 8);
85 card->cid.prod_name[2] = UNSTUFF_BITS(resp, 80, 8);
86 card->cid.prod_name[3] = UNSTUFF_BITS(resp, 72, 8);
87 card->cid.prod_name[4] = UNSTUFF_BITS(resp, 64, 8);
88 card->cid.hwrev = UNSTUFF_BITS(resp, 60, 4);
89 card->cid.fwrev = UNSTUFF_BITS(resp, 56, 4);
90 card->cid.serial = UNSTUFF_BITS(resp, 24, 32);
91 card->cid.year = UNSTUFF_BITS(resp, 12, 8);
92 card->cid.month = UNSTUFF_BITS(resp, 8, 4);
93
94 card->cid.year += 2000; /* SD cards year offset */
95}
96
97/*
98 * Given a 128-bit response, decode to our card CSD structure.
99 */
bd766312 100static int mmc_decode_csd(struct mmc_card *card)
7ea239d9
PO
101{
102 struct mmc_csd *csd = &card->csd;
103 unsigned int e, m, csd_struct;
104 u32 *resp = card->raw_csd;
105
106 csd_struct = UNSTUFF_BITS(resp, 126, 2);
107
108 switch (csd_struct) {
109 case 0:
110 m = UNSTUFF_BITS(resp, 115, 4);
111 e = UNSTUFF_BITS(resp, 112, 3);
112 csd->tacc_ns = (tacc_exp[e] * tacc_mant[m] + 9) / 10;
113 csd->tacc_clks = UNSTUFF_BITS(resp, 104, 8) * 100;
114
115 m = UNSTUFF_BITS(resp, 99, 4);
116 e = UNSTUFF_BITS(resp, 96, 3);
117 csd->max_dtr = tran_exp[e] * tran_mant[m];
118 csd->cmdclass = UNSTUFF_BITS(resp, 84, 12);
119
120 e = UNSTUFF_BITS(resp, 47, 3);
121 m = UNSTUFF_BITS(resp, 62, 12);
122 csd->capacity = (1 + m) << (e + 2);
123
124 csd->read_blkbits = UNSTUFF_BITS(resp, 80, 4);
125 csd->read_partial = UNSTUFF_BITS(resp, 79, 1);
126 csd->write_misalign = UNSTUFF_BITS(resp, 78, 1);
127 csd->read_misalign = UNSTUFF_BITS(resp, 77, 1);
3d705d14 128 csd->dsr_imp = UNSTUFF_BITS(resp, 76, 1);
7ea239d9
PO
129 csd->r2w_factor = UNSTUFF_BITS(resp, 26, 3);
130 csd->write_blkbits = UNSTUFF_BITS(resp, 22, 4);
131 csd->write_partial = UNSTUFF_BITS(resp, 21, 1);
dfe86cba
AH
132
133 if (UNSTUFF_BITS(resp, 46, 1)) {
134 csd->erase_size = 1;
135 } else if (csd->write_blkbits >= 9) {
136 csd->erase_size = UNSTUFF_BITS(resp, 39, 7) + 1;
137 csd->erase_size <<= csd->write_blkbits - 9;
138 }
7ea239d9
PO
139 break;
140 case 1:
141 /*
3a303511 142 * This is a block-addressed SDHC or SDXC card. Most
7ea239d9
PO
143 * interesting fields are unused and have fixed
144 * values. To avoid getting tripped by buggy cards,
145 * we assume those fixed values ourselves.
146 */
147 mmc_card_set_blockaddr(card);
148
149 csd->tacc_ns = 0; /* Unused */
150 csd->tacc_clks = 0; /* Unused */
151
152 m = UNSTUFF_BITS(resp, 99, 4);
153 e = UNSTUFF_BITS(resp, 96, 3);
154 csd->max_dtr = tran_exp[e] * tran_mant[m];
155 csd->cmdclass = UNSTUFF_BITS(resp, 84, 12);
3a303511
AN
156 csd->c_size = UNSTUFF_BITS(resp, 48, 22);
157
158 /* SDXC cards have a minimum C_SIZE of 0x00FFFF */
159 if (csd->c_size >= 0xFFFF)
160 mmc_card_set_ext_capacity(card);
7ea239d9
PO
161
162 m = UNSTUFF_BITS(resp, 48, 22);
163 csd->capacity = (1 + m) << 10;
164
165 csd->read_blkbits = 9;
166 csd->read_partial = 0;
167 csd->write_misalign = 0;
168 csd->read_misalign = 0;
169 csd->r2w_factor = 4; /* Unused */
170 csd->write_blkbits = 9;
171 csd->write_partial = 0;
dfe86cba 172 csd->erase_size = 1;
7ea239d9
PO
173 break;
174 default:
a3c76eb9 175 pr_err("%s: unrecognised CSD structure version %d\n",
7ea239d9 176 mmc_hostname(card->host), csd_struct);
bd766312 177 return -EINVAL;
7ea239d9 178 }
bd766312 179
dfe86cba
AH
180 card->erase_size = csd->erase_size;
181
bd766312 182 return 0;
7ea239d9
PO
183}
184
185/*
186 * Given a 64-bit response, decode to our card SCR structure.
187 */
bd766312 188static int mmc_decode_scr(struct mmc_card *card)
7ea239d9
PO
189{
190 struct sd_scr *scr = &card->scr;
191 unsigned int scr_struct;
192 u32 resp[4];
193
7ea239d9
PO
194 resp[3] = card->raw_scr[1];
195 resp[2] = card->raw_scr[0];
196
197 scr_struct = UNSTUFF_BITS(resp, 60, 4);
198 if (scr_struct != 0) {
a3c76eb9 199 pr_err("%s: unrecognised SCR structure version %d\n",
7ea239d9 200 mmc_hostname(card->host), scr_struct);
bd766312 201 return -EINVAL;
7ea239d9
PO
202 }
203
204 scr->sda_vsn = UNSTUFF_BITS(resp, 56, 4);
205 scr->bus_widths = UNSTUFF_BITS(resp, 48, 4);
013909c4
AN
206 if (scr->sda_vsn == SCR_SPEC_VER_2)
207 /* Check if Physical Layer Spec v3.0 is supported */
208 scr->sda_spec3 = UNSTUFF_BITS(resp, 47, 1);
bd766312 209
dfe86cba
AH
210 if (UNSTUFF_BITS(resp, 55, 1))
211 card->erased_byte = 0xFF;
212 else
213 card->erased_byte = 0x0;
214
f0d89972
AW
215 if (scr->sda_spec3)
216 scr->cmds = UNSTUFF_BITS(resp, 32, 2);
bd766312 217 return 0;
7ea239d9
PO
218}
219
dfe86cba
AH
220/*
221 * Fetch and process SD Status register.
222 */
223static int mmc_read_ssr(struct mmc_card *card)
224{
225 unsigned int au, es, et, eo;
9288cac0 226 int err, i;
dfe86cba
AH
227 u32 *ssr;
228
229 if (!(card->csd.cmdclass & CCC_APP_SPEC)) {
6606110d
JP
230 pr_warn("%s: card lacks mandatory SD Status function\n",
231 mmc_hostname(card->host));
dfe86cba
AH
232 return 0;
233 }
234
235 ssr = kmalloc(64, GFP_KERNEL);
236 if (!ssr)
237 return -ENOMEM;
238
239 err = mmc_app_sd_status(card, ssr);
240 if (err) {
6606110d
JP
241 pr_warn("%s: problem reading SD Status register\n",
242 mmc_hostname(card->host));
dfe86cba
AH
243 err = 0;
244 goto out;
245 }
246
247 for (i = 0; i < 16; i++)
248 ssr[i] = be32_to_cpu(ssr[i]);
249
250 /*
251 * UNSTUFF_BITS only works with four u32s so we have to offset the
252 * bitfield positions accordingly.
253 */
254 au = UNSTUFF_BITS(ssr, 428 - 384, 4);
9288cac0
WS
255 if (au) {
256 if (au <= 9 || card->scr.sda_spec3) {
257 card->ssr.au = sd_au_size[au];
258 es = UNSTUFF_BITS(ssr, 408 - 384, 16);
259 et = UNSTUFF_BITS(ssr, 402 - 384, 6);
260 if (es && et) {
261 eo = UNSTUFF_BITS(ssr, 400 - 384, 2);
262 card->ssr.erase_timeout = (et * 1000) / es;
263 card->ssr.erase_offset = eo * 1000;
264 }
265 } else {
6606110d
JP
266 pr_warn("%s: SD Status: Invalid Allocation Unit size\n",
267 mmc_hostname(card->host));
dfe86cba 268 }
dfe86cba
AH
269 }
270out:
271 kfree(ssr);
272 return err;
273}
274
7ea239d9 275/*
1addfcdb 276 * Fetches and decodes switch information
7ea239d9 277 */
1addfcdb 278static int mmc_read_switch(struct mmc_card *card)
7ea239d9
PO
279{
280 int err;
281 u8 *status;
282
3373c0ae 283 if (card->scr.sda_vsn < SCR_SPEC_VER_1)
17b0429d 284 return 0;
3373c0ae
PO
285
286 if (!(card->csd.cmdclass & CCC_SWITCH)) {
6606110d 287 pr_warn("%s: card lacks mandatory switch function, performance might suffer\n",
3373c0ae 288 mmc_hostname(card->host));
17b0429d 289 return 0;
3373c0ae
PO
290 }
291
17b0429d 292 err = -EIO;
7ea239d9
PO
293
294 status = kmalloc(64, GFP_KERNEL);
295 if (!status) {
a3c76eb9 296 pr_err("%s: could not allocate a buffer for "
013909c4
AN
297 "switch capabilities.\n",
298 mmc_hostname(card->host));
17b0429d 299 return -ENOMEM;
7ea239d9
PO
300 }
301
a39ca6ae
AL
302 /*
303 * Find out the card's support bits with a mode 0 operation.
304 * The argument does not matter, as the support bits do not
305 * change with the arguments.
306 */
307 err = mmc_sd_switch(card, 0, 0, 0, status);
17b0429d 308 if (err) {
013909c4
AN
309 /*
310 * If the host or the card can't do the switch,
311 * fail more gracefully.
312 */
313 if (err != -EINVAL && err != -ENOSYS && err != -EFAULT)
adf66a0d
PO
314 goto out;
315
6606110d 316 pr_warn("%s: problem reading Bus Speed modes\n",
3373c0ae 317 mmc_hostname(card->host));
17b0429d 318 err = 0;
adf66a0d 319
7ea239d9
PO
320 goto out;
321 }
322
fffe5d5a
QL
323 if (status[13] & SD_MODE_HIGH_SPEED)
324 card->sw_caps.hs_max_dtr = HIGH_SPEED_MAX_DTR;
f2815f68 325
013909c4
AN
326 if (card->scr.sda_spec3) {
327 card->sw_caps.sd3_bus_mode = status[13];
a39ca6ae 328 /* Driver Strengths supported by the card */
013909c4 329 card->sw_caps.sd3_drv_type = status[9];
d9812780 330 card->sw_caps.sd3_curr_limit = status[7] | status[6] << 8;
013909c4 331 }
7ea239d9 332
1addfcdb
PO
333out:
334 kfree(status);
335
336 return err;
337}
338
339/*
340 * Test if the card supports high-speed mode and, if so, switch to it.
341 */
71578a1e 342int mmc_sd_switch_hs(struct mmc_card *card)
1addfcdb
PO
343{
344 int err;
345 u8 *status;
346
3373c0ae 347 if (card->scr.sda_vsn < SCR_SPEC_VER_1)
17b0429d 348 return 0;
3373c0ae
PO
349
350 if (!(card->csd.cmdclass & CCC_SWITCH))
17b0429d 351 return 0;
3373c0ae 352
1addfcdb 353 if (!(card->host->caps & MMC_CAP_SD_HIGHSPEED))
17b0429d 354 return 0;
1addfcdb
PO
355
356 if (card->sw_caps.hs_max_dtr == 0)
17b0429d 357 return 0;
1addfcdb 358
1addfcdb
PO
359 status = kmalloc(64, GFP_KERNEL);
360 if (!status) {
a3c76eb9 361 pr_err("%s: could not allocate a buffer for "
facba917 362 "switch capabilities.\n", mmc_hostname(card->host));
17b0429d 363 return -ENOMEM;
1addfcdb
PO
364 }
365
7ea239d9 366 err = mmc_sd_switch(card, 1, 0, 1, status);
17b0429d 367 if (err)
7ea239d9
PO
368 goto out;
369
370 if ((status[16] & 0xF) != 1) {
6606110d 371 pr_warn("%s: Problem switching card into high-speed mode!\n",
7ea239d9 372 mmc_hostname(card->host));
71578a1e 373 err = 0;
7ea239d9 374 } else {
71578a1e 375 err = 1;
7ea239d9
PO
376 }
377
378out:
379 kfree(status);
380
381 return err;
382}
383
d6d50a15
AN
384static int sd_select_driver_type(struct mmc_card *card, u8 *status)
385{
fa021cef 386 int card_drv_type, drive_strength, drv_type;
d6d50a15
AN
387 int err;
388
3853a042
AH
389 card->drive_strength = 0;
390
fa021cef 391 card_drv_type = card->sw_caps.sd3_drv_type | SD_DRIVER_TYPE_B;
ca8e99b3 392
e23350b3
AH
393 drive_strength = mmc_select_drive_strength(card,
394 card->sw_caps.uhs_max_dtr,
395 card_drv_type, &drv_type);
d6d50a15 396
b4f30a17
AH
397 if (drive_strength) {
398 err = mmc_sd_switch(card, 1, 2, drive_strength, status);
399 if (err)
400 return err;
401 if ((status[15] & 0xF) != drive_strength) {
402 pr_warn("%s: Problem setting drive strength!\n",
403 mmc_hostname(card->host));
404 return 0;
405 }
3853a042 406 card->drive_strength = drive_strength;
d6d50a15
AN
407 }
408
b4f30a17
AH
409 if (drv_type)
410 mmc_set_driver_type(card->host, drv_type);
d6d50a15
AN
411
412 return 0;
413}
414
93c712f9 415static void sd_update_bus_speed_mode(struct mmc_card *card)
49c468fc 416{
49c468fc
AN
417 /*
418 * If the host doesn't support any of the UHS-I modes, fallback on
419 * default speed.
420 */
3f8a7fab 421 if (!mmc_host_uhs(card->host)) {
93c712f9
SJ
422 card->sd_bus_speed = 0;
423 return;
424 }
49c468fc
AN
425
426 if ((card->host->caps & MMC_CAP_UHS_SDR104) &&
427 (card->sw_caps.sd3_bus_mode & SD_MODE_UHS_SDR104)) {
93c712f9 428 card->sd_bus_speed = UHS_SDR104_BUS_SPEED;
49c468fc
AN
429 } else if ((card->host->caps & MMC_CAP_UHS_DDR50) &&
430 (card->sw_caps.sd3_bus_mode & SD_MODE_UHS_DDR50)) {
93c712f9 431 card->sd_bus_speed = UHS_DDR50_BUS_SPEED;
49c468fc
AN
432 } else if ((card->host->caps & (MMC_CAP_UHS_SDR104 |
433 MMC_CAP_UHS_SDR50)) && (card->sw_caps.sd3_bus_mode &
434 SD_MODE_UHS_SDR50)) {
93c712f9 435 card->sd_bus_speed = UHS_SDR50_BUS_SPEED;
49c468fc
AN
436 } else if ((card->host->caps & (MMC_CAP_UHS_SDR104 |
437 MMC_CAP_UHS_SDR50 | MMC_CAP_UHS_SDR25)) &&
438 (card->sw_caps.sd3_bus_mode & SD_MODE_UHS_SDR25)) {
93c712f9 439 card->sd_bus_speed = UHS_SDR25_BUS_SPEED;
49c468fc
AN
440 } else if ((card->host->caps & (MMC_CAP_UHS_SDR104 |
441 MMC_CAP_UHS_SDR50 | MMC_CAP_UHS_SDR25 |
442 MMC_CAP_UHS_SDR12)) && (card->sw_caps.sd3_bus_mode &
443 SD_MODE_UHS_SDR12)) {
93c712f9
SJ
444 card->sd_bus_speed = UHS_SDR12_BUS_SPEED;
445 }
446}
447
448static int sd_set_bus_speed_mode(struct mmc_card *card, u8 *status)
449{
450 int err;
451 unsigned int timing = 0;
452
453 switch (card->sd_bus_speed) {
454 case UHS_SDR104_BUS_SPEED:
455 timing = MMC_TIMING_UHS_SDR104;
456 card->sw_caps.uhs_max_dtr = UHS_SDR104_MAX_DTR;
457 break;
458 case UHS_DDR50_BUS_SPEED:
459 timing = MMC_TIMING_UHS_DDR50;
460 card->sw_caps.uhs_max_dtr = UHS_DDR50_MAX_DTR;
461 break;
462 case UHS_SDR50_BUS_SPEED:
463 timing = MMC_TIMING_UHS_SDR50;
464 card->sw_caps.uhs_max_dtr = UHS_SDR50_MAX_DTR;
465 break;
466 case UHS_SDR25_BUS_SPEED:
467 timing = MMC_TIMING_UHS_SDR25;
468 card->sw_caps.uhs_max_dtr = UHS_SDR25_MAX_DTR;
469 break;
470 case UHS_SDR12_BUS_SPEED:
471 timing = MMC_TIMING_UHS_SDR12;
472 card->sw_caps.uhs_max_dtr = UHS_SDR12_MAX_DTR;
473 break;
474 default:
475 return 0;
49c468fc
AN
476 }
477
93c712f9 478 err = mmc_sd_switch(card, 1, 0, card->sd_bus_speed, status);
49c468fc
AN
479 if (err)
480 return err;
481
93c712f9 482 if ((status[16] & 0xF) != card->sd_bus_speed)
6606110d 483 pr_warn("%s: Problem setting bus speed mode!\n",
49c468fc
AN
484 mmc_hostname(card->host));
485 else {
486 mmc_set_timing(card->host, timing);
487 mmc_set_clock(card->host, card->sw_caps.uhs_max_dtr);
488 }
489
490 return 0;
491}
492
55c4665e
AL
493/* Get host's max current setting at its current voltage */
494static u32 sd_get_host_max_current(struct mmc_host *host)
495{
496 u32 voltage, max_current;
497
498 voltage = 1 << host->ios.vdd;
499 switch (voltage) {
500 case MMC_VDD_165_195:
501 max_current = host->max_current_180;
502 break;
503 case MMC_VDD_29_30:
504 case MMC_VDD_30_31:
505 max_current = host->max_current_300;
506 break;
507 case MMC_VDD_32_33:
508 case MMC_VDD_33_34:
509 max_current = host->max_current_330;
510 break;
511 default:
512 max_current = 0;
513 }
514
515 return max_current;
516}
517
5371c927
AN
518static int sd_set_current_limit(struct mmc_card *card, u8 *status)
519{
0aa67700 520 int current_limit = SD_SET_CURRENT_NO_CHANGE;
5371c927 521 int err;
55c4665e 522 u32 max_current;
5371c927
AN
523
524 /*
525 * Current limit switch is only defined for SDR50, SDR104, and DDR50
0aa67700
PR
526 * bus speed modes. For other bus speed modes, we do not change the
527 * current limit.
55c4665e
AL
528 */
529 if ((card->sd_bus_speed != UHS_SDR50_BUS_SPEED) &&
530 (card->sd_bus_speed != UHS_SDR104_BUS_SPEED) &&
531 (card->sd_bus_speed != UHS_DDR50_BUS_SPEED))
532 return 0;
533
534 /*
535 * Host has different current capabilities when operating at
536 * different voltages, so find out its max current first.
537 */
538 max_current = sd_get_host_max_current(card->host);
539
540 /*
a39ca6ae
AL
541 * We only check host's capability here, if we set a limit that is
542 * higher than the card's maximum current, the card will be using its
543 * maximum current, e.g. if the card's maximum current is 300ma, and
544 * when we set current limit to 200ma, the card will draw 200ma, and
545 * when we set current limit to 400/600/800ma, the card will draw its
546 * maximum 300ma from the host.
d9812780
RK
547 *
548 * The above is incorrect: if we try to set a current limit that is
549 * not supported by the card, the card can rightfully error out the
550 * attempt, and remain at the default current limit. This results
551 * in a 300mA card being limited to 200mA even though the host
552 * supports 800mA. Failures seen with SanDisk 8GB UHS cards with
553 * an iMX6 host. --rmk
5371c927 554 */
d9812780
RK
555 if (max_current >= 800 &&
556 card->sw_caps.sd3_curr_limit & SD_MAX_CURRENT_800)
55c4665e 557 current_limit = SD_SET_CURRENT_LIMIT_800;
d9812780
RK
558 else if (max_current >= 600 &&
559 card->sw_caps.sd3_curr_limit & SD_MAX_CURRENT_600)
55c4665e 560 current_limit = SD_SET_CURRENT_LIMIT_600;
d9812780
RK
561 else if (max_current >= 400 &&
562 card->sw_caps.sd3_curr_limit & SD_MAX_CURRENT_400)
55c4665e 563 current_limit = SD_SET_CURRENT_LIMIT_400;
d9812780
RK
564 else if (max_current >= 200 &&
565 card->sw_caps.sd3_curr_limit & SD_MAX_CURRENT_200)
55c4665e 566 current_limit = SD_SET_CURRENT_LIMIT_200;
5371c927 567
0aa67700
PR
568 if (current_limit != SD_SET_CURRENT_NO_CHANGE) {
569 err = mmc_sd_switch(card, 1, 3, current_limit, status);
570 if (err)
571 return err;
5371c927 572
0aa67700 573 if (((status[15] >> 4) & 0x0F) != current_limit)
6606110d 574 pr_warn("%s: Problem setting current limit!\n",
0aa67700 575 mmc_hostname(card->host));
5371c927 576
0aa67700 577 }
a39ca6ae 578
5371c927
AN
579 return 0;
580}
581
d6d50a15
AN
582/*
583 * UHS-I specific initialization procedure
584 */
585static int mmc_sd_init_uhs_card(struct mmc_card *card)
586{
587 int err;
588 u8 *status;
589
590 if (!card->scr.sda_spec3)
591 return 0;
592
593 if (!(card->csd.cmdclass & CCC_SWITCH))
594 return 0;
595
596 status = kmalloc(64, GFP_KERNEL);
597 if (!status) {
a3c76eb9 598 pr_err("%s: could not allocate a buffer for "
d6d50a15
AN
599 "switch capabilities.\n", mmc_hostname(card->host));
600 return -ENOMEM;
601 }
602
603 /* Set 4-bit bus width */
604 if ((card->host->caps & MMC_CAP_4_BIT_DATA) &&
605 (card->scr.bus_widths & SD_SCR_BUS_WIDTH_4)) {
606 err = mmc_app_set_bus_width(card, MMC_BUS_WIDTH_4);
607 if (err)
608 goto out;
609
610 mmc_set_bus_width(card->host, MMC_BUS_WIDTH_4);
611 }
612
93c712f9
SJ
613 /*
614 * Select the bus speed mode depending on host
615 * and card capability.
616 */
617 sd_update_bus_speed_mode(card);
618
d6d50a15
AN
619 /* Set the driver strength for the card */
620 err = sd_select_driver_type(card, status);
49c468fc
AN
621 if (err)
622 goto out;
623
93c712f9
SJ
624 /* Set current limit for the card */
625 err = sd_set_current_limit(card, status);
5371c927
AN
626 if (err)
627 goto out;
628
93c712f9
SJ
629 /* Set bus speed mode of the card */
630 err = sd_set_bus_speed_mode(card, status);
b513ea25
AN
631 if (err)
632 goto out;
633
810e08ee
FS
634 /*
635 * SPI mode doesn't define CMD19 and tuning is only valid for SDR50 and
636 * SDR104 mode SD-cards. Note that tuning is mandatory for SDR104.
637 */
63e415c6 638 if (!mmc_host_is_spi(card->host) &&
e10c3219
CC
639 (card->host->ios.timing == MMC_TIMING_UHS_SDR50 ||
640 card->host->ios.timing == MMC_TIMING_UHS_DDR50 ||
641 card->host->ios.timing == MMC_TIMING_UHS_SDR104)) {
63e415c6 642 err = mmc_execute_tuning(card);
4324f6de
WY
643
644 /*
645 * As SD Specifications Part1 Physical Layer Specification
646 * Version 3.01 says, CMD19 tuning is available for unlocked
647 * cards in transfer state of 1.8V signaling mode. The small
648 * difference between v3.00 and 3.01 spec means that CMD19
649 * tuning is also available for DDR50 mode.
650 */
e10c3219 651 if (err && card->host->ios.timing == MMC_TIMING_UHS_DDR50) {
4324f6de
WY
652 pr_warn("%s: ddr50 tuning failed\n",
653 mmc_hostname(card->host));
654 err = 0;
655 }
656 }
657
d6d50a15
AN
658out:
659 kfree(status);
660
661 return err;
662}
663
51ec92e2
PO
664MMC_DEV_ATTR(cid, "%08x%08x%08x%08x\n", card->raw_cid[0], card->raw_cid[1],
665 card->raw_cid[2], card->raw_cid[3]);
666MMC_DEV_ATTR(csd, "%08x%08x%08x%08x\n", card->raw_csd[0], card->raw_csd[1],
667 card->raw_csd[2], card->raw_csd[3]);
668MMC_DEV_ATTR(scr, "%08x%08x\n", card->raw_scr[0], card->raw_scr[1]);
669MMC_DEV_ATTR(date, "%02d/%04d\n", card->cid.month, card->cid.year);
dfe86cba
AH
670MMC_DEV_ATTR(erase_size, "%u\n", card->erase_size << 9);
671MMC_DEV_ATTR(preferred_erase_size, "%u\n", card->pref_erase << 9);
51ec92e2
PO
672MMC_DEV_ATTR(fwrev, "0x%x\n", card->cid.fwrev);
673MMC_DEV_ATTR(hwrev, "0x%x\n", card->cid.hwrev);
674MMC_DEV_ATTR(manfid, "0x%06x\n", card->cid.manfid);
675MMC_DEV_ATTR(name, "%s\n", card->cid.prod_name);
676MMC_DEV_ATTR(oemid, "0x%04x\n", card->cid.oemid);
677MMC_DEV_ATTR(serial, "0x%08x\n", card->cid.serial);
5fb06af7 678MMC_DEV_ATTR(ocr, "%08x\n", card->ocr);
51ec92e2
PO
679
680
6825a606
BP
681static ssize_t mmc_dsr_show(struct device *dev,
682 struct device_attribute *attr,
683 char *buf)
684{
685 struct mmc_card *card = mmc_dev_to_card(dev);
686 struct mmc_host *host = card->host;
687
688 if (card->csd.dsr_imp && host->dsr_req)
689 return sprintf(buf, "0x%x\n", host->dsr);
690 else
691 /* return default DSR value */
692 return sprintf(buf, "0x%x\n", 0x404);
693}
694
695static DEVICE_ATTR(dsr, S_IRUGO, mmc_dsr_show, NULL);
696
51ec92e2
PO
697static struct attribute *sd_std_attrs[] = {
698 &dev_attr_cid.attr,
699 &dev_attr_csd.attr,
700 &dev_attr_scr.attr,
701 &dev_attr_date.attr,
dfe86cba
AH
702 &dev_attr_erase_size.attr,
703 &dev_attr_preferred_erase_size.attr,
51ec92e2
PO
704 &dev_attr_fwrev.attr,
705 &dev_attr_hwrev.attr,
706 &dev_attr_manfid.attr,
707 &dev_attr_name.attr,
708 &dev_attr_oemid.attr,
709 &dev_attr_serial.attr,
5fb06af7 710 &dev_attr_ocr.attr,
6825a606 711 &dev_attr_dsr.attr,
51ec92e2
PO
712 NULL,
713};
d1e58212 714ATTRIBUTE_GROUPS(sd_std);
51ec92e2 715
71578a1e 716struct device_type sd_type = {
d1e58212 717 .groups = sd_std_groups,
51ec92e2
PO
718};
719
7ea239d9 720/*
71578a1e 721 * Fetch CID from card.
7ea239d9 722 */
d6d50a15 723int mmc_sd_get_cid(struct mmc_host *host, u32 ocr, u32 *cid, u32 *rocr)
7ea239d9 724{
7ea239d9 725 int err;
55c4665e 726 u32 max_current;
0797e5f1 727 int retries = 10;
69041150 728 u32 pocr = ocr;
0797e5f1
JR
729
730try_again:
731 if (!retries) {
732 ocr &= ~SD_OCR_S18R;
6606110d 733 pr_warn("%s: Skipping voltage switch\n", mmc_hostname(host));
0797e5f1 734 }
7ea239d9 735
7ea239d9
PO
736 /*
737 * Since we're changing the OCR value, we seem to
738 * need to tell some cards to go back to the idle
739 * state. We wait 1ms to give cards time to
740 * respond.
741 */
742 mmc_go_idle(host);
743
744 /*
745 * If SD_SEND_IF_COND indicates an SD 2.0
746 * compliant card and we should set bit 30
747 * of the ocr to indicate that we can handle
748 * block-addressed SDHC cards.
749 */
6abaa0c9 750 err = mmc_send_if_cond(host, ocr);
17b0429d 751 if (!err)
f2119df6 752 ocr |= SD_OCR_CCS;
7ea239d9 753
f2119df6
AN
754 /*
755 * If the host supports one of UHS-I modes, request the card
0797e5f1
JR
756 * to switch to 1.8V signaling level. If the card has failed
757 * repeatedly to switch however, skip this.
f2119df6 758 */
0797e5f1 759 if (retries && mmc_host_uhs(host))
f2119df6
AN
760 ocr |= SD_OCR_S18R;
761
55c4665e
AL
762 /*
763 * If the host can supply more than 150mA at current voltage,
764 * XPC should be set to 1.
765 */
766 max_current = sd_get_host_max_current(host);
767 if (max_current > 150)
f2119df6
AN
768 ocr |= SD_OCR_XPC;
769
d6d50a15 770 err = mmc_send_app_op_cond(host, ocr, rocr);
17b0429d 771 if (err)
71578a1e 772 return err;
7ea239d9 773
f2119df6
AN
774 /*
775 * In case CCS and S18A in the response is set, start Signal Voltage
776 * Switch procedure. SPI mode doesn't support CMD11.
777 */
d6d50a15
AN
778 if (!mmc_host_is_spi(host) && rocr &&
779 ((*rocr & 0x41000000) == 0x41000000)) {
0f791fda 780 err = mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_180,
69041150 781 pocr);
0797e5f1
JR
782 if (err == -EAGAIN) {
783 retries--;
784 goto try_again;
785 } else if (err) {
786 retries = 0;
f2119df6
AN
787 goto try_again;
788 }
789 }
790
af517150
DB
791 if (mmc_host_is_spi(host))
792 err = mmc_send_cid(host, cid);
793 else
794 err = mmc_all_send_cid(host, cid);
71578a1e
MM
795
796 return err;
797}
798
799int mmc_sd_get_csd(struct mmc_host *host, struct mmc_card *card)
800{
801 int err;
802
803 /*
804 * Fetch CSD from card.
805 */
806 err = mmc_send_csd(card, card->raw_csd);
17b0429d 807 if (err)
71578a1e 808 return err;
7ea239d9 809
71578a1e
MM
810 err = mmc_decode_csd(card);
811 if (err)
812 return err;
813
814 return 0;
815}
816
9f6e0bff
LPC
817static int mmc_sd_get_ro(struct mmc_host *host)
818{
819 int ro;
820
821 /*
822 * Some systems don't feature a write-protect pin and don't need one.
823 * E.g. because they only have micro-SD card slot. For those systems
824 * assume that the SD card is always read-write.
825 */
826 if (host->caps2 & MMC_CAP2_NO_WRITE_PROTECT)
827 return 0;
828
829 if (!host->ops->get_ro)
830 return -1;
831
9f6e0bff 832 ro = host->ops->get_ro(host);
9f6e0bff
LPC
833
834 return ro;
835}
836
71578a1e
MM
837int mmc_sd_setup_card(struct mmc_host *host, struct mmc_card *card,
838 bool reinit)
839{
840 int err;
841
842 if (!reinit) {
843 /*
844 * Fetch SCR from card.
845 */
846 err = mmc_app_send_scr(card, card->raw_scr);
847 if (err)
848 return err;
849
850 err = mmc_decode_scr(card);
851 if (err)
852 return err;
853
dfe86cba
AH
854 /*
855 * Fetch and process SD Status register.
856 */
857 err = mmc_read_ssr(card);
858 if (err)
859 return err;
860
861 /* Erase init depends on CSD and SSR */
862 mmc_init_erase(card);
863
71578a1e
MM
864 /*
865 * Fetch switch information from card.
866 */
867 err = mmc_read_switch(card);
868 if (err)
869 return err;
870 }
871
872 /*
873 * For SPI, enable CRC as appropriate.
874 * This CRC enable is located AFTER the reading of the
875 * card registers because some SDHC cards are not able
876 * to provide valid CRCs for non-512-byte blocks.
877 */
878 if (mmc_host_is_spi(host)) {
879 err = mmc_spi_set_crc(host, use_spi_crc);
880 if (err)
881 return err;
882 }
883
884 /*
885 * Check if read-only switch is active.
886 */
887 if (!reinit) {
9f6e0bff 888 int ro = mmc_sd_get_ro(host);
71578a1e
MM
889
890 if (ro < 0) {
6606110d 891 pr_warn("%s: host does not support reading read-only switch, assuming write-enable\n",
71578a1e
MM
892 mmc_hostname(host));
893 } else if (ro > 0) {
894 mmc_card_set_readonly(card);
adf66a0d 895 }
71578a1e
MM
896 }
897
898 return 0;
899}
900
901unsigned mmc_sd_get_max_clock(struct mmc_card *card)
902{
903 unsigned max_dtr = (unsigned int)-1;
904
cdc99179 905 if (mmc_card_hs(card)) {
71578a1e
MM
906 if (max_dtr > card->sw_caps.hs_max_dtr)
907 max_dtr = card->sw_caps.hs_max_dtr;
908 } else if (max_dtr > card->csd.max_dtr) {
909 max_dtr = card->csd.max_dtr;
910 }
911
912 return max_dtr;
913}
914
71578a1e
MM
915/*
916 * Handle the detection and initialisation of a card.
917 *
918 * In the case of a resume, "oldcard" will contain the card
919 * we're trying to reinitialise.
920 */
921static int mmc_sd_init_card(struct mmc_host *host, u32 ocr,
922 struct mmc_card *oldcard)
923{
924 struct mmc_card *card;
925 int err;
926 u32 cid[4];
d6d50a15 927 u32 rocr = 0;
71578a1e
MM
928
929 BUG_ON(!host);
930 WARN_ON(!host->claimed);
931
d6d50a15 932 err = mmc_sd_get_cid(host, ocr, cid, &rocr);
71578a1e
MM
933 if (err)
934 return err;
935
936 if (oldcard) {
937 if (memcmp(cid, oldcard->raw_cid, sizeof(cid)) != 0)
938 return -ENOENT;
7ea239d9 939
6abaa0c9
PO
940 card = oldcard;
941 } else {
942 /*
943 * Allocate card structure.
944 */
51ec92e2 945 card = mmc_alloc_card(host, &sd_type);
71578a1e
MM
946 if (IS_ERR(card))
947 return PTR_ERR(card);
6abaa0c9 948
69041150 949 card->ocr = ocr;
6abaa0c9
PO
950 card->type = MMC_TYPE_SD;
951 memcpy(card->raw_cid, cid, sizeof(card->raw_cid));
952 }
7ea239d9 953
eac86321
DA
954 /*
955 * Call the optional HC's init_card function to handle quirks.
956 */
957 if (host->ops->init_card)
958 host->ops->init_card(host, card);
959
7ea239d9 960 /*
af517150 961 * For native busses: get card RCA and quit open drain mode.
7ea239d9 962 */
af517150
DB
963 if (!mmc_host_is_spi(host)) {
964 err = mmc_send_relative_addr(host, &card->rca);
965 if (err)
7fca9675 966 goto free_card;
af517150 967 }
7ea239d9 968
6abaa0c9 969 if (!oldcard) {
71578a1e 970 err = mmc_sd_get_csd(host, card);
17b0429d 971 if (err)
7fca9675 972 goto free_card;
bd766312 973
6abaa0c9
PO
974 mmc_decode_cid(card);
975 }
7ea239d9 976
3d705d14
SH
977 /*
978 * handling only for cards supporting DSR and hosts requesting
979 * DSR configuration
980 */
981 if (card->csd.dsr_imp && host->dsr_req)
982 mmc_set_dsr(host);
983
7ea239d9 984 /*
6abaa0c9 985 * Select card, as all following commands rely on that.
7ea239d9 986 */
af517150
DB
987 if (!mmc_host_is_spi(host)) {
988 err = mmc_select_card(card);
989 if (err)
7fca9675 990 goto free_card;
6abaa0c9 991 }
1addfcdb 992
71578a1e
MM
993 err = mmc_sd_setup_card(host, card, oldcard != NULL);
994 if (err)
995 goto free_card;
9d9f25c0 996
d6d50a15
AN
997 /* Initialization sequence for UHS-I cards */
998 if (rocr & SD_ROCR_S18A) {
999 err = mmc_sd_init_uhs_card(card);
17b0429d 1000 if (err)
7ea239d9 1001 goto free_card;
d6d50a15
AN
1002 } else {
1003 /*
1004 * Attempt to change to high-speed (if supported)
1005 */
1006 err = mmc_sd_switch_hs(card);
1007 if (err > 0)
cdc99179 1008 mmc_set_timing(card->host, MMC_TIMING_SD_HS);
d6d50a15
AN
1009 else if (err)
1010 goto free_card;
1011
1012 /*
1013 * Set bus speed.
1014 */
1015 mmc_set_clock(host, mmc_sd_get_max_clock(card));
7ea239d9 1016
d6d50a15
AN
1017 /*
1018 * Switch to wider bus (if supported).
1019 */
1020 if ((host->caps & MMC_CAP_4_BIT_DATA) &&
1021 (card->scr.bus_widths & SD_SCR_BUS_WIDTH_4)) {
1022 err = mmc_app_set_bus_width(card, MMC_BUS_WIDTH_4);
1023 if (err)
1024 goto free_card;
1025
1026 mmc_set_bus_width(host, MMC_BUS_WIDTH_4);
1027 }
7ea239d9
PO
1028 }
1029
71578a1e 1030 host->card = card;
17b0429d 1031 return 0;
6abaa0c9
PO
1032
1033free_card:
1034 if (!oldcard)
1035 mmc_remove_card(card);
6abaa0c9 1036
adf66a0d 1037 return err;
6abaa0c9
PO
1038}
1039
1040/*
1041 * Host is being removed. Free up the current card.
1042 */
1043static void mmc_sd_remove(struct mmc_host *host)
1044{
1045 BUG_ON(!host);
1046 BUG_ON(!host->card);
1047
1048 mmc_remove_card(host->card);
1049 host->card = NULL;
1050}
1051
d3049504
AH
1052/*
1053 * Card detection - card is alive.
1054 */
1055static int mmc_sd_alive(struct mmc_host *host)
1056{
1057 return mmc_send_status(host->card, NULL);
1058}
1059
6abaa0c9
PO
1060/*
1061 * Card detection callback from host.
1062 */
1063static void mmc_sd_detect(struct mmc_host *host)
1064{
1065 int err;
1066
1067 BUG_ON(!host);
1068 BUG_ON(!host->card);
1069
e94cfef6 1070 mmc_get_card(host->card);
6abaa0c9
PO
1071
1072 /*
1073 * Just check if our card has been removed.
1074 */
d3049504 1075 err = _mmc_detect_card_removed(host);
7ea239d9 1076
e94cfef6 1077 mmc_put_card(host->card);
7ea239d9 1078
17b0429d 1079 if (err) {
4101c16a 1080 mmc_sd_remove(host);
6abaa0c9
PO
1081
1082 mmc_claim_host(host);
1083 mmc_detach_bus(host);
7f7e4129 1084 mmc_power_off(host);
6abaa0c9
PO
1085 mmc_release_host(host);
1086 }
1087}
1088
0cb403a2 1089static int _mmc_sd_suspend(struct mmc_host *host)
6abaa0c9 1090{
85e727ed
JC
1091 int err = 0;
1092
6abaa0c9
PO
1093 BUG_ON(!host);
1094 BUG_ON(!host->card);
1095
1096 mmc_claim_host(host);
9ec775f7
UH
1097
1098 if (mmc_card_suspended(host->card))
1099 goto out;
1100
af517150 1101 if (!mmc_host_is_spi(host))
85e727ed 1102 err = mmc_deselect_cards(host);
cdc99179 1103
9ec775f7 1104 if (!err) {
74590263 1105 mmc_power_off(host);
9ec775f7
UH
1106 mmc_card_set_suspended(host->card);
1107 }
95cdfb72 1108
9ec775f7
UH
1109out:
1110 mmc_release_host(host);
85e727ed 1111 return err;
6abaa0c9
PO
1112}
1113
1114/*
0cb403a2
UH
1115 * Callback for suspend
1116 */
1117static int mmc_sd_suspend(struct mmc_host *host)
1118{
1119 int err;
1120
1121 err = _mmc_sd_suspend(host);
1122 if (!err) {
1123 pm_runtime_disable(&host->card->dev);
1124 pm_runtime_set_suspended(&host->card->dev);
1125 }
1126
1127 return err;
1128}
1129
1130/*
6abaa0c9
PO
1131 * This function tries to determine if the same card is still present
1132 * and, if so, restore all state to it.
1133 */
0cb403a2 1134static int _mmc_sd_resume(struct mmc_host *host)
6abaa0c9 1135{
9ec775f7 1136 int err = 0;
6abaa0c9
PO
1137
1138 BUG_ON(!host);
1139 BUG_ON(!host->card);
1140
1141 mmc_claim_host(host);
9ec775f7
UH
1142
1143 if (!mmc_card_suspended(host->card))
1144 goto out;
1145
69041150 1146 mmc_power_up(host, host->card->ocr);
69041150 1147 err = mmc_sd_init_card(host, host->card->ocr, host->card);
9ec775f7 1148 mmc_card_clr_suspended(host->card);
2986d0bf 1149
9ec775f7
UH
1150out:
1151 mmc_release_host(host);
95cdfb72 1152 return err;
6abaa0c9
PO
1153}
1154
0cb403a2
UH
1155/*
1156 * Callback for resume
1157 */
1158static int mmc_sd_resume(struct mmc_host *host)
1159{
0cb403a2 1160 pm_runtime_enable(&host->card->dev);
c29536e8 1161 return 0;
0cb403a2
UH
1162}
1163
c4d770d7
UH
1164/*
1165 * Callback for runtime_suspend.
1166 */
1167static int mmc_sd_runtime_suspend(struct mmc_host *host)
1168{
1169 int err;
1170
1171 if (!(host->caps & MMC_CAP_AGGRESSIVE_PM))
1172 return 0;
1173
0cb403a2 1174 err = _mmc_sd_suspend(host);
0cc81a8c 1175 if (err)
f42cf8d6 1176 pr_err("%s: error %d doing aggressive suspend\n",
c4d770d7 1177 mmc_hostname(host), err);
c4d770d7 1178
c4d770d7
UH
1179 return err;
1180}
1181
1182/*
1183 * Callback for runtime_resume.
1184 */
1185static int mmc_sd_runtime_resume(struct mmc_host *host)
1186{
1187 int err;
1188
0cb403a2 1189 err = _mmc_sd_resume(host);
520322d9 1190 if (err && err != -ENOMEDIUM)
c29536e8 1191 pr_err("%s: error %d doing runtime resume\n",
c4d770d7
UH
1192 mmc_hostname(host), err);
1193
c4d770d7
UH
1194 return 0;
1195}
1196
dc0ecfef
JR
1197static int mmc_sd_reset(struct mmc_host *host)
1198{
1199 mmc_power_cycle(host, host->card->ocr);
3056c49c 1200 return mmc_sd_init_card(host, host->card->ocr, host->card);
dc0ecfef
JR
1201}
1202
6abaa0c9
PO
1203static const struct mmc_bus_ops mmc_sd_ops = {
1204 .remove = mmc_sd_remove,
1205 .detect = mmc_sd_detect,
c4d770d7
UH
1206 .runtime_suspend = mmc_sd_runtime_suspend,
1207 .runtime_resume = mmc_sd_runtime_resume,
6abaa0c9
PO
1208 .suspend = mmc_sd_suspend,
1209 .resume = mmc_sd_resume,
d3049504 1210 .alive = mmc_sd_alive,
5992e786 1211 .shutdown = mmc_sd_suspend,
dc0ecfef 1212 .reset = mmc_sd_reset,
6abaa0c9
PO
1213};
1214
1215/*
1216 * Starting point for SD card init.
1217 */
807e8e40 1218int mmc_attach_sd(struct mmc_host *host)
6abaa0c9
PO
1219{
1220 int err;
69041150 1221 u32 ocr, rocr;
6abaa0c9
PO
1222
1223 BUG_ON(!host);
d84075c8 1224 WARN_ON(!host->claimed);
6abaa0c9 1225
807e8e40
AR
1226 err = mmc_send_app_op_cond(host, 0, &ocr);
1227 if (err)
1228 return err;
1229
2501c917 1230 mmc_attach_bus(host, &mmc_sd_ops);
8f230f45
TI
1231 if (host->ocr_avail_sd)
1232 host->ocr_avail = host->ocr_avail_sd;
6abaa0c9 1233
af517150
DB
1234 /*
1235 * We need to get OCR a different way for SPI.
1236 */
1237 if (mmc_host_is_spi(host)) {
1238 mmc_go_idle(host);
1239
1240 err = mmc_spi_read_ocr(host, 0, &ocr);
1241 if (err)
1242 goto err;
1243 }
1244
69041150 1245 rocr = mmc_select_voltage(host, ocr);
6abaa0c9
PO
1246
1247 /*
1248 * Can we support the voltage(s) of the card(s)?
1249 */
69041150 1250 if (!rocr) {
109b5bed 1251 err = -EINVAL;
6abaa0c9 1252 goto err;
109b5bed 1253 }
6abaa0c9
PO
1254
1255 /*
1256 * Detect and init the card.
1257 */
69041150 1258 err = mmc_sd_init_card(host, rocr, NULL);
17b0429d 1259 if (err)
6abaa0c9
PO
1260 goto err;
1261
1262 mmc_release_host(host);
4101c16a 1263 err = mmc_add_card(host->card);
7ea239d9 1264 if (err)
2986d0bf 1265 goto remove_card;
7ea239d9 1266
2860d060 1267 mmc_claim_host(host);
7ea239d9
PO
1268 return 0;
1269
2986d0bf 1270remove_card:
6abaa0c9 1271 mmc_remove_card(host->card);
7ea239d9 1272 host->card = NULL;
2986d0bf 1273 mmc_claim_host(host);
7ea239d9
PO
1274err:
1275 mmc_detach_bus(host);
7ea239d9 1276
a3c76eb9 1277 pr_err("%s: error %d whilst initialising SD card\n",
109b5bed
PO
1278 mmc_hostname(host), err);
1279
adf66a0d 1280 return err;
7ea239d9 1281}
This page took 0.68197 seconds and 5 git commands to generate.