blob: ad709340e6639a4ee5647bf8be129996ebbff075 [file] [log] [blame]
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001/*
Pierre Ossman70f10482007-07-11 20:04:50 +02002 * linux/drivers/mmc/core/sd.c
Pierre Ossman7ea239d2006-12-31 00:11:32 +01003 *
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>
Wolfram Sang9288cac2013-11-26 02:16:25 +010014#include <linux/sizes.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090015#include <linux/slab.h>
Paul Gortmaker0205a902011-07-15 12:01:27 -040016#include <linux/stat.h>
Ulf Hansson0cb403a2013-10-10 14:20:05 +020017#include <linux/pm_runtime.h>
Pierre Ossman7ea239d2006-12-31 00:11:32 +010018
19#include <linux/mmc/host.h>
20#include <linux/mmc/card.h>
21#include <linux/mmc/mmc.h>
Pierre Ossman3373c0a2007-05-31 22:25:11 +020022#include <linux/mmc/sd.h>
Pierre Ossman7ea239d2006-12-31 00:11:32 +010023
24#include "core.h"
Pierre Ossman4101c162007-05-19 13:39:01 +020025#include "bus.h"
Pierre Ossman7ea239d2006-12-31 00:11:32 +010026#include "mmc_ops.h"
Mark Brownce101492011-02-10 10:58:37 +000027#include "sd.h"
Pierre Ossman7ea239d2006-12-31 00:11:32 +010028#include "sd_ops.h"
29
Pierre Ossman7ea239d2006-12-31 00:11:32 +010030static 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
Wolfram Sang9288cac2013-11-26 02:16:25 +010049static 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
Pierre Ossman7ea239d2006-12-31 00:11:32 +010056#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 */
Michal Miroslaw71578a12010-08-10 18:01:40 -070073void mmc_decode_cid(struct mmc_card *card)
Pierre Ossman7ea239d2006-12-31 00:11:32 +010074{
75 u32 *resp = card->raw_cid;
76
Pierre Ossman7ea239d2006-12-31 00:11:32 +010077 /*
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 */
Pierre Ossmanbd766312007-05-01 16:11:57 +0200100static int mmc_decode_csd(struct mmc_card *card)
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100101{
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);
Sascha Hauer3d705d12014-08-19 10:45:51 +0200128 csd->dsr_imp = UNSTUFF_BITS(resp, 76, 1);
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100129 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);
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700132
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 }
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100139 break;
140 case 1:
141 /*
Arindam Nath3a303512011-05-05 12:19:03 +0530142 * This is a block-addressed SDHC or SDXC card. Most
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100143 * 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);
Arindam Nath3a303512011-05-05 12:19:03 +0530156 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);
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100161
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;
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700172 csd->erase_size = 1;
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100173 break;
174 default:
Girish K Sa3c76eb2011-10-11 11:44:09 +0530175 pr_err("%s: unrecognised CSD structure version %d\n",
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100176 mmc_hostname(card->host), csd_struct);
Pierre Ossmanbd766312007-05-01 16:11:57 +0200177 return -EINVAL;
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100178 }
Pierre Ossmanbd766312007-05-01 16:11:57 +0200179
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700180 card->erase_size = csd->erase_size;
181
Pierre Ossmanbd766312007-05-01 16:11:57 +0200182 return 0;
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100183}
184
185/*
186 * Given a 64-bit response, decode to our card SCR structure.
187 */
Pierre Ossmanbd766312007-05-01 16:11:57 +0200188static int mmc_decode_scr(struct mmc_card *card)
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100189{
190 struct sd_scr *scr = &card->scr;
191 unsigned int scr_struct;
192 u32 resp[4];
193
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100194 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) {
Girish K Sa3c76eb2011-10-11 11:44:09 +0530199 pr_err("%s: unrecognised SCR structure version %d\n",
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100200 mmc_hostname(card->host), scr_struct);
Pierre Ossmanbd766312007-05-01 16:11:57 +0200201 return -EINVAL;
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100202 }
203
204 scr->sda_vsn = UNSTUFF_BITS(resp, 56, 4);
205 scr->bus_widths = UNSTUFF_BITS(resp, 48, 4);
Arindam Nath013909c2011-05-05 12:18:58 +0530206 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);
Pierre Ossmanbd766312007-05-01 16:11:57 +0200209
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700210 if (UNSTUFF_BITS(resp, 55, 1))
211 card->erased_byte = 0xFF;
212 else
213 card->erased_byte = 0x0;
214
Andrei Warkentinf0d89972011-05-23 15:06:38 -0500215 if (scr->sda_spec3)
216 scr->cmds = UNSTUFF_BITS(resp, 32, 2);
Pierre Ossmanbd766312007-05-01 16:11:57 +0200217 return 0;
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100218}
219
220/*
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700221 * Fetch and process SD Status register.
222 */
223static int mmc_read_ssr(struct mmc_card *card)
224{
225 unsigned int au, es, et, eo;
Paul Burtonefd16f72016-11-11 14:22:36 +0000226 u32 *raw_ssr;
Uri Yanai5275a652016-08-14 11:46:36 +0300227 int i;
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700228
229 if (!(card->csd.cmdclass & CCC_APP_SPEC)) {
Joe Perches66061102014-09-12 14:56:56 -0700230 pr_warn("%s: card lacks mandatory SD Status function\n",
231 mmc_hostname(card->host));
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700232 return 0;
233 }
234
Paul Burtonefd16f72016-11-11 14:22:36 +0000235 raw_ssr = kmalloc(sizeof(card->raw_ssr), GFP_KERNEL);
236 if (!raw_ssr)
237 return -ENOMEM;
238
239 if (mmc_app_sd_status(card, raw_ssr)) {
Joe Perches66061102014-09-12 14:56:56 -0700240 pr_warn("%s: problem reading SD Status register\n",
241 mmc_hostname(card->host));
Paul Burtonefd16f72016-11-11 14:22:36 +0000242 kfree(raw_ssr);
Uri Yanai5275a652016-08-14 11:46:36 +0300243 return 0;
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700244 }
245
246 for (i = 0; i < 16; i++)
Paul Burtonefd16f72016-11-11 14:22:36 +0000247 card->raw_ssr[i] = be32_to_cpu(raw_ssr[i]);
248
249 kfree(raw_ssr);
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700250
251 /*
252 * UNSTUFF_BITS only works with four u32s so we have to offset the
253 * bitfield positions accordingly.
254 */
Uri Yanai5275a652016-08-14 11:46:36 +0300255 au = UNSTUFF_BITS(card->raw_ssr, 428 - 384, 4);
Wolfram Sang9288cac2013-11-26 02:16:25 +0100256 if (au) {
257 if (au <= 9 || card->scr.sda_spec3) {
258 card->ssr.au = sd_au_size[au];
Uri Yanai5275a652016-08-14 11:46:36 +0300259 es = UNSTUFF_BITS(card->raw_ssr, 408 - 384, 16);
260 et = UNSTUFF_BITS(card->raw_ssr, 402 - 384, 6);
Wolfram Sang9288cac2013-11-26 02:16:25 +0100261 if (es && et) {
Uri Yanai5275a652016-08-14 11:46:36 +0300262 eo = UNSTUFF_BITS(card->raw_ssr, 400 - 384, 2);
Wolfram Sang9288cac2013-11-26 02:16:25 +0100263 card->ssr.erase_timeout = (et * 1000) / es;
264 card->ssr.erase_offset = eo * 1000;
265 }
266 } else {
Joe Perches66061102014-09-12 14:56:56 -0700267 pr_warn("%s: SD Status: Invalid Allocation Unit size\n",
268 mmc_hostname(card->host));
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700269 }
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700270 }
Uri Yanai5275a652016-08-14 11:46:36 +0300271
272 return 0;
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700273}
274
275/*
Pierre Ossman1addfcd2007-05-01 14:46:08 +0200276 * Fetches and decodes switch information
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100277 */
Pierre Ossman1addfcd2007-05-01 14:46:08 +0200278static int mmc_read_switch(struct mmc_card *card)
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100279{
280 int err;
281 u8 *status;
282
Pierre Ossman3373c0a2007-05-31 22:25:11 +0200283 if (card->scr.sda_vsn < SCR_SPEC_VER_1)
Pierre Ossman17b04292007-07-22 22:18:46 +0200284 return 0;
Pierre Ossman3373c0a2007-05-31 22:25:11 +0200285
286 if (!(card->csd.cmdclass & CCC_SWITCH)) {
Joe Perches66061102014-09-12 14:56:56 -0700287 pr_warn("%s: card lacks mandatory switch function, performance might suffer\n",
Pierre Ossman3373c0a2007-05-31 22:25:11 +0200288 mmc_hostname(card->host));
Pierre Ossman17b04292007-07-22 22:18:46 +0200289 return 0;
Pierre Ossman3373c0a2007-05-31 22:25:11 +0200290 }
291
Pierre Ossman17b04292007-07-22 22:18:46 +0200292 err = -EIO;
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100293
294 status = kmalloc(64, GFP_KERNEL);
295 if (!status) {
Girish K Sa3c76eb2011-10-11 11:44:09 +0530296 pr_err("%s: could not allocate a buffer for "
Arindam Nath013909c2011-05-05 12:18:58 +0530297 "switch capabilities.\n",
298 mmc_hostname(card->host));
Pierre Ossman17b04292007-07-22 22:18:46 +0200299 return -ENOMEM;
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100300 }
301
Aaron Lua39ca6ae2012-07-03 14:16:11 +0800302 /*
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);
Pierre Ossman17b04292007-07-22 22:18:46 +0200308 if (err) {
Arindam Nath013909c2011-05-05 12:18:58 +0530309 /*
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)
Pierre Ossmanadf66a02007-07-22 23:08:30 +0200314 goto out;
315
Joe Perches66061102014-09-12 14:56:56 -0700316 pr_warn("%s: problem reading Bus Speed modes\n",
Pierre Ossman3373c0a2007-05-31 22:25:11 +0200317 mmc_hostname(card->host));
Pierre Ossman17b04292007-07-22 22:18:46 +0200318 err = 0;
Pierre Ossmanadf66a02007-07-22 23:08:30 +0200319
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100320 goto out;
321 }
322
Qiang Liufffe5d52011-11-08 08:43:08 -0500323 if (status[13] & SD_MODE_HIGH_SPEED)
324 card->sw_caps.hs_max_dtr = HIGH_SPEED_MAX_DTR;
Subhash Jadavanif2815f62011-08-10 11:16:01 +0530325
Arindam Nath013909c2011-05-05 12:18:58 +0530326 if (card->scr.sda_spec3) {
327 card->sw_caps.sd3_bus_mode = status[13];
Aaron Lua39ca6ae2012-07-03 14:16:11 +0800328 /* Driver Strengths supported by the card */
Arindam Nath013909c2011-05-05 12:18:58 +0530329 card->sw_caps.sd3_drv_type = status[9];
Russell Kingd9812782016-01-02 10:06:29 +0000330 card->sw_caps.sd3_curr_limit = status[7] | status[6] << 8;
Arindam Nath013909c2011-05-05 12:18:58 +0530331 }
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100332
Pierre Ossman1addfcd2007-05-01 14:46:08 +0200333out:
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 */
Michal Miroslaw71578a12010-08-10 18:01:40 -0700342int mmc_sd_switch_hs(struct mmc_card *card)
Pierre Ossman1addfcd2007-05-01 14:46:08 +0200343{
344 int err;
345 u8 *status;
346
Pierre Ossman3373c0a2007-05-31 22:25:11 +0200347 if (card->scr.sda_vsn < SCR_SPEC_VER_1)
Pierre Ossman17b04292007-07-22 22:18:46 +0200348 return 0;
Pierre Ossman3373c0a2007-05-31 22:25:11 +0200349
350 if (!(card->csd.cmdclass & CCC_SWITCH))
Pierre Ossman17b04292007-07-22 22:18:46 +0200351 return 0;
Pierre Ossman3373c0a2007-05-31 22:25:11 +0200352
Pierre Ossman1addfcd2007-05-01 14:46:08 +0200353 if (!(card->host->caps & MMC_CAP_SD_HIGHSPEED))
Pierre Ossman17b04292007-07-22 22:18:46 +0200354 return 0;
Pierre Ossman1addfcd2007-05-01 14:46:08 +0200355
356 if (card->sw_caps.hs_max_dtr == 0)
Pierre Ossman17b04292007-07-22 22:18:46 +0200357 return 0;
Pierre Ossman1addfcd2007-05-01 14:46:08 +0200358
Pierre Ossman1addfcd2007-05-01 14:46:08 +0200359 status = kmalloc(64, GFP_KERNEL);
360 if (!status) {
Girish K Sa3c76eb2011-10-11 11:44:09 +0530361 pr_err("%s: could not allocate a buffer for "
Pierre Ossmanfacba912007-07-24 21:53:43 +0200362 "switch capabilities.\n", mmc_hostname(card->host));
Pierre Ossman17b04292007-07-22 22:18:46 +0200363 return -ENOMEM;
Pierre Ossman1addfcd2007-05-01 14:46:08 +0200364 }
365
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100366 err = mmc_sd_switch(card, 1, 0, 1, status);
Pierre Ossman17b04292007-07-22 22:18:46 +0200367 if (err)
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100368 goto out;
369
370 if ((status[16] & 0xF) != 1) {
Joe Perches66061102014-09-12 14:56:56 -0700371 pr_warn("%s: Problem switching card into high-speed mode!\n",
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100372 mmc_hostname(card->host));
Michal Miroslaw71578a12010-08-10 18:01:40 -0700373 err = 0;
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100374 } else {
Michal Miroslaw71578a12010-08-10 18:01:40 -0700375 err = 1;
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100376 }
377
378out:
379 kfree(status);
380
381 return err;
382}
383
Arindam Nathd6d50a12011-05-05 12:18:59 +0530384static int sd_select_driver_type(struct mmc_card *card, u8 *status)
385{
Adrian Hunterfa021ce2015-02-06 14:12:53 +0200386 int card_drv_type, drive_strength, drv_type;
Arindam Nathd6d50a12011-05-05 12:18:59 +0530387 int err;
388
Adrian Hunter3853a042015-02-06 14:12:56 +0200389 card->drive_strength = 0;
390
Adrian Hunterfa021ce2015-02-06 14:12:53 +0200391 card_drv_type = card->sw_caps.sd3_drv_type | SD_DRIVER_TYPE_B;
Philip Rakityca8e99b2011-07-06 08:51:32 -0700392
Adrian Huntere23350b2015-02-06 14:12:55 +0200393 drive_strength = mmc_select_drive_strength(card,
394 card->sw_caps.uhs_max_dtr,
395 card_drv_type, &drv_type);
Philip Rakityca8e99b2011-07-06 08:51:32 -0700396
Adrian Hunterb4f30a12015-02-06 14:12:52 +0200397 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 }
Adrian Hunter3853a042015-02-06 14:12:56 +0200406 card->drive_strength = drive_strength;
Arindam Nathd6d50a12011-05-05 12:18:59 +0530407 }
408
Adrian Hunterb4f30a12015-02-06 14:12:52 +0200409 if (drv_type)
410 mmc_set_driver_type(card->host, drv_type);
Arindam Nathd6d50a12011-05-05 12:18:59 +0530411
412 return 0;
413}
414
Subhash Jadavani93c712f2011-08-09 12:19:31 +0530415static void sd_update_bus_speed_mode(struct mmc_card *card)
Arindam Nath49c468f2011-05-05 12:19:01 +0530416{
Arindam Nath49c468f2011-05-05 12:19:01 +0530417 /*
418 * If the host doesn't support any of the UHS-I modes, fallback on
419 * default speed.
420 */
Johan Rudholm3f8a7fa2013-01-28 15:08:24 +0100421 if (!mmc_host_uhs(card->host)) {
Subhash Jadavani93c712f2011-08-09 12:19:31 +0530422 card->sd_bus_speed = 0;
423 return;
424 }
Arindam Nath49c468f2011-05-05 12:19:01 +0530425
426 if ((card->host->caps & MMC_CAP_UHS_SDR104) &&
427 (card->sw_caps.sd3_bus_mode & SD_MODE_UHS_SDR104)) {
Subhash Jadavani93c712f2011-08-09 12:19:31 +0530428 card->sd_bus_speed = UHS_SDR104_BUS_SPEED;
Arindam Nath49c468f2011-05-05 12:19:01 +0530429 } else if ((card->host->caps & MMC_CAP_UHS_DDR50) &&
430 (card->sw_caps.sd3_bus_mode & SD_MODE_UHS_DDR50)) {
Subhash Jadavani93c712f2011-08-09 12:19:31 +0530431 card->sd_bus_speed = UHS_DDR50_BUS_SPEED;
Arindam Nath49c468f2011-05-05 12:19:01 +0530432 } 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)) {
Subhash Jadavani93c712f2011-08-09 12:19:31 +0530435 card->sd_bus_speed = UHS_SDR50_BUS_SPEED;
Arindam Nath49c468f2011-05-05 12:19:01 +0530436 } 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)) {
Subhash Jadavani93c712f2011-08-09 12:19:31 +0530439 card->sd_bus_speed = UHS_SDR25_BUS_SPEED;
Arindam Nath49c468f2011-05-05 12:19:01 +0530440 } 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)) {
Subhash Jadavani93c712f2011-08-09 12:19:31 +0530444 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;
Arindam Nath49c468f2011-05-05 12:19:01 +0530476 }
477
Subhash Jadavani93c712f2011-08-09 12:19:31 +0530478 err = mmc_sd_switch(card, 1, 0, card->sd_bus_speed, status);
Arindam Nath49c468f2011-05-05 12:19:01 +0530479 if (err)
480 return err;
481
Subhash Jadavani93c712f2011-08-09 12:19:31 +0530482 if ((status[16] & 0xF) != card->sd_bus_speed)
Joe Perches66061102014-09-12 14:56:56 -0700483 pr_warn("%s: Problem setting bus speed mode!\n",
Arindam Nath49c468f2011-05-05 12:19:01 +0530484 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
Aaron Lu55c46652012-07-04 13:31:48 +0800493/* 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
Arindam Nath5371c922011-05-05 12:19:02 +0530518static int sd_set_current_limit(struct mmc_card *card, u8 *status)
519{
Philip Rakity0aa67702012-05-27 18:36:33 -0700520 int current_limit = SD_SET_CURRENT_NO_CHANGE;
Arindam Nath5371c922011-05-05 12:19:02 +0530521 int err;
Aaron Lu55c46652012-07-04 13:31:48 +0800522 u32 max_current;
Arindam Nath5371c922011-05-05 12:19:02 +0530523
524 /*
525 * Current limit switch is only defined for SDR50, SDR104, and DDR50
Philip Rakity0aa67702012-05-27 18:36:33 -0700526 * bus speed modes. For other bus speed modes, we do not change the
527 * current limit.
Aaron Lu55c46652012-07-04 13:31:48 +0800528 */
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 /*
Aaron Lua39ca6ae2012-07-03 14:16:11 +0800541 * 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.
Russell Kingd9812782016-01-02 10:06:29 +0000547 *
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
Arindam Nath5371c922011-05-05 12:19:02 +0530554 */
Russell Kingd9812782016-01-02 10:06:29 +0000555 if (max_current >= 800 &&
556 card->sw_caps.sd3_curr_limit & SD_MAX_CURRENT_800)
Aaron Lu55c46652012-07-04 13:31:48 +0800557 current_limit = SD_SET_CURRENT_LIMIT_800;
Russell Kingd9812782016-01-02 10:06:29 +0000558 else if (max_current >= 600 &&
559 card->sw_caps.sd3_curr_limit & SD_MAX_CURRENT_600)
Aaron Lu55c46652012-07-04 13:31:48 +0800560 current_limit = SD_SET_CURRENT_LIMIT_600;
Russell Kingd9812782016-01-02 10:06:29 +0000561 else if (max_current >= 400 &&
562 card->sw_caps.sd3_curr_limit & SD_MAX_CURRENT_400)
Aaron Lu55c46652012-07-04 13:31:48 +0800563 current_limit = SD_SET_CURRENT_LIMIT_400;
Russell Kingd9812782016-01-02 10:06:29 +0000564 else if (max_current >= 200 &&
565 card->sw_caps.sd3_curr_limit & SD_MAX_CURRENT_200)
Aaron Lu55c46652012-07-04 13:31:48 +0800566 current_limit = SD_SET_CURRENT_LIMIT_200;
Arindam Nath5371c922011-05-05 12:19:02 +0530567
Philip Rakity0aa67702012-05-27 18:36:33 -0700568 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;
Arindam Nath5371c922011-05-05 12:19:02 +0530572
Philip Rakity0aa67702012-05-27 18:36:33 -0700573 if (((status[15] >> 4) & 0x0F) != current_limit)
Joe Perches66061102014-09-12 14:56:56 -0700574 pr_warn("%s: Problem setting current limit!\n",
Philip Rakity0aa67702012-05-27 18:36:33 -0700575 mmc_hostname(card->host));
Arindam Nath5371c922011-05-05 12:19:02 +0530576
Philip Rakity0aa67702012-05-27 18:36:33 -0700577 }
Aaron Lua39ca6ae2012-07-03 14:16:11 +0800578
Arindam Nath5371c922011-05-05 12:19:02 +0530579 return 0;
580}
581
Arindam Nathd6d50a12011-05-05 12:18:59 +0530582/*
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) {
Girish K Sa3c76eb2011-10-11 11:44:09 +0530598 pr_err("%s: could not allocate a buffer for "
Arindam Nathd6d50a12011-05-05 12:18:59 +0530599 "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
Subhash Jadavani93c712f2011-08-09 12:19:31 +0530613 /*
614 * Select the bus speed mode depending on host
615 * and card capability.
616 */
617 sd_update_bus_speed_mode(card);
618
Arindam Nathd6d50a12011-05-05 12:18:59 +0530619 /* Set the driver strength for the card */
620 err = sd_select_driver_type(card, status);
Arindam Nath49c468f2011-05-05 12:19:01 +0530621 if (err)
622 goto out;
623
Subhash Jadavani93c712f2011-08-09 12:19:31 +0530624 /* Set current limit for the card */
625 err = sd_set_current_limit(card, status);
Arindam Nath5371c922011-05-05 12:19:02 +0530626 if (err)
627 goto out;
628
Subhash Jadavani93c712f2011-08-09 12:19:31 +0530629 /* Set bus speed mode of the card */
630 err = sd_set_bus_speed_mode(card, status);
Arindam Nathb513ea22011-05-05 12:19:04 +0530631 if (err)
632 goto out;
633
Fredrik Soderstedt810e08e2013-04-17 13:50:53 +0200634 /*
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 */
Adrian Hunter63e415c2014-12-05 19:40:59 +0200638 if (!mmc_host_is_spi(card->host) &&
Carlo Caionee10c3212016-01-13 09:36:55 +0100639 (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)) {
Adrian Hunter63e415c2014-12-05 19:40:59 +0200642 err = mmc_execute_tuning(card);
Weijun Yang4324f6d2015-10-04 12:04:11 +0000643
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 */
Carlo Caionee10c3212016-01-13 09:36:55 +0100651 if (err && card->host->ios.timing == MMC_TIMING_UHS_DDR50) {
Weijun Yang4324f6d2015-10-04 12:04:11 +0000652 pr_warn("%s: ddr50 tuning failed\n",
653 mmc_hostname(card->host));
654 err = 0;
655 }
656 }
657
Arindam Nathd6d50a12011-05-05 12:18:59 +0530658out:
659 kfree(status);
660
661 return err;
662}
663
Pierre Ossman51ec92e2008-03-21 23:54:50 +0100664MMC_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]);
Uri Yanai5275a652016-08-14 11:46:36 +0300669MMC_DEV_ATTR(ssr,
670 "%08x%08x%08x%08x%08x%08x%08x%08x%08x%08x%08x%08x%08x%08x%08x%08x\n",
671 card->raw_ssr[0], card->raw_ssr[1], card->raw_ssr[2],
672 card->raw_ssr[3], card->raw_ssr[4], card->raw_ssr[5],
673 card->raw_ssr[6], card->raw_ssr[7], card->raw_ssr[8],
674 card->raw_ssr[9], card->raw_ssr[10], card->raw_ssr[11],
675 card->raw_ssr[12], card->raw_ssr[13], card->raw_ssr[14],
676 card->raw_ssr[15]);
Pierre Ossman51ec92e2008-03-21 23:54:50 +0100677MMC_DEV_ATTR(date, "%02d/%04d\n", card->cid.month, card->cid.year);
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700678MMC_DEV_ATTR(erase_size, "%u\n", card->erase_size << 9);
679MMC_DEV_ATTR(preferred_erase_size, "%u\n", card->pref_erase << 9);
Pierre Ossman51ec92e2008-03-21 23:54:50 +0100680MMC_DEV_ATTR(fwrev, "0x%x\n", card->cid.fwrev);
681MMC_DEV_ATTR(hwrev, "0x%x\n", card->cid.hwrev);
682MMC_DEV_ATTR(manfid, "0x%06x\n", card->cid.manfid);
683MMC_DEV_ATTR(name, "%s\n", card->cid.prod_name);
684MMC_DEV_ATTR(oemid, "0x%04x\n", card->cid.oemid);
685MMC_DEV_ATTR(serial, "0x%08x\n", card->cid.serial);
Bastian Stenderc814d672017-11-28 09:24:07 +0100686MMC_DEV_ATTR(ocr, "0x%08x\n", card->ocr);
Pierre Ossman51ec92e2008-03-21 23:54:50 +0100687
688
Bojan Prtvar6825a602016-07-19 11:16:38 +0200689static ssize_t mmc_dsr_show(struct device *dev,
690 struct device_attribute *attr,
691 char *buf)
692{
693 struct mmc_card *card = mmc_dev_to_card(dev);
694 struct mmc_host *host = card->host;
695
696 if (card->csd.dsr_imp && host->dsr_req)
697 return sprintf(buf, "0x%x\n", host->dsr);
698 else
699 /* return default DSR value */
700 return sprintf(buf, "0x%x\n", 0x404);
701}
702
703static DEVICE_ATTR(dsr, S_IRUGO, mmc_dsr_show, NULL);
704
Pierre Ossman51ec92e2008-03-21 23:54:50 +0100705static struct attribute *sd_std_attrs[] = {
706 &dev_attr_cid.attr,
707 &dev_attr_csd.attr,
708 &dev_attr_scr.attr,
Uri Yanai5275a652016-08-14 11:46:36 +0300709 &dev_attr_ssr.attr,
Pierre Ossman51ec92e2008-03-21 23:54:50 +0100710 &dev_attr_date.attr,
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700711 &dev_attr_erase_size.attr,
712 &dev_attr_preferred_erase_size.attr,
Pierre Ossman51ec92e2008-03-21 23:54:50 +0100713 &dev_attr_fwrev.attr,
714 &dev_attr_hwrev.attr,
715 &dev_attr_manfid.attr,
716 &dev_attr_name.attr,
717 &dev_attr_oemid.attr,
718 &dev_attr_serial.attr,
Bojan Prtvar5fb06af2016-07-04 13:56:55 +0200719 &dev_attr_ocr.attr,
Bojan Prtvar6825a602016-07-19 11:16:38 +0200720 &dev_attr_dsr.attr,
Pierre Ossman51ec92e2008-03-21 23:54:50 +0100721 NULL,
722};
Axel Lind1e58212014-03-08 15:05:27 +0800723ATTRIBUTE_GROUPS(sd_std);
Pierre Ossman51ec92e2008-03-21 23:54:50 +0100724
Michal Miroslaw71578a12010-08-10 18:01:40 -0700725struct device_type sd_type = {
Axel Lind1e58212014-03-08 15:05:27 +0800726 .groups = sd_std_groups,
Pierre Ossman51ec92e2008-03-21 23:54:50 +0100727};
728
Pierre Ossman7ea239d2006-12-31 00:11:32 +0100729/*
Michal Miroslaw71578a12010-08-10 18:01:40 -0700730 * Fetch CID from card.
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200731 */
Arindam Nathd6d50a12011-05-05 12:18:59 +0530732int mmc_sd_get_cid(struct mmc_host *host, u32 ocr, u32 *cid, u32 *rocr)
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200733{
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200734 int err;
Aaron Lu55c46652012-07-04 13:31:48 +0800735 u32 max_current;
Johan Rudholm0797e5f2013-01-28 15:08:28 +0100736 int retries = 10;
Ulf Hansson69041152013-09-13 11:31:33 +0200737 u32 pocr = ocr;
Johan Rudholm0797e5f2013-01-28 15:08:28 +0100738
739try_again:
740 if (!retries) {
741 ocr &= ~SD_OCR_S18R;
Joe Perches66061102014-09-12 14:56:56 -0700742 pr_warn("%s: Skipping voltage switch\n", mmc_hostname(host));
Johan Rudholm0797e5f2013-01-28 15:08:28 +0100743 }
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200744
745 /*
746 * Since we're changing the OCR value, we seem to
747 * need to tell some cards to go back to the idle
748 * state. We wait 1ms to give cards time to
749 * respond.
750 */
751 mmc_go_idle(host);
752
753 /*
754 * If SD_SEND_IF_COND indicates an SD 2.0
755 * compliant card and we should set bit 30
756 * of the ocr to indicate that we can handle
757 * block-addressed SDHC cards.
758 */
759 err = mmc_send_if_cond(host, ocr);
Pierre Ossman17b04292007-07-22 22:18:46 +0200760 if (!err)
Arindam Nathf2119df2011-05-05 12:18:57 +0530761 ocr |= SD_OCR_CCS;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200762
Arindam Nathf2119df2011-05-05 12:18:57 +0530763 /*
764 * If the host supports one of UHS-I modes, request the card
Johan Rudholm0797e5f2013-01-28 15:08:28 +0100765 * to switch to 1.8V signaling level. If the card has failed
766 * repeatedly to switch however, skip this.
Arindam Nathf2119df2011-05-05 12:18:57 +0530767 */
Johan Rudholm0797e5f2013-01-28 15:08:28 +0100768 if (retries && mmc_host_uhs(host))
Arindam Nathf2119df2011-05-05 12:18:57 +0530769 ocr |= SD_OCR_S18R;
770
Aaron Lu55c46652012-07-04 13:31:48 +0800771 /*
772 * If the host can supply more than 150mA at current voltage,
773 * XPC should be set to 1.
774 */
775 max_current = sd_get_host_max_current(host);
776 if (max_current > 150)
Arindam Nathf2119df2011-05-05 12:18:57 +0530777 ocr |= SD_OCR_XPC;
778
Arindam Nathd6d50a12011-05-05 12:18:59 +0530779 err = mmc_send_app_op_cond(host, ocr, rocr);
Pierre Ossman17b04292007-07-22 22:18:46 +0200780 if (err)
Michal Miroslaw71578a12010-08-10 18:01:40 -0700781 return err;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200782
Arindam Nathf2119df2011-05-05 12:18:57 +0530783 /*
784 * In case CCS and S18A in the response is set, start Signal Voltage
785 * Switch procedure. SPI mode doesn't support CMD11.
786 */
Arindam Nathd6d50a12011-05-05 12:18:59 +0530787 if (!mmc_host_is_spi(host) && rocr &&
788 ((*rocr & 0x41000000) == 0x41000000)) {
Ulf Hansson0f791fd2013-09-12 15:36:34 +0200789 err = mmc_set_signal_voltage(host, MMC_SIGNAL_VOLTAGE_180,
Ulf Hansson69041152013-09-13 11:31:33 +0200790 pocr);
Johan Rudholm0797e5f2013-01-28 15:08:28 +0100791 if (err == -EAGAIN) {
792 retries--;
793 goto try_again;
794 } else if (err) {
795 retries = 0;
Arindam Nathf2119df2011-05-05 12:18:57 +0530796 goto try_again;
797 }
798 }
799
David Brownellaf517152007-08-08 09:11:32 -0700800 if (mmc_host_is_spi(host))
801 err = mmc_send_cid(host, cid);
802 else
803 err = mmc_all_send_cid(host, cid);
Michal Miroslaw71578a12010-08-10 18:01:40 -0700804
805 return err;
806}
807
808int mmc_sd_get_csd(struct mmc_host *host, struct mmc_card *card)
809{
810 int err;
811
812 /*
813 * Fetch CSD from card.
814 */
815 err = mmc_send_csd(card, card->raw_csd);
Pierre Ossman17b04292007-07-22 22:18:46 +0200816 if (err)
Michal Miroslaw71578a12010-08-10 18:01:40 -0700817 return err;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200818
Michal Miroslaw71578a12010-08-10 18:01:40 -0700819 err = mmc_decode_csd(card);
820 if (err)
821 return err;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200822
Michal Miroslaw71578a12010-08-10 18:01:40 -0700823 return 0;
824}
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200825
Lars-Peter Clausen9f6e0bf2015-05-06 20:31:19 +0200826static int mmc_sd_get_ro(struct mmc_host *host)
827{
828 int ro;
829
830 /*
831 * Some systems don't feature a write-protect pin and don't need one.
832 * E.g. because they only have micro-SD card slot. For those systems
833 * assume that the SD card is always read-write.
834 */
835 if (host->caps2 & MMC_CAP2_NO_WRITE_PROTECT)
836 return 0;
837
838 if (!host->ops->get_ro)
839 return -1;
840
Lars-Peter Clausen9f6e0bf2015-05-06 20:31:19 +0200841 ro = host->ops->get_ro(host);
Lars-Peter Clausen9f6e0bf2015-05-06 20:31:19 +0200842
843 return ro;
844}
845
Michal Miroslaw71578a12010-08-10 18:01:40 -0700846int mmc_sd_setup_card(struct mmc_host *host, struct mmc_card *card,
847 bool reinit)
848{
849 int err;
San Mehat6bb7b602008-11-11 09:35:36 -0800850#ifdef CONFIG_MMC_PARANOID_SD_INIT
851 int retries;
852#endif
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200853
Michal Miroslaw71578a12010-08-10 18:01:40 -0700854 if (!reinit) {
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200855 /*
856 * Fetch SCR from card.
857 */
858 err = mmc_app_send_scr(card, card->raw_scr);
Pierre Ossman17b04292007-07-22 22:18:46 +0200859 if (err)
Michal Miroslaw71578a12010-08-10 18:01:40 -0700860 return err;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200861
Pierre Ossmanbd766312007-05-01 16:11:57 +0200862 err = mmc_decode_scr(card);
Michal Miroslaw71578a12010-08-10 18:01:40 -0700863 if (err)
864 return err;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200865
866 /*
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700867 * Fetch and process SD Status register.
868 */
869 err = mmc_read_ssr(card);
870 if (err)
871 return err;
872
873 /* Erase init depends on CSD and SSR */
874 mmc_init_erase(card);
875
876 /*
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200877 * Fetch switch information from card.
878 */
San Mehat6bb7b602008-11-11 09:35:36 -0800879#ifdef CONFIG_MMC_PARANOID_SD_INIT
880 for (retries = 1; retries <= 3; retries++) {
881 err = mmc_read_switch(card);
882 if (!err) {
883 if (retries > 1) {
884 printk(KERN_WARNING
885 "%s: recovered\n",
886 mmc_hostname(host));
887 }
888 break;
889 } else {
890 printk(KERN_WARNING
891 "%s: read switch failed (attempt %d)\n",
892 mmc_hostname(host), retries);
893 }
894 }
895#else
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200896 err = mmc_read_switch(card);
San Mehat6bb7b602008-11-11 09:35:36 -0800897#endif
898
Pierre Ossman17b04292007-07-22 22:18:46 +0200899 if (err)
Michal Miroslaw71578a12010-08-10 18:01:40 -0700900 return err;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200901 }
902
903 /*
Wolfgang Muees9d9f25c2009-04-07 14:48:16 +0100904 * For SPI, enable CRC as appropriate.
905 * This CRC enable is located AFTER the reading of the
906 * card registers because some SDHC cards are not able
907 * to provide valid CRCs for non-512-byte blocks.
908 */
909 if (mmc_host_is_spi(host)) {
910 err = mmc_spi_set_crc(host, use_spi_crc);
911 if (err)
Michal Miroslaw71578a12010-08-10 18:01:40 -0700912 return err;
Wolfgang Muees9d9f25c2009-04-07 14:48:16 +0100913 }
914
915 /*
Michal Miroslaw71578a12010-08-10 18:01:40 -0700916 * Check if read-only switch is active.
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200917 */
Michal Miroslaw71578a12010-08-10 18:01:40 -0700918 if (!reinit) {
Lars-Peter Clausen9f6e0bf2015-05-06 20:31:19 +0200919 int ro = mmc_sd_get_ro(host);
Michal Miroslaw71578a12010-08-10 18:01:40 -0700920
921 if (ro < 0) {
Joe Perches66061102014-09-12 14:56:56 -0700922 pr_warn("%s: host does not support reading read-only switch, assuming write-enable\n",
Michal Miroslaw71578a12010-08-10 18:01:40 -0700923 mmc_hostname(host));
924 } else if (ro > 0) {
925 mmc_card_set_readonly(card);
926 }
927 }
928
929 return 0;
930}
931
932unsigned mmc_sd_get_max_clock(struct mmc_card *card)
933{
934 unsigned max_dtr = (unsigned int)-1;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200935
Seungwon Jeoncdc99172014-04-23 17:07:35 +0900936 if (mmc_card_hs(card)) {
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200937 if (max_dtr > card->sw_caps.hs_max_dtr)
938 max_dtr = card->sw_caps.hs_max_dtr;
939 } else if (max_dtr > card->csd.max_dtr) {
940 max_dtr = card->csd.max_dtr;
941 }
942
Michal Miroslaw71578a12010-08-10 18:01:40 -0700943 return max_dtr;
944}
945
Michal Miroslaw71578a12010-08-10 18:01:40 -0700946/*
947 * Handle the detection and initialisation of a card.
948 *
949 * In the case of a resume, "oldcard" will contain the card
950 * we're trying to reinitialise.
951 */
952static int mmc_sd_init_card(struct mmc_host *host, u32 ocr,
953 struct mmc_card *oldcard)
954{
955 struct mmc_card *card;
956 int err;
957 u32 cid[4];
Arindam Nathd6d50a12011-05-05 12:18:59 +0530958 u32 rocr = 0;
Michal Miroslaw71578a12010-08-10 18:01:40 -0700959
960 BUG_ON(!host);
961 WARN_ON(!host->claimed);
962
Arindam Nathd6d50a12011-05-05 12:18:59 +0530963 err = mmc_sd_get_cid(host, ocr, cid, &rocr);
Michal Miroslaw71578a12010-08-10 18:01:40 -0700964 if (err)
965 return err;
966
967 if (oldcard) {
968 if (memcmp(cid, oldcard->raw_cid, sizeof(cid)) != 0)
969 return -ENOENT;
970
971 card = oldcard;
972 } else {
973 /*
974 * Allocate card structure.
975 */
976 card = mmc_alloc_card(host, &sd_type);
977 if (IS_ERR(card))
978 return PTR_ERR(card);
979
Ulf Hansson69041152013-09-13 11:31:33 +0200980 card->ocr = ocr;
Michal Miroslaw71578a12010-08-10 18:01:40 -0700981 card->type = MMC_TYPE_SD;
982 memcpy(card->raw_cid, cid, sizeof(card->raw_cid));
983 }
984
985 /*
Doug Andersoneac86322014-12-02 15:42:45 -0800986 * Call the optional HC's init_card function to handle quirks.
987 */
988 if (host->ops->init_card)
989 host->ops->init_card(host, card);
990
991 /*
Michal Miroslaw71578a12010-08-10 18:01:40 -0700992 * For native busses: get card RCA and quit open drain mode.
993 */
994 if (!mmc_host_is_spi(host)) {
995 err = mmc_send_relative_addr(host, &card->rca);
996 if (err)
Wei WANG7fca9672013-07-17 14:21:10 +0800997 goto free_card;
Michal Miroslaw71578a12010-08-10 18:01:40 -0700998 }
999
1000 if (!oldcard) {
1001 err = mmc_sd_get_csd(host, card);
1002 if (err)
Wei WANG7fca9672013-07-17 14:21:10 +08001003 goto free_card;
Michal Miroslaw71578a12010-08-10 18:01:40 -07001004
1005 mmc_decode_cid(card);
1006 }
1007
1008 /*
Sascha Hauer3d705d12014-08-19 10:45:51 +02001009 * handling only for cards supporting DSR and hosts requesting
1010 * DSR configuration
1011 */
1012 if (card->csd.dsr_imp && host->dsr_req)
1013 mmc_set_dsr(host);
1014
1015 /*
Michal Miroslaw71578a12010-08-10 18:01:40 -07001016 * Select card, as all following commands rely on that.
1017 */
1018 if (!mmc_host_is_spi(host)) {
1019 err = mmc_select_card(card);
1020 if (err)
Wei WANG7fca9672013-07-17 14:21:10 +08001021 goto free_card;
Michal Miroslaw71578a12010-08-10 18:01:40 -07001022 }
1023
1024 err = mmc_sd_setup_card(host, card, oldcard != NULL);
1025 if (err)
1026 goto free_card;
1027
Arindam Nathd6d50a12011-05-05 12:18:59 +05301028 /* Initialization sequence for UHS-I cards */
1029 if (rocr & SD_ROCR_S18A) {
1030 err = mmc_sd_init_uhs_card(card);
Pierre Ossman17b04292007-07-22 22:18:46 +02001031 if (err)
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001032 goto free_card;
Arindam Nathd6d50a12011-05-05 12:18:59 +05301033 } else {
1034 /*
1035 * Attempt to change to high-speed (if supported)
1036 */
1037 err = mmc_sd_switch_hs(card);
1038 if (err > 0)
Seungwon Jeoncdc99172014-04-23 17:07:35 +09001039 mmc_set_timing(card->host, MMC_TIMING_SD_HS);
Arindam Nathd6d50a12011-05-05 12:18:59 +05301040 else if (err)
1041 goto free_card;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001042
Arindam Nathd6d50a12011-05-05 12:18:59 +05301043 /*
1044 * Set bus speed.
1045 */
1046 mmc_set_clock(host, mmc_sd_get_max_clock(card));
1047
1048 /*
1049 * Switch to wider bus (if supported).
1050 */
1051 if ((host->caps & MMC_CAP_4_BIT_DATA) &&
1052 (card->scr.bus_widths & SD_SCR_BUS_WIDTH_4)) {
1053 err = mmc_app_set_bus_width(card, MMC_BUS_WIDTH_4);
1054 if (err)
1055 goto free_card;
1056
1057 mmc_set_bus_width(host, MMC_BUS_WIDTH_4);
1058 }
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001059 }
1060
Michal Miroslaw71578a12010-08-10 18:01:40 -07001061 host->card = card;
Pierre Ossman17b04292007-07-22 22:18:46 +02001062 return 0;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001063
1064free_card:
1065 if (!oldcard)
1066 mmc_remove_card(card);
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001067
Pierre Ossmanadf66a02007-07-22 23:08:30 +02001068 return err;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001069}
1070
1071/*
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001072 * Host is being removed. Free up the current card.
1073 */
1074static void mmc_sd_remove(struct mmc_host *host)
1075{
1076 BUG_ON(!host);
1077 BUG_ON(!host->card);
1078
1079 mmc_remove_card(host->card);
1080 host->card = NULL;
1081}
1082
1083/*
Adrian Hunterd3049502011-11-28 16:22:00 +02001084 * Card detection - card is alive.
1085 */
1086static int mmc_sd_alive(struct mmc_host *host)
1087{
1088 return mmc_send_status(host->card, NULL);
1089}
1090
1091/*
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001092 * Card detection callback from host.
1093 */
1094static void mmc_sd_detect(struct mmc_host *host)
1095{
San Mehat0a3f5622008-12-04 11:18:00 -08001096 int err = 0;
1097#ifdef CONFIG_MMC_PARANOID_SD_INIT
1098 int retries = 5;
1099#endif
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001100
1101 BUG_ON(!host);
1102 BUG_ON(!host->card);
1103
Ulf Hanssone94cfef2013-05-02 14:02:38 +02001104 mmc_get_card(host->card);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001105
1106 /*
1107 * Just check if our card has been removed.
1108 */
San Mehat0a3f5622008-12-04 11:18:00 -08001109#ifdef CONFIG_MMC_PARANOID_SD_INIT
1110 while(retries) {
1111 err = mmc_send_status(host->card, NULL);
1112 if (err) {
1113 retries--;
1114 udelay(5);
1115 continue;
1116 }
1117 break;
1118 }
1119 if (!retries) {
1120 printk(KERN_ERR "%s(%s): Unable to re-detect card (%d)\n",
1121 __func__, mmc_hostname(host), err);
1122 }
1123#else
Adrian Hunterd3049502011-11-28 16:22:00 +02001124 err = _mmc_detect_card_removed(host);
San Mehat0a3f5622008-12-04 11:18:00 -08001125#endif
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001126
Ulf Hanssone94cfef2013-05-02 14:02:38 +02001127 mmc_put_card(host->card);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001128
Pierre Ossman17b04292007-07-22 22:18:46 +02001129 if (err) {
Pierre Ossman4101c162007-05-19 13:39:01 +02001130 mmc_sd_remove(host);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001131
1132 mmc_claim_host(host);
1133 mmc_detach_bus(host);
Ulf Hansson7f7e4122011-09-21 14:08:13 -04001134 mmc_power_off(host);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001135 mmc_release_host(host);
1136 }
1137}
1138
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001139static int _mmc_sd_suspend(struct mmc_host *host)
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001140{
Jaehoon Chung85e727e2012-05-31 20:31:47 +09001141 int err = 0;
1142
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001143 BUG_ON(!host);
1144 BUG_ON(!host->card);
1145
1146 mmc_claim_host(host);
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001147
1148 if (mmc_card_suspended(host->card))
1149 goto out;
1150
David Brownellaf517152007-08-08 09:11:32 -07001151 if (!mmc_host_is_spi(host))
Jaehoon Chung85e727e2012-05-31 20:31:47 +09001152 err = mmc_deselect_cards(host);
Seungwon Jeoncdc99172014-04-23 17:07:35 +09001153
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001154 if (!err) {
Ulf Hansson74590262013-06-10 17:03:38 +02001155 mmc_power_off(host);
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001156 mmc_card_set_suspended(host->card);
1157 }
Nicolas Pitre95cdfb72009-09-22 16:45:29 -07001158
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001159out:
1160 mmc_release_host(host);
Jaehoon Chung85e727e2012-05-31 20:31:47 +09001161 return err;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001162}
1163
1164/*
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001165 * Callback for suspend
1166 */
1167static int mmc_sd_suspend(struct mmc_host *host)
1168{
1169 int err;
1170
1171 err = _mmc_sd_suspend(host);
1172 if (!err) {
1173 pm_runtime_disable(&host->card->dev);
1174 pm_runtime_set_suspended(&host->card->dev);
1175 }
1176
1177 return err;
1178}
1179
1180/*
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001181 * This function tries to determine if the same card is still present
1182 * and, if so, restore all state to it.
1183 */
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001184static int _mmc_sd_resume(struct mmc_host *host)
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001185{
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001186 int err = 0;
San Mehat3d1bf522008-12-01 08:52:34 -08001187#ifdef CONFIG_MMC_PARANOID_SD_INIT
1188 int retries;
1189#endif
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001190
1191 BUG_ON(!host);
1192 BUG_ON(!host->card);
1193
1194 mmc_claim_host(host);
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001195
1196 if (!mmc_card_suspended(host->card))
1197 goto out;
1198
Ulf Hansson69041152013-09-13 11:31:33 +02001199 mmc_power_up(host, host->card->ocr);
San Mehat3d1bf522008-12-01 08:52:34 -08001200#ifdef CONFIG_MMC_PARANOID_SD_INIT
1201 retries = 5;
1202 while (retries) {
1203 err = mmc_sd_init_card(host, host->card->ocr, host->card);
1204
1205 if (err) {
1206 printk(KERN_ERR "%s: Re-init card rc = %d (retries = %d)\n",
1207 mmc_hostname(host), err, retries);
1208 mdelay(5);
1209 retries--;
1210 continue;
1211 }
1212 break;
1213 }
1214#else
Ulf Hansson69041152013-09-13 11:31:33 +02001215 err = mmc_sd_init_card(host, host->card->ocr, host->card);
San Mehat3d1bf522008-12-01 08:52:34 -08001216#endif
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001217 mmc_card_clr_suspended(host->card);
Pierre Ossman2986d0b2007-07-22 17:52:06 +02001218
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001219out:
1220 mmc_release_host(host);
Nicolas Pitre95cdfb72009-09-22 16:45:29 -07001221 return err;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001222}
1223
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001224/*
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001225 * Callback for resume
1226 */
1227static int mmc_sd_resume(struct mmc_host *host)
1228{
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001229 pm_runtime_enable(&host->card->dev);
Ulf Hanssonc29536e2015-11-05 16:01:32 +01001230 return 0;
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001231}
1232
1233/*
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001234 * Callback for runtime_suspend.
1235 */
1236static int mmc_sd_runtime_suspend(struct mmc_host *host)
1237{
1238 int err;
1239
1240 if (!(host->caps & MMC_CAP_AGGRESSIVE_PM))
1241 return 0;
1242
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001243 err = _mmc_sd_suspend(host);
Ulf Hansson0cc81a82013-10-03 11:24:44 +02001244 if (err)
Masanari Iidaf42cf8d2015-02-24 23:11:26 +09001245 pr_err("%s: error %d doing aggressive suspend\n",
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001246 mmc_hostname(host), err);
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001247
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001248 return err;
1249}
1250
1251/*
1252 * Callback for runtime_resume.
1253 */
1254static int mmc_sd_runtime_resume(struct mmc_host *host)
1255{
1256 int err;
1257
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001258 err = _mmc_sd_resume(host);
Adrian Hunter520322d2015-12-14 15:51:27 +02001259 if (err && err != -ENOMEDIUM)
Ulf Hanssonc29536e2015-11-05 16:01:32 +01001260 pr_err("%s: error %d doing runtime resume\n",
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001261 mmc_hostname(host), err);
1262
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001263 return 0;
1264}
1265
Johan Rudholmdc0ecfe2015-01-12 15:38:06 +01001266static int mmc_sd_reset(struct mmc_host *host)
1267{
1268 mmc_power_cycle(host, host->card->ocr);
Ulf Hansson3056c492015-06-01 11:14:58 +02001269 return mmc_sd_init_card(host, host->card->ocr, host->card);
Johan Rudholmdc0ecfe2015-01-12 15:38:06 +01001270}
1271
Adrian Hunter9feae242009-09-22 16:44:32 -07001272static const struct mmc_bus_ops mmc_sd_ops = {
1273 .remove = mmc_sd_remove,
1274 .detect = mmc_sd_detect,
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001275 .runtime_suspend = mmc_sd_runtime_suspend,
1276 .runtime_resume = mmc_sd_runtime_resume,
Adrian Hunter9feae242009-09-22 16:44:32 -07001277 .suspend = mmc_sd_suspend,
1278 .resume = mmc_sd_resume,
Adrian Hunterd3049502011-11-28 16:22:00 +02001279 .alive = mmc_sd_alive,
Ulf Hansson5992e782013-06-10 17:03:42 +02001280 .shutdown = mmc_sd_suspend,
Johan Rudholmdc0ecfe2015-01-12 15:38:06 +01001281 .reset = mmc_sd_reset,
Adrian Hunter9feae242009-09-22 16:44:32 -07001282};
1283
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001284/*
1285 * Starting point for SD card init.
1286 */
Andy Ross807e8e42011-01-03 10:36:56 -08001287int mmc_attach_sd(struct mmc_host *host)
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001288{
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001289 int err;
Ulf Hansson69041152013-09-13 11:31:33 +02001290 u32 ocr, rocr;
San Mehat0a3f5622008-12-04 11:18:00 -08001291#ifdef CONFIG_MMC_PARANOID_SD_INIT
1292 int retries;
1293#endif
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001294
1295 BUG_ON(!host);
Pierre Ossmand84075c82007-08-09 13:23:56 +02001296 WARN_ON(!host->claimed);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001297
Andy Ross807e8e42011-01-03 10:36:56 -08001298 err = mmc_send_app_op_cond(host, 0, &ocr);
1299 if (err)
1300 return err;
1301
Ulf Hansson2501c912013-10-30 01:00:18 +01001302 mmc_attach_bus(host, &mmc_sd_ops);
Takashi Iwai8f230f42010-12-08 10:04:30 +01001303 if (host->ocr_avail_sd)
1304 host->ocr_avail = host->ocr_avail_sd;
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001305
Philip Langdale55556da2007-03-16 19:39:00 -07001306 /*
David Brownellaf517152007-08-08 09:11:32 -07001307 * We need to get OCR a different way for SPI.
1308 */
1309 if (mmc_host_is_spi(host)) {
1310 mmc_go_idle(host);
1311
1312 err = mmc_spi_read_ocr(host, 0, &ocr);
1313 if (err)
1314 goto err;
1315 }
1316
Ulf Hansson69041152013-09-13 11:31:33 +02001317 rocr = mmc_select_voltage(host, ocr);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001318
1319 /*
1320 * Can we support the voltage(s) of the card(s)?
1321 */
Ulf Hansson69041152013-09-13 11:31:33 +02001322 if (!rocr) {
Pierre Ossman109b5be2007-07-23 00:12:10 +02001323 err = -EINVAL;
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001324 goto err;
Pierre Ossman109b5be2007-07-23 00:12:10 +02001325 }
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001326
1327 /*
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001328 * Detect and init the card.
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001329 */
San Mehat0a3f5622008-12-04 11:18:00 -08001330#ifdef CONFIG_MMC_PARANOID_SD_INIT
1331 retries = 5;
1332 while (retries) {
1333 err = mmc_sd_init_card(host, rocr, NULL);
1334 if (err) {
1335 retries--;
1336 continue;
1337 }
1338 break;
1339 }
1340
1341 if (!retries) {
1342 printk(KERN_ERR "%s: mmc_sd_init_card() failure (err = %d)\n",
1343 mmc_hostname(host), err);
1344 goto err;
1345 }
1346#else
Ulf Hansson69041152013-09-13 11:31:33 +02001347 err = mmc_sd_init_card(host, rocr, NULL);
Pierre Ossman17b04292007-07-22 22:18:46 +02001348 if (err)
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001349 goto err;
San Mehat0a3f5622008-12-04 11:18:00 -08001350#endif
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001351
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001352 mmc_release_host(host);
Pierre Ossman4101c162007-05-19 13:39:01 +02001353 err = mmc_add_card(host->card);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001354 if (err)
Pierre Ossman2986d0b2007-07-22 17:52:06 +02001355 goto remove_card;
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001356
Sergei Shtylyov2860d062015-10-14 23:53:03 +03001357 mmc_claim_host(host);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001358 return 0;
1359
Pierre Ossman2986d0b2007-07-22 17:52:06 +02001360remove_card:
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001361 mmc_remove_card(host->card);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001362 host->card = NULL;
Pierre Ossman2986d0b2007-07-22 17:52:06 +02001363 mmc_claim_host(host);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001364err:
1365 mmc_detach_bus(host);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001366
Girish K Sa3c76eb2011-10-11 11:44:09 +05301367 pr_err("%s: error %d whilst initialising SD card\n",
Pierre Ossman109b5be2007-07-23 00:12:10 +02001368 mmc_hostname(host), err);
1369
Pierre Ossmanadf66a02007-07-22 23:08:30 +02001370 return err;
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001371}