mmc.c 16.0 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
}

/*
 * Given a 128-bit response, decode to our card CSD structure.
 */
P
Pierre Ossman 已提交
114
static int mmc_decode_csd(struct mmc_card *card)
P
Pierre Ossman 已提交
115 116
{
	struct mmc_csd *csd = &card->csd;
K
Kyungmin Park 已提交
117
	unsigned int e, m;
P
Pierre Ossman 已提交
118 119 120 121 122
	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 已提交
123
	 * We also support eMMC v4.4 & v4.41.
P
Pierre Ossman 已提交
124
	 */
K
Kyungmin Park 已提交
125 126
	csd->structure = UNSTUFF_BITS(resp, 126, 2);
	if (csd->structure == 0) {
P
Pierre Ossman 已提交
127
		printk(KERN_ERR "%s: unrecognised CSD structure version %d\n",
K
Kyungmin Park 已提交
128
			mmc_hostname(card->host), csd->structure);
P
Pierre Ossman 已提交
129
		return -EINVAL;
P
Pierre Ossman 已提交
130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153
	}

	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 已提交
154 155

	return 0;
P
Pierre Ossman 已提交
156 157 158
}

/*
159
 * Read and decode extended CSD.
P
Pierre Ossman 已提交
160
 */
161
static int mmc_read_ext_csd(struct mmc_card *card)
P
Pierre Ossman 已提交
162 163 164 165 166 167 168
{
	int err;
	u8 *ext_csd;

	BUG_ON(!card);

	if (card->csd.mmca_vsn < CSD_SPEC_VER_4)
P
Pierre Ossman 已提交
169
		return 0;
P
Pierre Ossman 已提交
170 171 172 173 174 175 176 177

	/*
	 * 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 已提交
178
			"receive the ext_csd.\n", mmc_hostname(card->host));
P
Pierre Ossman 已提交
179
		return -ENOMEM;
P
Pierre Ossman 已提交
180 181 182
	}

	err = mmc_send_ext_csd(card, ext_csd);
P
Pierre Ossman 已提交
183
	if (err) {
184 185 186 187 188
		/* If the host or the card can't do the switch,
		 * fail more gracefully. */
		if ((err != -EINVAL)
		 && (err != -ENOSYS)
		 && (err != -EFAULT))
P
Pierre Ossman 已提交
189 190
			goto out;

P
Pierre Ossman 已提交
191 192 193 194 195 196 197 198 199 200 201 202 203 204
		/*
		 * 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 已提交
205
			err = 0;
P
Pierre Ossman 已提交
206
		}
P
Pierre Ossman 已提交
207

P
Pierre Ossman 已提交
208 209 210
		goto out;
	}

K
Kyungmin Park 已提交
211 212 213 214 215 216 217 218 219 220 221 222
	/* 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;
		}
	}

223
	card->ext_csd.rev = ext_csd[EXT_CSD_REV];
A
Adrian Hunter 已提交
224
	if (card->ext_csd.rev > 5) {
K
Kyungmin Park 已提交
225 226
		printk(KERN_ERR "%s: unrecognised EXT_CSD revision %d\n",
			mmc_hostname(card->host), card->ext_csd.rev);
227 228
		err = -EINVAL;
		goto out;
P
Pierre Ossman 已提交
229 230
	}

231
	if (card->ext_csd.rev >= 2) {
P
Pierre Ossman 已提交
232 233 234 235 236
		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;
237 238 239

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

243
	switch (ext_csd[EXT_CSD_CARD_TYPE] & EXT_CSD_CARD_TYPE_MASK) {
P
Pierre Ossman 已提交
244 245 246 247 248 249 250 251 252 253 254 255 256
	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));
	}

257 258 259 260 261 262 263 264 265
	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];
	}

P
Pierre Ossman 已提交
266 267 268 269 270 271
out:
	kfree(ext_csd);

	return err;
}

272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300
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);
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,
	&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,
};

301
static const struct attribute_group *mmc_attr_groups[] = {
302 303 304 305 306 307 308 309
	&mmc_std_attr_group,
	NULL,
};

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

P
Pierre Ossman 已提交
310
/*
311 312
 * Handle the detection and initialisation of a card.
 *
D
Deepak Saxena 已提交
313
 * In the case of a resume, "oldcard" will contain the card
314
 * we're trying to reinitialise.
P
Pierre Ossman 已提交
315
 */
316
static int mmc_init_card(struct mmc_host *host, u32 ocr,
317
	struct mmc_card *oldcard)
P
Pierre Ossman 已提交
318 319 320 321 322 323 324
{
	struct mmc_card *card;
	int err;
	u32 cid[4];
	unsigned int max_dtr;

	BUG_ON(!host);
P
Pierre Ossman 已提交
325
	WARN_ON(!host->claimed);
P
Pierre Ossman 已提交
326 327 328 329 330 331 332 333 334 335

	/*
	 * 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 */
336
	err = mmc_send_op_cond(host, ocr | (1 << 30), NULL);
P
Pierre Ossman 已提交
337
	if (err)
338
		goto err;
P
Pierre Ossman 已提交
339

D
David Brownell 已提交
340 341 342 343 344 345 346 347 348
	/*
	 * 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 已提交
349 350 351
	/*
	 * Fetch CID from card.
	 */
D
David Brownell 已提交
352 353 354 355
	if (mmc_host_is_spi(host))
		err = mmc_send_cid(host, cid);
	else
		err = mmc_all_send_cid(host, cid);
P
Pierre Ossman 已提交
356
	if (err)
P
Pierre Ossman 已提交
357 358
		goto err;

359
	if (oldcard) {
P
Pierre Ossman 已提交
360 361
		if (memcmp(cid, oldcard->raw_cid, sizeof(cid)) != 0) {
			err = -ENOENT;
362
			goto err;
P
Pierre Ossman 已提交
363
		}
364 365 366 367 368 369

		card = oldcard;
	} else {
		/*
		 * Allocate card structure.
		 */
370
		card = mmc_alloc_card(host, &mmc_type);
P
Pierre Ossman 已提交
371 372
		if (IS_ERR(card)) {
			err = PTR_ERR(card);
373
			goto err;
P
Pierre Ossman 已提交
374
		}
P
Pierre Ossman 已提交
375

376 377 378 379
		card->type = MMC_TYPE_MMC;
		card->rca = 1;
		memcpy(card->raw_cid, cid, sizeof(card->raw_cid));
	}
P
Pierre Ossman 已提交
380 381

	/*
D
David Brownell 已提交
382
	 * For native busses:  set card RCA and quit open drain mode.
P
Pierre Ossman 已提交
383
	 */
D
David Brownell 已提交
384 385 386 387
	if (!mmc_host_is_spi(host)) {
		err = mmc_set_relative_addr(card);
		if (err)
			goto free_card;
P
Pierre Ossman 已提交
388

D
David Brownell 已提交
389 390
		mmc_set_bus_mode(host, MMC_BUSMODE_PUSHPULL);
	}
P
Pierre Ossman 已提交
391

392 393 394 395 396
	if (!oldcard) {
		/*
		 * Fetch CSD from card.
		 */
		err = mmc_send_csd(card, card->raw_csd);
P
Pierre Ossman 已提交
397
		if (err)
398
			goto free_card;
P
Pierre Ossman 已提交
399

P
Pierre Ossman 已提交
400
		err = mmc_decode_csd(card);
P
Pierre Ossman 已提交
401
		if (err)
P
Pierre Ossman 已提交
402 403
			goto free_card;
		err = mmc_decode_cid(card);
P
Pierre Ossman 已提交
404
		if (err)
P
Pierre Ossman 已提交
405
			goto free_card;
406
	}
P
Pierre Ossman 已提交
407 408

	/*
409
	 * Select card, as all following commands rely on that.
P
Pierre Ossman 已提交
410
	 */
D
David Brownell 已提交
411 412 413 414 415
	if (!mmc_host_is_spi(host)) {
		err = mmc_select_card(card);
		if (err)
			goto free_card;
	}
P
Pierre Ossman 已提交
416

417 418
	if (!oldcard) {
		/*
D
David Brownell 已提交
419
		 * Fetch and process extended CSD.
420 421
		 */
		err = mmc_read_ext_csd(card);
P
Pierre Ossman 已提交
422
		if (err)
423 424
			goto free_card;
	}
P
Pierre Ossman 已提交
425

426 427 428 429 430 431 432
	/*
	 * 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);
433
		if (err && err != -EBADMSG)
434 435
			goto free_card;

436 437 438 439 440 441 442 443
		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);
		}
444 445
	}

P
Pierre Ossman 已提交
446 447 448 449 450 451 452 453 454 455 456 457 458 459
	/*
	 * 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);

460 461 462 463
	/*
	 * Activate wide bus (if supported).
	 */
	if ((card->csd.mmca_vsn >= CSD_SPEC_VER_4) &&
J
Jarkko Lavinen 已提交
464 465 466 467 468 469 470 471 472 473 474
	    (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) {
			ext_csd_bit = EXT_CSD_BUS_WIDTH_8;
			bus_width = MMC_BUS_WIDTH_8;
		} else {
			ext_csd_bit = EXT_CSD_BUS_WIDTH_4;
			bus_width = MMC_BUS_WIDTH_4;
		}

475
		err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
J
Jarkko Lavinen 已提交
476 477
				 EXT_CSD_BUS_WIDTH, ext_csd_bit);

478
		if (err && err != -EBADMSG)
479 480
			goto free_card;

481 482 483 484 485 486 487 488
		if (err) {
			printk(KERN_WARNING "%s: switch to bus width %d "
			       "failed\n", mmc_hostname(card->host),
			       1 << bus_width);
			err = 0;
		} else {
			mmc_set_bus_width(card->host, bus_width);
		}
489 490
	}

491 492 493
	if (!oldcard)
		host->card = card;

P
Pierre Ossman 已提交
494
	return 0;
495 496 497 498 499 500

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

P
Pierre Ossman 已提交
501
	return err;
502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534
}

/*
 * 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 已提交
535
	if (err) {
P
Pierre Ossman 已提交
536
		mmc_remove(host);
537 538 539 540 541 542 543 544 545 546

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

/*
 * Suspend callback from host.
 */
547
static int mmc_suspend(struct mmc_host *host)
548 549 550
{
	BUG_ON(!host);
	BUG_ON(!host->card);
P
Pierre Ossman 已提交
551

552
	mmc_claim_host(host);
D
David Brownell 已提交
553 554
	if (!mmc_host_is_spi(host))
		mmc_deselect_cards(host);
555
	host->card->state &= ~MMC_STATE_HIGHSPEED;
P
Pierre Ossman 已提交
556
	mmc_release_host(host);
557 558

	return 0;
559
}
P
Pierre Ossman 已提交
560

561 562 563 564 565 566
/*
 * Resume callback from host.
 *
 * This function tries to determine if the same card is still present
 * and, if so, restore all state to it.
 */
567
static int mmc_resume(struct mmc_host *host)
568 569 570 571 572 573 574
{
	int err;

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

	mmc_claim_host(host);
575
	err = mmc_init_card(host, host->ocr, host->card);
576 577
	mmc_release_host(host);

578
	return err;
579 580
}

581 582 583 584 585 586 587 588
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);
}

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 614 615 616 617 618
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;
}

619
static const struct mmc_bus_ops mmc_ops = {
620 621
	.awake = mmc_awake,
	.sleep = mmc_sleep,
622 623 624 625
	.remove = mmc_remove,
	.detect = mmc_detect,
	.suspend = NULL,
	.resume = NULL,
626
	.power_restore = mmc_power_restore,
627 628 629
};

static const struct mmc_bus_ops mmc_ops_unsafe = {
630 631
	.awake = mmc_awake,
	.sleep = mmc_sleep,
632 633 634 635
	.remove = mmc_remove,
	.detect = mmc_detect,
	.suspend = mmc_suspend,
	.resume = mmc_resume,
636
	.power_restore = mmc_power_restore,
637 638
};

639 640 641 642
static void mmc_attach_bus_ops(struct mmc_host *host)
{
	const struct mmc_bus_ops *bus_ops;

643
	if (host->caps & MMC_CAP_NONREMOVABLE || !mmc_assume_removable)
644 645 646 647 648 649
		bus_ops = &mmc_ops_unsafe;
	else
		bus_ops = &mmc_ops;
	mmc_attach_bus(host, bus_ops);
}

650 651 652 653 654 655 656 657
/*
 * Starting point for MMC card init.
 */
int mmc_attach_mmc(struct mmc_host *host, u32 ocr)
{
	int err;

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

660
	mmc_attach_bus_ops(host);
661

D
David Brownell 已提交
662 663 664 665 666 667 668 669 670
	/*
	 * 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;
	}

671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686
	/*
	 * 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?
	 */
687 688
	if (!host->ocr) {
		err = -EINVAL;
689
		goto err;
690
	}
691 692 693 694

	/*
	 * Detect and init the card.
	 */
695
	err = mmc_init_card(host, host->ocr, NULL);
P
Pierre Ossman 已提交
696
	if (err)
697 698 699 700
		goto err;

	mmc_release_host(host);

P
Pierre Ossman 已提交
701
	err = mmc_add_card(host->card);
P
Pierre Ossman 已提交
702
	if (err)
703
		goto remove_card;
P
Pierre Ossman 已提交
704 705 706

	return 0;

707
remove_card:
708
	mmc_remove_card(host->card);
P
Pierre Ossman 已提交
709
	host->card = NULL;
710
	mmc_claim_host(host);
P
Pierre Ossman 已提交
711 712 713 714
err:
	mmc_detach_bus(host);
	mmc_release_host(host);

715 716 717
	printk(KERN_ERR "%s: error %d whilst initialising MMC card\n",
		mmc_hostname(host), err);

P
Pierre Ossman 已提交
718
	return err;
P
Pierre Ossman 已提交
719
}