blob: f09148a4ab5574f34b91d4f4bbe9687375328f11 [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;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200850
Michal Miroslaw71578a12010-08-10 18:01:40 -0700851 if (!reinit) {
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200852 /*
853 * Fetch SCR from card.
854 */
855 err = mmc_app_send_scr(card, card->raw_scr);
Pierre Ossman17b04292007-07-22 22:18:46 +0200856 if (err)
Michal Miroslaw71578a12010-08-10 18:01:40 -0700857 return err;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200858
Pierre Ossmanbd766312007-05-01 16:11:57 +0200859 err = mmc_decode_scr(card);
Michal Miroslaw71578a12010-08-10 18:01:40 -0700860 if (err)
861 return err;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200862
863 /*
Adrian Hunterdfe86cb2010-08-11 14:17:46 -0700864 * Fetch and process SD Status register.
865 */
866 err = mmc_read_ssr(card);
867 if (err)
868 return err;
869
870 /* Erase init depends on CSD and SSR */
871 mmc_init_erase(card);
872
873 /*
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200874 * Fetch switch information from card.
875 */
876 err = mmc_read_switch(card);
Pierre Ossman17b04292007-07-22 22:18:46 +0200877 if (err)
Michal Miroslaw71578a12010-08-10 18:01:40 -0700878 return err;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200879 }
880
881 /*
Wolfgang Muees9d9f25c2009-04-07 14:48:16 +0100882 * For SPI, enable CRC as appropriate.
883 * This CRC enable is located AFTER the reading of the
884 * card registers because some SDHC cards are not able
885 * to provide valid CRCs for non-512-byte blocks.
886 */
887 if (mmc_host_is_spi(host)) {
888 err = mmc_spi_set_crc(host, use_spi_crc);
889 if (err)
Michal Miroslaw71578a12010-08-10 18:01:40 -0700890 return err;
Wolfgang Muees9d9f25c2009-04-07 14:48:16 +0100891 }
892
893 /*
Michal Miroslaw71578a12010-08-10 18:01:40 -0700894 * Check if read-only switch is active.
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200895 */
Michal Miroslaw71578a12010-08-10 18:01:40 -0700896 if (!reinit) {
Lars-Peter Clausen9f6e0bf2015-05-06 20:31:19 +0200897 int ro = mmc_sd_get_ro(host);
Michal Miroslaw71578a12010-08-10 18:01:40 -0700898
899 if (ro < 0) {
Joe Perches66061102014-09-12 14:56:56 -0700900 pr_warn("%s: host does not support reading read-only switch, assuming write-enable\n",
Michal Miroslaw71578a12010-08-10 18:01:40 -0700901 mmc_hostname(host));
902 } else if (ro > 0) {
903 mmc_card_set_readonly(card);
904 }
905 }
906
907 return 0;
908}
909
910unsigned mmc_sd_get_max_clock(struct mmc_card *card)
911{
912 unsigned max_dtr = (unsigned int)-1;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200913
Seungwon Jeoncdc99172014-04-23 17:07:35 +0900914 if (mmc_card_hs(card)) {
Pierre Ossman6abaa0c2007-05-01 16:00:02 +0200915 if (max_dtr > card->sw_caps.hs_max_dtr)
916 max_dtr = card->sw_caps.hs_max_dtr;
917 } else if (max_dtr > card->csd.max_dtr) {
918 max_dtr = card->csd.max_dtr;
919 }
920
Michal Miroslaw71578a12010-08-10 18:01:40 -0700921 return max_dtr;
922}
923
Michal Miroslaw71578a12010-08-10 18:01:40 -0700924/*
925 * Handle the detection and initialisation of a card.
926 *
927 * In the case of a resume, "oldcard" will contain the card
928 * we're trying to reinitialise.
929 */
930static int mmc_sd_init_card(struct mmc_host *host, u32 ocr,
931 struct mmc_card *oldcard)
932{
933 struct mmc_card *card;
934 int err;
935 u32 cid[4];
Arindam Nathd6d50a12011-05-05 12:18:59 +0530936 u32 rocr = 0;
Michal Miroslaw71578a12010-08-10 18:01:40 -0700937
938 BUG_ON(!host);
939 WARN_ON(!host->claimed);
940
Arindam Nathd6d50a12011-05-05 12:18:59 +0530941 err = mmc_sd_get_cid(host, ocr, cid, &rocr);
Michal Miroslaw71578a12010-08-10 18:01:40 -0700942 if (err)
943 return err;
944
945 if (oldcard) {
946 if (memcmp(cid, oldcard->raw_cid, sizeof(cid)) != 0)
947 return -ENOENT;
948
949 card = oldcard;
950 } else {
951 /*
952 * Allocate card structure.
953 */
954 card = mmc_alloc_card(host, &sd_type);
955 if (IS_ERR(card))
956 return PTR_ERR(card);
957
Ulf Hansson69041152013-09-13 11:31:33 +0200958 card->ocr = ocr;
Michal Miroslaw71578a12010-08-10 18:01:40 -0700959 card->type = MMC_TYPE_SD;
960 memcpy(card->raw_cid, cid, sizeof(card->raw_cid));
961 }
962
963 /*
Doug Andersoneac86322014-12-02 15:42:45 -0800964 * Call the optional HC's init_card function to handle quirks.
965 */
966 if (host->ops->init_card)
967 host->ops->init_card(host, card);
968
969 /*
Michal Miroslaw71578a12010-08-10 18:01:40 -0700970 * For native busses: get card RCA and quit open drain mode.
971 */
972 if (!mmc_host_is_spi(host)) {
973 err = mmc_send_relative_addr(host, &card->rca);
974 if (err)
Wei WANG7fca9672013-07-17 14:21:10 +0800975 goto free_card;
Michal Miroslaw71578a12010-08-10 18:01:40 -0700976 }
977
978 if (!oldcard) {
979 err = mmc_sd_get_csd(host, card);
980 if (err)
Wei WANG7fca9672013-07-17 14:21:10 +0800981 goto free_card;
Michal Miroslaw71578a12010-08-10 18:01:40 -0700982
983 mmc_decode_cid(card);
984 }
985
986 /*
Sascha Hauer3d705d12014-08-19 10:45:51 +0200987 * handling only for cards supporting DSR and hosts requesting
988 * DSR configuration
989 */
990 if (card->csd.dsr_imp && host->dsr_req)
991 mmc_set_dsr(host);
992
993 /*
Michal Miroslaw71578a12010-08-10 18:01:40 -0700994 * Select card, as all following commands rely on that.
995 */
996 if (!mmc_host_is_spi(host)) {
997 err = mmc_select_card(card);
998 if (err)
Wei WANG7fca9672013-07-17 14:21:10 +0800999 goto free_card;
Michal Miroslaw71578a12010-08-10 18:01:40 -07001000 }
1001
1002 err = mmc_sd_setup_card(host, card, oldcard != NULL);
1003 if (err)
1004 goto free_card;
1005
Arindam Nathd6d50a12011-05-05 12:18:59 +05301006 /* Initialization sequence for UHS-I cards */
1007 if (rocr & SD_ROCR_S18A) {
1008 err = mmc_sd_init_uhs_card(card);
Pierre Ossman17b04292007-07-22 22:18:46 +02001009 if (err)
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001010 goto free_card;
Arindam Nathd6d50a12011-05-05 12:18:59 +05301011 } else {
1012 /*
1013 * Attempt to change to high-speed (if supported)
1014 */
1015 err = mmc_sd_switch_hs(card);
1016 if (err > 0)
Seungwon Jeoncdc99172014-04-23 17:07:35 +09001017 mmc_set_timing(card->host, MMC_TIMING_SD_HS);
Arindam Nathd6d50a12011-05-05 12:18:59 +05301018 else if (err)
1019 goto free_card;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001020
Arindam Nathd6d50a12011-05-05 12:18:59 +05301021 /*
1022 * Set bus speed.
1023 */
1024 mmc_set_clock(host, mmc_sd_get_max_clock(card));
1025
1026 /*
1027 * Switch to wider bus (if supported).
1028 */
1029 if ((host->caps & MMC_CAP_4_BIT_DATA) &&
1030 (card->scr.bus_widths & SD_SCR_BUS_WIDTH_4)) {
1031 err = mmc_app_set_bus_width(card, MMC_BUS_WIDTH_4);
1032 if (err)
1033 goto free_card;
1034
1035 mmc_set_bus_width(host, MMC_BUS_WIDTH_4);
1036 }
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001037 }
1038
Michal Miroslaw71578a12010-08-10 18:01:40 -07001039 host->card = card;
Pierre Ossman17b04292007-07-22 22:18:46 +02001040 return 0;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001041
1042free_card:
1043 if (!oldcard)
1044 mmc_remove_card(card);
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001045
Pierre Ossmanadf66a02007-07-22 23:08:30 +02001046 return err;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001047}
1048
1049/*
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001050 * Host is being removed. Free up the current card.
1051 */
1052static void mmc_sd_remove(struct mmc_host *host)
1053{
1054 BUG_ON(!host);
1055 BUG_ON(!host->card);
1056
1057 mmc_remove_card(host->card);
1058 host->card = NULL;
1059}
1060
1061/*
Adrian Hunterd3049502011-11-28 16:22:00 +02001062 * Card detection - card is alive.
1063 */
1064static int mmc_sd_alive(struct mmc_host *host)
1065{
1066 return mmc_send_status(host->card, NULL);
1067}
1068
1069/*
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001070 * Card detection callback from host.
1071 */
1072static void mmc_sd_detect(struct mmc_host *host)
1073{
1074 int err;
1075
1076 BUG_ON(!host);
1077 BUG_ON(!host->card);
1078
Ulf Hanssone94cfef2013-05-02 14:02:38 +02001079 mmc_get_card(host->card);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001080
1081 /*
1082 * Just check if our card has been removed.
1083 */
Adrian Hunterd3049502011-11-28 16:22:00 +02001084 err = _mmc_detect_card_removed(host);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001085
Ulf Hanssone94cfef2013-05-02 14:02:38 +02001086 mmc_put_card(host->card);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001087
Pierre Ossman17b04292007-07-22 22:18:46 +02001088 if (err) {
Pierre Ossman4101c162007-05-19 13:39:01 +02001089 mmc_sd_remove(host);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001090
1091 mmc_claim_host(host);
1092 mmc_detach_bus(host);
Ulf Hansson7f7e4122011-09-21 14:08:13 -04001093 mmc_power_off(host);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001094 mmc_release_host(host);
1095 }
1096}
1097
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001098static int _mmc_sd_suspend(struct mmc_host *host)
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001099{
Jaehoon Chung85e727e2012-05-31 20:31:47 +09001100 int err = 0;
1101
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001102 BUG_ON(!host);
1103 BUG_ON(!host->card);
1104
1105 mmc_claim_host(host);
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001106
1107 if (mmc_card_suspended(host->card))
1108 goto out;
1109
David Brownellaf517152007-08-08 09:11:32 -07001110 if (!mmc_host_is_spi(host))
Jaehoon Chung85e727e2012-05-31 20:31:47 +09001111 err = mmc_deselect_cards(host);
Seungwon Jeoncdc99172014-04-23 17:07:35 +09001112
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001113 if (!err) {
Ulf Hansson74590262013-06-10 17:03:38 +02001114 mmc_power_off(host);
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001115 mmc_card_set_suspended(host->card);
1116 }
Nicolas Pitre95cdfb72009-09-22 16:45:29 -07001117
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001118out:
1119 mmc_release_host(host);
Jaehoon Chung85e727e2012-05-31 20:31:47 +09001120 return err;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001121}
1122
1123/*
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001124 * Callback for suspend
1125 */
1126static int mmc_sd_suspend(struct mmc_host *host)
1127{
1128 int err;
1129
1130 err = _mmc_sd_suspend(host);
1131 if (!err) {
1132 pm_runtime_disable(&host->card->dev);
1133 pm_runtime_set_suspended(&host->card->dev);
1134 }
1135
1136 return err;
1137}
1138
1139/*
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001140 * This function tries to determine if the same card is still present
1141 * and, if so, restore all state to it.
1142 */
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001143static int _mmc_sd_resume(struct mmc_host *host)
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001144{
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001145 int err = 0;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001146
1147 BUG_ON(!host);
1148 BUG_ON(!host->card);
1149
1150 mmc_claim_host(host);
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001151
1152 if (!mmc_card_suspended(host->card))
1153 goto out;
1154
Ulf Hansson69041152013-09-13 11:31:33 +02001155 mmc_power_up(host, host->card->ocr);
Ulf Hansson69041152013-09-13 11:31:33 +02001156 err = mmc_sd_init_card(host, host->card->ocr, host->card);
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001157 mmc_card_clr_suspended(host->card);
Pierre Ossman2986d0b2007-07-22 17:52:06 +02001158
Ulf Hansson9ec775f2013-10-02 17:37:09 +02001159out:
1160 mmc_release_host(host);
Nicolas Pitre95cdfb72009-09-22 16:45:29 -07001161 return err;
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001162}
1163
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001164/*
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001165 * Callback for resume
1166 */
1167static int mmc_sd_resume(struct mmc_host *host)
1168{
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001169 pm_runtime_enable(&host->card->dev);
Ulf Hanssonc29536e2015-11-05 16:01:32 +01001170 return 0;
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001171}
1172
1173/*
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001174 * Callback for runtime_suspend.
1175 */
1176static int mmc_sd_runtime_suspend(struct mmc_host *host)
1177{
1178 int err;
1179
1180 if (!(host->caps & MMC_CAP_AGGRESSIVE_PM))
1181 return 0;
1182
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001183 err = _mmc_sd_suspend(host);
Ulf Hansson0cc81a82013-10-03 11:24:44 +02001184 if (err)
Masanari Iidaf42cf8d2015-02-24 23:11:26 +09001185 pr_err("%s: error %d doing aggressive suspend\n",
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001186 mmc_hostname(host), err);
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001187
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001188 return err;
1189}
1190
1191/*
1192 * Callback for runtime_resume.
1193 */
1194static int mmc_sd_runtime_resume(struct mmc_host *host)
1195{
1196 int err;
1197
Ulf Hansson0cb403a2013-10-10 14:20:05 +02001198 err = _mmc_sd_resume(host);
Adrian Hunter520322d2015-12-14 15:51:27 +02001199 if (err && err != -ENOMEDIUM)
Ulf Hanssonc29536e2015-11-05 16:01:32 +01001200 pr_err("%s: error %d doing runtime resume\n",
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001201 mmc_hostname(host), err);
1202
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001203 return 0;
1204}
1205
Johan Rudholmdc0ecfe2015-01-12 15:38:06 +01001206static int mmc_sd_reset(struct mmc_host *host)
1207{
1208 mmc_power_cycle(host, host->card->ocr);
Ulf Hansson3056c492015-06-01 11:14:58 +02001209 return mmc_sd_init_card(host, host->card->ocr, host->card);
Johan Rudholmdc0ecfe2015-01-12 15:38:06 +01001210}
1211
Adrian Hunter9feae242009-09-22 16:44:32 -07001212static const struct mmc_bus_ops mmc_sd_ops = {
1213 .remove = mmc_sd_remove,
1214 .detect = mmc_sd_detect,
Ulf Hanssonc4d770d2013-05-02 14:02:39 +02001215 .runtime_suspend = mmc_sd_runtime_suspend,
1216 .runtime_resume = mmc_sd_runtime_resume,
Adrian Hunter9feae242009-09-22 16:44:32 -07001217 .suspend = mmc_sd_suspend,
1218 .resume = mmc_sd_resume,
Adrian Hunterd3049502011-11-28 16:22:00 +02001219 .alive = mmc_sd_alive,
Ulf Hansson5992e782013-06-10 17:03:42 +02001220 .shutdown = mmc_sd_suspend,
Johan Rudholmdc0ecfe2015-01-12 15:38:06 +01001221 .reset = mmc_sd_reset,
Adrian Hunter9feae242009-09-22 16:44:32 -07001222};
1223
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001224/*
1225 * Starting point for SD card init.
1226 */
Andy Ross807e8e42011-01-03 10:36:56 -08001227int mmc_attach_sd(struct mmc_host *host)
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001228{
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001229 int err;
Ulf Hansson69041152013-09-13 11:31:33 +02001230 u32 ocr, rocr;
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001231
1232 BUG_ON(!host);
Pierre Ossmand84075c82007-08-09 13:23:56 +02001233 WARN_ON(!host->claimed);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001234
Andy Ross807e8e42011-01-03 10:36:56 -08001235 err = mmc_send_app_op_cond(host, 0, &ocr);
1236 if (err)
1237 return err;
1238
Ulf Hansson2501c912013-10-30 01:00:18 +01001239 mmc_attach_bus(host, &mmc_sd_ops);
Takashi Iwai8f230f42010-12-08 10:04:30 +01001240 if (host->ocr_avail_sd)
1241 host->ocr_avail = host->ocr_avail_sd;
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001242
Philip Langdale55556da2007-03-16 19:39:00 -07001243 /*
David Brownellaf517152007-08-08 09:11:32 -07001244 * We need to get OCR a different way for SPI.
1245 */
1246 if (mmc_host_is_spi(host)) {
1247 mmc_go_idle(host);
1248
1249 err = mmc_spi_read_ocr(host, 0, &ocr);
1250 if (err)
1251 goto err;
1252 }
1253
Ulf Hansson69041152013-09-13 11:31:33 +02001254 rocr = mmc_select_voltage(host, ocr);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001255
1256 /*
1257 * Can we support the voltage(s) of the card(s)?
1258 */
Ulf Hansson69041152013-09-13 11:31:33 +02001259 if (!rocr) {
Pierre Ossman109b5be2007-07-23 00:12:10 +02001260 err = -EINVAL;
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001261 goto err;
Pierre Ossman109b5be2007-07-23 00:12:10 +02001262 }
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001263
1264 /*
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001265 * Detect and init the card.
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001266 */
Ulf Hansson69041152013-09-13 11:31:33 +02001267 err = mmc_sd_init_card(host, rocr, NULL);
Pierre Ossman17b04292007-07-22 22:18:46 +02001268 if (err)
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001269 goto err;
1270
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001271 mmc_release_host(host);
Pierre Ossman4101c162007-05-19 13:39:01 +02001272 err = mmc_add_card(host->card);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001273 if (err)
Pierre Ossman2986d0b2007-07-22 17:52:06 +02001274 goto remove_card;
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001275
Sergei Shtylyov2860d062015-10-14 23:53:03 +03001276 mmc_claim_host(host);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001277 return 0;
1278
Pierre Ossman2986d0b2007-07-22 17:52:06 +02001279remove_card:
Pierre Ossman6abaa0c2007-05-01 16:00:02 +02001280 mmc_remove_card(host->card);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001281 host->card = NULL;
Pierre Ossman2986d0b2007-07-22 17:52:06 +02001282 mmc_claim_host(host);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001283err:
1284 mmc_detach_bus(host);
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001285
Girish K Sa3c76eb2011-10-11 11:44:09 +05301286 pr_err("%s: error %d whilst initialising SD card\n",
Pierre Ossman109b5be2007-07-23 00:12:10 +02001287 mmc_hostname(host), err);
1288
Pierre Ossmanadf66a02007-07-22 23:08:30 +02001289 return err;
Pierre Ossman7ea239d2006-12-31 00:11:32 +01001290}