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