mmc.c 18.3 KB
Newer Older
P
Pierre Ossman 已提交
1
/*
P
Pierre Ossman 已提交
2
 *  linux/drivers/mmc/core/mmc.c
P
Pierre Ossman 已提交
3 4 5 6 7 8 9 10 11 12 13
 *
 *  Copyright (C) 2003-2004 Russell King, All Rights Reserved.
 *  Copyright (C) 2005-2007 Pierre Ossman, All Rights Reserved.
 *  MMCv4 support Copyright (C) 2006 Philip Langdale, All Rights Reserved.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/err.h>
14
#include <linux/slab.h>
P
Pierre Ossman 已提交
15 16 17 18 19 20

#include <linux/mmc/host.h>
#include <linux/mmc/card.h>
#include <linux/mmc/mmc.h>

#include "core.h"
P
Pierre Ossman 已提交
21
#include "bus.h"
P
Pierre Ossman 已提交
22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59
#include "mmc_ops.h"

static const unsigned int tran_exp[] = {
	10000,		100000,		1000000,	10000000,
	0,		0,		0,		0
};

static const unsigned char tran_mant[] = {
	0,	10,	12,	13,	15,	20,	25,	30,
	35,	40,	45,	50,	55,	60,	70,	80,
};

static const unsigned int tacc_exp[] = {
	1,	10,	100,	1000,	10000,	100000,	1000000, 10000000,
};

static const unsigned int tacc_mant[] = {
	0,	10,	12,	13,	15,	20,	25,	30,
	35,	40,	45,	50,	55,	60,	70,	80,
};

#define UNSTUFF_BITS(resp,start,size)					\
	({								\
		const int __size = size;				\
		const u32 __mask = (__size < 32 ? 1 << __size : 0) - 1;	\
		const int __off = 3 - ((start) / 32);			\
		const int __shft = (start) & 31;			\
		u32 __res;						\
									\
		__res = resp[__off] >> __shft;				\
		if (__size + __shft > 32)				\
			__res |= resp[__off-1] << ((32 - __shft) % 32);	\
		__res & __mask;						\
	})

/*
 * Given the decoded CSD structure, decode the raw CID to our CID structure.
 */
P
Pierre Ossman 已提交
60
static int mmc_decode_cid(struct mmc_card *card)
P
Pierre Ossman 已提交
61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102
{
	u32 *resp = card->raw_cid;

	/*
	 * The selection of the format here is based upon published
	 * specs from sandisk and from what people have reported.
	 */
	switch (card->csd.mmca_vsn) {
	case 0: /* MMC v1.0 - v1.2 */
	case 1: /* MMC v1.4 */
		card->cid.manfid	= UNSTUFF_BITS(resp, 104, 24);
		card->cid.prod_name[0]	= UNSTUFF_BITS(resp, 96, 8);
		card->cid.prod_name[1]	= UNSTUFF_BITS(resp, 88, 8);
		card->cid.prod_name[2]	= UNSTUFF_BITS(resp, 80, 8);
		card->cid.prod_name[3]	= UNSTUFF_BITS(resp, 72, 8);
		card->cid.prod_name[4]	= UNSTUFF_BITS(resp, 64, 8);
		card->cid.prod_name[5]	= UNSTUFF_BITS(resp, 56, 8);
		card->cid.prod_name[6]	= UNSTUFF_BITS(resp, 48, 8);
		card->cid.hwrev		= UNSTUFF_BITS(resp, 44, 4);
		card->cid.fwrev		= UNSTUFF_BITS(resp, 40, 4);
		card->cid.serial	= UNSTUFF_BITS(resp, 16, 24);
		card->cid.month		= UNSTUFF_BITS(resp, 12, 4);
		card->cid.year		= UNSTUFF_BITS(resp, 8, 4) + 1997;
		break;

	case 2: /* MMC v2.0 - v2.2 */
	case 3: /* MMC v3.1 - v3.3 */
	case 4: /* MMC v4 */
		card->cid.manfid	= UNSTUFF_BITS(resp, 120, 8);
		card->cid.oemid		= UNSTUFF_BITS(resp, 104, 16);
		card->cid.prod_name[0]	= UNSTUFF_BITS(resp, 96, 8);
		card->cid.prod_name[1]	= UNSTUFF_BITS(resp, 88, 8);
		card->cid.prod_name[2]	= UNSTUFF_BITS(resp, 80, 8);
		card->cid.prod_name[3]	= UNSTUFF_BITS(resp, 72, 8);
		card->cid.prod_name[4]	= UNSTUFF_BITS(resp, 64, 8);
		card->cid.prod_name[5]	= UNSTUFF_BITS(resp, 56, 8);
		card->cid.serial	= UNSTUFF_BITS(resp, 16, 32);
		card->cid.month		= UNSTUFF_BITS(resp, 12, 4);
		card->cid.year		= UNSTUFF_BITS(resp, 8, 4) + 1997;
		break;

	default:
P
Pierre Ossman 已提交
103
		printk(KERN_ERR "%s: card has unknown MMCA version %d\n",
P
Pierre Ossman 已提交
104
			mmc_hostname(card->host), card->csd.mmca_vsn);
P
Pierre Ossman 已提交
105
		return -EINVAL;
P
Pierre Ossman 已提交
106
	}
P
Pierre Ossman 已提交
107 108

	return 0;
P
Pierre Ossman 已提交
109 110
}

111 112 113 114 115 116 117 118 119 120
static void mmc_set_erase_size(struct mmc_card *card)
{
	if (card->ext_csd.erase_group_def & 1)
		card->erase_size = card->ext_csd.hc_erase_size;
	else
		card->erase_size = card->csd.erase_size;

	mmc_init_erase(card);
}

P
Pierre Ossman 已提交
121 122 123
/*
 * Given a 128-bit response, decode to our card CSD structure.
 */
P
Pierre Ossman 已提交
124
static int mmc_decode_csd(struct mmc_card *card)
P
Pierre Ossman 已提交
125 126
{
	struct mmc_csd *csd = &card->csd;
127
	unsigned int e, m, a, b;
P
Pierre Ossman 已提交
128 129 130 131 132
	u32 *resp = card->raw_csd;

	/*
	 * We only understand CSD structure v1.1 and v1.2.
	 * v1.2 has extra information in bits 15, 11 and 10.
K
Kyungmin Park 已提交
133
	 * We also support eMMC v4.4 & v4.41.
P
Pierre Ossman 已提交
134
	 */
K
Kyungmin Park 已提交
135 136
	csd->structure = UNSTUFF_BITS(resp, 126, 2);
	if (csd->structure == 0) {
P
Pierre Ossman 已提交
137
		printk(KERN_ERR "%s: unrecognised CSD structure version %d\n",
K
Kyungmin Park 已提交
138
			mmc_hostname(card->host), csd->structure);
P
Pierre Ossman 已提交
139
		return -EINVAL;
P
Pierre Ossman 已提交
140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163
	}

	csd->mmca_vsn	 = UNSTUFF_BITS(resp, 122, 4);
	m = UNSTUFF_BITS(resp, 115, 4);
	e = UNSTUFF_BITS(resp, 112, 3);
	csd->tacc_ns	 = (tacc_exp[e] * tacc_mant[m] + 9) / 10;
	csd->tacc_clks	 = UNSTUFF_BITS(resp, 104, 8) * 100;

	m = UNSTUFF_BITS(resp, 99, 4);
	e = UNSTUFF_BITS(resp, 96, 3);
	csd->max_dtr	  = tran_exp[e] * tran_mant[m];
	csd->cmdclass	  = UNSTUFF_BITS(resp, 84, 12);

	e = UNSTUFF_BITS(resp, 47, 3);
	m = UNSTUFF_BITS(resp, 62, 12);
	csd->capacity	  = (1 + m) << (e + 2);

	csd->read_blkbits = UNSTUFF_BITS(resp, 80, 4);
	csd->read_partial = UNSTUFF_BITS(resp, 79, 1);
	csd->write_misalign = UNSTUFF_BITS(resp, 78, 1);
	csd->read_misalign = UNSTUFF_BITS(resp, 77, 1);
	csd->r2w_factor = UNSTUFF_BITS(resp, 26, 3);
	csd->write_blkbits = UNSTUFF_BITS(resp, 22, 4);
	csd->write_partial = UNSTUFF_BITS(resp, 21, 1);
P
Pierre Ossman 已提交
164

165 166 167 168 169 170 171
	if (csd->write_blkbits >= 9) {
		a = UNSTUFF_BITS(resp, 42, 5);
		b = UNSTUFF_BITS(resp, 37, 5);
		csd->erase_size = (a + 1) * (b + 1);
		csd->erase_size <<= csd->write_blkbits - 9;
	}

P
Pierre Ossman 已提交
172
	return 0;
P
Pierre Ossman 已提交
173 174 175
}

/*
176
 * Read and decode extended CSD.
P
Pierre Ossman 已提交
177
 */
178
static int mmc_read_ext_csd(struct mmc_card *card)
P
Pierre Ossman 已提交
179 180 181 182 183 184 185
{
	int err;
	u8 *ext_csd;

	BUG_ON(!card);

	if (card->csd.mmca_vsn < CSD_SPEC_VER_4)
P
Pierre Ossman 已提交
186
		return 0;
P
Pierre Ossman 已提交
187 188 189 190 191 192 193 194

	/*
	 * As the ext_csd is so large and mostly unused, we don't store the
	 * raw block in mmc_card.
	 */
	ext_csd = kmalloc(512, GFP_KERNEL);
	if (!ext_csd) {
		printk(KERN_ERR "%s: could not allocate a buffer to "
P
Pierre Ossman 已提交
195
			"receive the ext_csd.\n", mmc_hostname(card->host));
P
Pierre Ossman 已提交
196
		return -ENOMEM;
P
Pierre Ossman 已提交
197 198 199
	}

	err = mmc_send_ext_csd(card, ext_csd);
P
Pierre Ossman 已提交
200
	if (err) {
201 202 203 204 205
		/* If the host or the card can't do the switch,
		 * fail more gracefully. */
		if ((err != -EINVAL)
		 && (err != -ENOSYS)
		 && (err != -EFAULT))
P
Pierre Ossman 已提交
206 207
			goto out;

P
Pierre Ossman 已提交
208 209 210 211 212 213 214 215 216 217 218 219 220 221
		/*
		 * High capacity cards should have this "magic" size
		 * stored in their CSD.
		 */
		if (card->csd.capacity == (4096 * 512)) {
			printk(KERN_ERR "%s: unable to read EXT_CSD "
				"on a possible high capacity card. "
				"Card will be ignored.\n",
				mmc_hostname(card->host));
		} else {
			printk(KERN_WARNING "%s: unable to read "
				"EXT_CSD, performance might "
				"suffer.\n",
				mmc_hostname(card->host));
P
Pierre Ossman 已提交
222
			err = 0;
P
Pierre Ossman 已提交
223
		}
P
Pierre Ossman 已提交
224

P
Pierre Ossman 已提交
225 226 227
		goto out;
	}

K
Kyungmin Park 已提交
228 229 230 231 232 233 234 235 236 237 238 239
	/* Version is coded in the CSD_STRUCTURE byte in the EXT_CSD register */
	if (card->csd.structure == 3) {
		int ext_csd_struct = ext_csd[EXT_CSD_STRUCTURE];
		if (ext_csd_struct > 2) {
			printk(KERN_ERR "%s: unrecognised EXT_CSD structure "
				"version %d\n", mmc_hostname(card->host),
					ext_csd_struct);
			err = -EINVAL;
			goto out;
		}
	}

240
	card->ext_csd.rev = ext_csd[EXT_CSD_REV];
A
Adrian Hunter 已提交
241
	if (card->ext_csd.rev > 5) {
K
Kyungmin Park 已提交
242 243
		printk(KERN_ERR "%s: unrecognised EXT_CSD revision %d\n",
			mmc_hostname(card->host), card->ext_csd.rev);
244 245
		err = -EINVAL;
		goto out;
P
Pierre Ossman 已提交
246 247
	}

248
	if (card->ext_csd.rev >= 2) {
P
Pierre Ossman 已提交
249 250 251 252 253
		card->ext_csd.sectors =
			ext_csd[EXT_CSD_SEC_CNT + 0] << 0 |
			ext_csd[EXT_CSD_SEC_CNT + 1] << 8 |
			ext_csd[EXT_CSD_SEC_CNT + 2] << 16 |
			ext_csd[EXT_CSD_SEC_CNT + 3] << 24;
254 255 256

		/* Cards with density > 2GiB are sector addressed */
		if (card->ext_csd.sectors > (2u * 1024 * 1024 * 1024) / 512)
P
Pierre Ossman 已提交
257 258
			mmc_card_set_blockaddr(card);
	}
P
Pierre Ossman 已提交
259

260
	switch (ext_csd[EXT_CSD_CARD_TYPE] & EXT_CSD_CARD_TYPE_MASK) {
H
Hanumath Prasad 已提交
261 262 263 264 265 266 267 268 269 270 271 272 273 274 275
	case EXT_CSD_CARD_TYPE_DDR_52 | EXT_CSD_CARD_TYPE_52 |
	     EXT_CSD_CARD_TYPE_26:
		card->ext_csd.hs_max_dtr = 52000000;
		card->ext_csd.card_type = EXT_CSD_CARD_TYPE_DDR_52;
		break;
	case EXT_CSD_CARD_TYPE_DDR_1_2V | EXT_CSD_CARD_TYPE_52 |
	     EXT_CSD_CARD_TYPE_26:
		card->ext_csd.hs_max_dtr = 52000000;
		card->ext_csd.card_type = EXT_CSD_CARD_TYPE_DDR_1_2V;
		break;
	case EXT_CSD_CARD_TYPE_DDR_1_8V | EXT_CSD_CARD_TYPE_52 |
	     EXT_CSD_CARD_TYPE_26:
		card->ext_csd.hs_max_dtr = 52000000;
		card->ext_csd.card_type = EXT_CSD_CARD_TYPE_DDR_1_8V;
		break;
P
Pierre Ossman 已提交
276 277 278 279 280 281 282 283 284 285 286 287 288
	case EXT_CSD_CARD_TYPE_52 | EXT_CSD_CARD_TYPE_26:
		card->ext_csd.hs_max_dtr = 52000000;
		break;
	case EXT_CSD_CARD_TYPE_26:
		card->ext_csd.hs_max_dtr = 26000000;
		break;
	default:
		/* MMC v4 spec says this cannot happen */
		printk(KERN_WARNING "%s: card is mmc v4 but doesn't "
			"support any high-speed modes.\n",
			mmc_hostname(card->host));
	}

289 290 291 292 293 294 295
	if (card->ext_csd.rev >= 3) {
		u8 sa_shift = ext_csd[EXT_CSD_S_A_TIMEOUT];

		/* Sleep / awake timeout in 100ns units */
		if (sa_shift > 0 && sa_shift <= 0x17)
			card->ext_csd.sa_timeout =
					1 << ext_csd[EXT_CSD_S_A_TIMEOUT];
296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312
		card->ext_csd.erase_group_def =
			ext_csd[EXT_CSD_ERASE_GROUP_DEF];
		card->ext_csd.hc_erase_timeout = 300 *
			ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT];
		card->ext_csd.hc_erase_size =
			ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE] << 10;
	}

	if (card->ext_csd.rev >= 4) {
		card->ext_csd.sec_trim_mult =
			ext_csd[EXT_CSD_SEC_TRIM_MULT];
		card->ext_csd.sec_erase_mult =
			ext_csd[EXT_CSD_SEC_ERASE_MULT];
		card->ext_csd.sec_feature_support =
			ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT];
		card->ext_csd.trim_timeout = 300 *
			ext_csd[EXT_CSD_TRIM_MULT];
313 314
	}

315 316 317 318 319
	if (ext_csd[EXT_CSD_ERASED_MEM_CONT])
		card->erased_byte = 0xFF;
	else
		card->erased_byte = 0x0;

P
Pierre Ossman 已提交
320 321 322 323 324 325
out:
	kfree(ext_csd);

	return err;
}

326 327 328 329 330
MMC_DEV_ATTR(cid, "%08x%08x%08x%08x\n", card->raw_cid[0], card->raw_cid[1],
	card->raw_cid[2], card->raw_cid[3]);
MMC_DEV_ATTR(csd, "%08x%08x%08x%08x\n", card->raw_csd[0], card->raw_csd[1],
	card->raw_csd[2], card->raw_csd[3]);
MMC_DEV_ATTR(date, "%02d/%04d\n", card->cid.month, card->cid.year);
331 332
MMC_DEV_ATTR(erase_size, "%u\n", card->erase_size << 9);
MMC_DEV_ATTR(preferred_erase_size, "%u\n", card->pref_erase << 9);
333 334 335 336 337 338 339 340 341 342 343
MMC_DEV_ATTR(fwrev, "0x%x\n", card->cid.fwrev);
MMC_DEV_ATTR(hwrev, "0x%x\n", card->cid.hwrev);
MMC_DEV_ATTR(manfid, "0x%06x\n", card->cid.manfid);
MMC_DEV_ATTR(name, "%s\n", card->cid.prod_name);
MMC_DEV_ATTR(oemid, "0x%04x\n", card->cid.oemid);
MMC_DEV_ATTR(serial, "0x%08x\n", card->cid.serial);

static struct attribute *mmc_std_attrs[] = {
	&dev_attr_cid.attr,
	&dev_attr_csd.attr,
	&dev_attr_date.attr,
344 345
	&dev_attr_erase_size.attr,
	&dev_attr_preferred_erase_size.attr,
346 347 348 349 350 351 352 353 354 355 356 357 358
	&dev_attr_fwrev.attr,
	&dev_attr_hwrev.attr,
	&dev_attr_manfid.attr,
	&dev_attr_name.attr,
	&dev_attr_oemid.attr,
	&dev_attr_serial.attr,
	NULL,
};

static struct attribute_group mmc_std_attr_group = {
	.attrs = mmc_std_attrs,
};

359
static const struct attribute_group *mmc_attr_groups[] = {
360 361 362 363 364 365 366 367
	&mmc_std_attr_group,
	NULL,
};

static struct device_type mmc_type = {
	.groups = mmc_attr_groups,
};

P
Pierre Ossman 已提交
368
/*
369 370
 * Handle the detection and initialisation of a card.
 *
D
Deepak Saxena 已提交
371
 * In the case of a resume, "oldcard" will contain the card
372
 * we're trying to reinitialise.
P
Pierre Ossman 已提交
373
 */
374
static int mmc_init_card(struct mmc_host *host, u32 ocr,
375
	struct mmc_card *oldcard)
P
Pierre Ossman 已提交
376 377
{
	struct mmc_card *card;
378
	int err, ddr = 0;
P
Pierre Ossman 已提交
379 380 381 382
	u32 cid[4];
	unsigned int max_dtr;

	BUG_ON(!host);
P
Pierre Ossman 已提交
383
	WARN_ON(!host->claimed);
P
Pierre Ossman 已提交
384 385 386 387 388 389 390 391 392 393

	/*
	 * Since we're changing the OCR value, we seem to
	 * need to tell some cards to go back to the idle
	 * state.  We wait 1ms to give cards time to
	 * respond.
	 */
	mmc_go_idle(host);

	/* The extra bit indicates that we support high capacity */
394
	err = mmc_send_op_cond(host, ocr | (1 << 30), NULL);
P
Pierre Ossman 已提交
395
	if (err)
396
		goto err;
P
Pierre Ossman 已提交
397

D
David Brownell 已提交
398 399 400 401 402 403 404 405 406
	/*
	 * For SPI, enable CRC as appropriate.
	 */
	if (mmc_host_is_spi(host)) {
		err = mmc_spi_set_crc(host, use_spi_crc);
		if (err)
			goto err;
	}

P
Pierre Ossman 已提交
407 408 409
	/*
	 * Fetch CID from card.
	 */
D
David Brownell 已提交
410 411 412 413
	if (mmc_host_is_spi(host))
		err = mmc_send_cid(host, cid);
	else
		err = mmc_all_send_cid(host, cid);
P
Pierre Ossman 已提交
414
	if (err)
P
Pierre Ossman 已提交
415 416
		goto err;

417
	if (oldcard) {
P
Pierre Ossman 已提交
418 419
		if (memcmp(cid, oldcard->raw_cid, sizeof(cid)) != 0) {
			err = -ENOENT;
420
			goto err;
P
Pierre Ossman 已提交
421
		}
422 423 424 425 426 427

		card = oldcard;
	} else {
		/*
		 * Allocate card structure.
		 */
428
		card = mmc_alloc_card(host, &mmc_type);
P
Pierre Ossman 已提交
429 430
		if (IS_ERR(card)) {
			err = PTR_ERR(card);
431
			goto err;
P
Pierre Ossman 已提交
432
		}
P
Pierre Ossman 已提交
433

434 435 436 437
		card->type = MMC_TYPE_MMC;
		card->rca = 1;
		memcpy(card->raw_cid, cid, sizeof(card->raw_cid));
	}
P
Pierre Ossman 已提交
438 439

	/*
D
David Brownell 已提交
440
	 * For native busses:  set card RCA and quit open drain mode.
P
Pierre Ossman 已提交
441
	 */
D
David Brownell 已提交
442 443 444 445
	if (!mmc_host_is_spi(host)) {
		err = mmc_set_relative_addr(card);
		if (err)
			goto free_card;
P
Pierre Ossman 已提交
446

D
David Brownell 已提交
447 448
		mmc_set_bus_mode(host, MMC_BUSMODE_PUSHPULL);
	}
P
Pierre Ossman 已提交
449

450 451 452 453 454
	if (!oldcard) {
		/*
		 * Fetch CSD from card.
		 */
		err = mmc_send_csd(card, card->raw_csd);
P
Pierre Ossman 已提交
455
		if (err)
456
			goto free_card;
P
Pierre Ossman 已提交
457

P
Pierre Ossman 已提交
458
		err = mmc_decode_csd(card);
P
Pierre Ossman 已提交
459
		if (err)
P
Pierre Ossman 已提交
460 461
			goto free_card;
		err = mmc_decode_cid(card);
P
Pierre Ossman 已提交
462
		if (err)
P
Pierre Ossman 已提交
463
			goto free_card;
464
	}
P
Pierre Ossman 已提交
465 466

	/*
467
	 * Select card, as all following commands rely on that.
P
Pierre Ossman 已提交
468
	 */
D
David Brownell 已提交
469 470 471 472 473
	if (!mmc_host_is_spi(host)) {
		err = mmc_select_card(card);
		if (err)
			goto free_card;
	}
P
Pierre Ossman 已提交
474

475 476
	if (!oldcard) {
		/*
D
David Brownell 已提交
477
		 * Fetch and process extended CSD.
478 479
		 */
		err = mmc_read_ext_csd(card);
P
Pierre Ossman 已提交
480
		if (err)
481
			goto free_card;
482 483
		/* Erase size depends on CSD and Extended CSD */
		mmc_set_erase_size(card);
484
	}
P
Pierre Ossman 已提交
485

486 487 488 489 490 491 492
	/*
	 * Activate high speed (if supported)
	 */
	if ((card->ext_csd.hs_max_dtr != 0) &&
		(host->caps & MMC_CAP_MMC_HIGHSPEED)) {
		err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
			EXT_CSD_HS_TIMING, 1);
493
		if (err && err != -EBADMSG)
494 495
			goto free_card;

496 497 498 499 500 501 502 503
		if (err) {
			printk(KERN_WARNING "%s: switch to highspeed failed\n",
			       mmc_hostname(card->host));
			err = 0;
		} else {
			mmc_card_set_highspeed(card);
			mmc_set_timing(card->host, MMC_TIMING_MMC_HS);
		}
504 505
	}

P
Pierre Ossman 已提交
506 507 508 509 510 511 512 513 514 515 516 517 518 519
	/*
	 * Compute bus speed.
	 */
	max_dtr = (unsigned int)-1;

	if (mmc_card_highspeed(card)) {
		if (max_dtr > card->ext_csd.hs_max_dtr)
			max_dtr = card->ext_csd.hs_max_dtr;
	} else if (max_dtr > card->csd.max_dtr) {
		max_dtr = card->csd.max_dtr;
	}

	mmc_set_clock(host, max_dtr);

H
Hanumath Prasad 已提交
520
	/*
521
	 * Indicate DDR mode (if supported).
H
Hanumath Prasad 已提交
522 523 524 525
	 */
	if (mmc_card_highspeed(card)) {
		if ((card->ext_csd.card_type & EXT_CSD_CARD_TYPE_DDR_1_8V)
			&& (host->caps & (MMC_CAP_1_8V_DDR)))
526
				ddr = 1;
H
Hanumath Prasad 已提交
527 528
		else if ((card->ext_csd.card_type & EXT_CSD_CARD_TYPE_DDR_1_2V)
			&& (host->caps & (MMC_CAP_1_2V_DDR)))
529
				ddr = 1;
H
Hanumath Prasad 已提交
530 531
	}

532
	/*
533
	 * Activate wide bus and DDR (if supported).
534 535
	 */
	if ((card->csd.mmca_vsn >= CSD_SPEC_VER_4) &&
J
Jarkko Lavinen 已提交
536 537 538 539
	    (host->caps & (MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA))) {
		unsigned ext_csd_bit, bus_width;

		if (host->caps & MMC_CAP_8_BIT_DATA) {
540
			if (ddr)
H
Hanumath Prasad 已提交
541 542 543
				ext_csd_bit = EXT_CSD_DDR_BUS_WIDTH_8;
			else
				ext_csd_bit = EXT_CSD_BUS_WIDTH_8;
J
Jarkko Lavinen 已提交
544 545
			bus_width = MMC_BUS_WIDTH_8;
		} else {
546
			if (ddr)
H
Hanumath Prasad 已提交
547 548 549
				ext_csd_bit = EXT_CSD_DDR_BUS_WIDTH_4;
			else
				ext_csd_bit = EXT_CSD_BUS_WIDTH_4;
J
Jarkko Lavinen 已提交
550 551 552
			bus_width = MMC_BUS_WIDTH_4;
		}

553
		err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
J
Jarkko Lavinen 已提交
554 555
				 EXT_CSD_BUS_WIDTH, ext_csd_bit);

556
		if (err && err != -EBADMSG)
557 558
			goto free_card;

559
		if (err) {
560
			printk(KERN_WARNING "%s: switch to bus width %d ddr %d "
561
			       "failed\n", mmc_hostname(card->host),
562
			       1 << bus_width, ddr);
563 564
			err = 0;
		} else {
565 566
			mmc_card_set_ddr_mode(card);
			mmc_set_bus_width_ddr(card->host, bus_width, ddr);
567
		}
568 569
	}

570 571 572
	if (!oldcard)
		host->card = card;

P
Pierre Ossman 已提交
573
	return 0;
574 575 576 577 578 579

free_card:
	if (!oldcard)
		mmc_remove_card(card);
err:

P
Pierre Ossman 已提交
580
	return err;
581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613
}

/*
 * Host is being removed. Free up the current card.
 */
static void mmc_remove(struct mmc_host *host)
{
	BUG_ON(!host);
	BUG_ON(!host->card);

	mmc_remove_card(host->card);
	host->card = NULL;
}

/*
 * Card detection callback from host.
 */
static void mmc_detect(struct mmc_host *host)
{
	int err;

	BUG_ON(!host);
	BUG_ON(!host->card);

	mmc_claim_host(host);

	/*
	 * Just check if our card has been removed.
	 */
	err = mmc_send_status(host->card, NULL);

	mmc_release_host(host);

P
Pierre Ossman 已提交
614
	if (err) {
P
Pierre Ossman 已提交
615
		mmc_remove(host);
616 617 618 619 620 621 622 623 624 625

		mmc_claim_host(host);
		mmc_detach_bus(host);
		mmc_release_host(host);
	}
}

/*
 * Suspend callback from host.
 */
626
static int mmc_suspend(struct mmc_host *host)
627 628 629
{
	BUG_ON(!host);
	BUG_ON(!host->card);
P
Pierre Ossman 已提交
630

631
	mmc_claim_host(host);
D
David Brownell 已提交
632 633
	if (!mmc_host_is_spi(host))
		mmc_deselect_cards(host);
634
	host->card->state &= ~MMC_STATE_HIGHSPEED;
P
Pierre Ossman 已提交
635
	mmc_release_host(host);
636 637

	return 0;
638
}
P
Pierre Ossman 已提交
639

640 641 642 643 644 645
/*
 * Resume callback from host.
 *
 * This function tries to determine if the same card is still present
 * and, if so, restore all state to it.
 */
646
static int mmc_resume(struct mmc_host *host)
647 648 649 650 651 652 653
{
	int err;

	BUG_ON(!host);
	BUG_ON(!host->card);

	mmc_claim_host(host);
654
	err = mmc_init_card(host, host->ocr, host->card);
655 656
	mmc_release_host(host);

657
	return err;
658 659
}

660 661 662 663 664 665 666 667
static void mmc_power_restore(struct mmc_host *host)
{
	host->card->state &= ~MMC_STATE_HIGHSPEED;
	mmc_claim_host(host);
	mmc_init_card(host, host->ocr, host->card);
	mmc_release_host(host);
}

668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697
static int mmc_sleep(struct mmc_host *host)
{
	struct mmc_card *card = host->card;
	int err = -ENOSYS;

	if (card && card->ext_csd.rev >= 3) {
		err = mmc_card_sleepawake(host, 1);
		if (err < 0)
			pr_debug("%s: Error %d while putting card into sleep",
				 mmc_hostname(host), err);
	}

	return err;
}

static int mmc_awake(struct mmc_host *host)
{
	struct mmc_card *card = host->card;
	int err = -ENOSYS;

	if (card && card->ext_csd.rev >= 3) {
		err = mmc_card_sleepawake(host, 0);
		if (err < 0)
			pr_debug("%s: Error %d while awaking sleeping card",
				 mmc_hostname(host), err);
	}

	return err;
}

698
static const struct mmc_bus_ops mmc_ops = {
699 700
	.awake = mmc_awake,
	.sleep = mmc_sleep,
701 702 703 704
	.remove = mmc_remove,
	.detect = mmc_detect,
	.suspend = NULL,
	.resume = NULL,
705
	.power_restore = mmc_power_restore,
706 707 708
};

static const struct mmc_bus_ops mmc_ops_unsafe = {
709 710
	.awake = mmc_awake,
	.sleep = mmc_sleep,
711 712 713 714
	.remove = mmc_remove,
	.detect = mmc_detect,
	.suspend = mmc_suspend,
	.resume = mmc_resume,
715
	.power_restore = mmc_power_restore,
716 717
};

718 719 720 721
static void mmc_attach_bus_ops(struct mmc_host *host)
{
	const struct mmc_bus_ops *bus_ops;

722
	if (!mmc_card_is_removable(host))
723 724 725 726 727 728
		bus_ops = &mmc_ops_unsafe;
	else
		bus_ops = &mmc_ops;
	mmc_attach_bus(host, bus_ops);
}

729 730 731 732 733 734 735 736
/*
 * Starting point for MMC card init.
 */
int mmc_attach_mmc(struct mmc_host *host, u32 ocr)
{
	int err;

	BUG_ON(!host);
P
Pierre Ossman 已提交
737
	WARN_ON(!host->claimed);
738

739
	mmc_attach_bus_ops(host);
740

D
David Brownell 已提交
741 742 743 744 745 746 747 748 749
	/*
	 * We need to get OCR a different way for SPI.
	 */
	if (mmc_host_is_spi(host)) {
		err = mmc_spi_read_ocr(host, 1, &ocr);
		if (err)
			goto err;
	}

750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765
	/*
	 * Sanity check the voltages that the card claims to
	 * support.
	 */
	if (ocr & 0x7F) {
		printk(KERN_WARNING "%s: card claims to support voltages "
		       "below the defined range. These will be ignored.\n",
		       mmc_hostname(host));
		ocr &= ~0x7F;
	}

	host->ocr = mmc_select_voltage(host, ocr);

	/*
	 * Can we support the voltage of the card?
	 */
766 767
	if (!host->ocr) {
		err = -EINVAL;
768
		goto err;
769
	}
770 771 772 773

	/*
	 * Detect and init the card.
	 */
774
	err = mmc_init_card(host, host->ocr, NULL);
P
Pierre Ossman 已提交
775
	if (err)
776 777 778 779
		goto err;

	mmc_release_host(host);

P
Pierre Ossman 已提交
780
	err = mmc_add_card(host->card);
P
Pierre Ossman 已提交
781
	if (err)
782
		goto remove_card;
P
Pierre Ossman 已提交
783 784 785

	return 0;

786
remove_card:
787
	mmc_remove_card(host->card);
P
Pierre Ossman 已提交
788
	host->card = NULL;
789
	mmc_claim_host(host);
P
Pierre Ossman 已提交
790 791 792 793
err:
	mmc_detach_bus(host);
	mmc_release_host(host);

794 795 796
	printk(KERN_ERR "%s: error %d whilst initialising MMC card\n",
		mmc_hostname(host), err);

P
Pierre Ossman 已提交
797
	return err;
P
Pierre Ossman 已提交
798
}