mmc.c 33.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
#include "mmc_ops.h"
23
#include "sd_ops.h"
P
Pierre Ossman 已提交
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 60

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 已提交
61
static int mmc_decode_cid(struct mmc_card *card)
P
Pierre Ossman 已提交
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 103
{
	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:
104
		pr_err("%s: card has unknown MMCA version %d\n",
P
Pierre Ossman 已提交
105
			mmc_hostname(card->host), card->csd.mmca_vsn);
P
Pierre Ossman 已提交
106
		return -EINVAL;
P
Pierre Ossman 已提交
107
	}
P
Pierre Ossman 已提交
108 109

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

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

	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 已提交
165

166 167 168 169 170 171 172
	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 已提交
173
	return 0;
P
Pierre Ossman 已提交
174 175 176
}

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

	BUG_ON(!card);
185 186 187
	BUG_ON(!new_ext_csd);

	*new_ext_csd = NULL;
P
Pierre Ossman 已提交
188 189

	if (card->csd.mmca_vsn < CSD_SPEC_VER_4)
P
Pierre Ossman 已提交
190
		return 0;
P
Pierre Ossman 已提交
191 192 193 194 195 196 197

	/*
	 * 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) {
198
		pr_err("%s: could not allocate a buffer to "
P
Pierre Ossman 已提交
199
			"receive the ext_csd.\n", mmc_hostname(card->host));
P
Pierre Ossman 已提交
200
		return -ENOMEM;
P
Pierre Ossman 已提交
201 202 203
	}

	err = mmc_send_ext_csd(card, ext_csd);
P
Pierre Ossman 已提交
204
	if (err) {
205 206 207
		kfree(ext_csd);
		*new_ext_csd = NULL;

208 209 210 211 212
		/* If the host or the card can't do the switch,
		 * fail more gracefully. */
		if ((err != -EINVAL)
		 && (err != -ENOSYS)
		 && (err != -EFAULT))
213
			return err;
P
Pierre Ossman 已提交
214

P
Pierre Ossman 已提交
215 216 217 218 219
		/*
		 * High capacity cards should have this "magic" size
		 * stored in their CSD.
		 */
		if (card->csd.capacity == (4096 * 512)) {
220
			pr_err("%s: unable to read EXT_CSD "
P
Pierre Ossman 已提交
221 222 223 224
				"on a possible high capacity card. "
				"Card will be ignored.\n",
				mmc_hostname(card->host));
		} else {
225
			pr_warning("%s: unable to read "
P
Pierre Ossman 已提交
226 227 228
				"EXT_CSD, performance might "
				"suffer.\n",
				mmc_hostname(card->host));
P
Pierre Ossman 已提交
229
			err = 0;
P
Pierre Ossman 已提交
230
		}
231 232
	} else
		*new_ext_csd = ext_csd;
P
Pierre Ossman 已提交
233

234 235 236 237 238 239 240 241
	return err;
}

/*
 * Decode extended CSD.
 */
static int mmc_read_ext_csd(struct mmc_card *card, u8 *ext_csd)
{
242 243 244
	int err = 0, idx;
	unsigned int part_size;
	u8 hc_erase_grp_sz = 0, hc_wp_grp_sz = 0;
245 246 247 248 249

	BUG_ON(!card);

	if (!ext_csd)
		return 0;
P
Pierre Ossman 已提交
250

K
Kyungmin Park 已提交
251
	/* Version is coded in the CSD_STRUCTURE byte in the EXT_CSD register */
252
	card->ext_csd.raw_ext_csd_structure = ext_csd[EXT_CSD_STRUCTURE];
K
Kyungmin Park 已提交
253
	if (card->csd.structure == 3) {
254
		if (card->ext_csd.raw_ext_csd_structure > 2) {
255
			pr_err("%s: unrecognised EXT_CSD structure "
K
Kyungmin Park 已提交
256
				"version %d\n", mmc_hostname(card->host),
257
					card->ext_csd.raw_ext_csd_structure);
K
Kyungmin Park 已提交
258 259 260 261 262
			err = -EINVAL;
			goto out;
		}
	}

263
	card->ext_csd.rev = ext_csd[EXT_CSD_REV];
264
	if (card->ext_csd.rev > 6) {
265
		pr_err("%s: unrecognised EXT_CSD revision %d\n",
K
Kyungmin Park 已提交
266
			mmc_hostname(card->host), card->ext_csd.rev);
267 268
		err = -EINVAL;
		goto out;
P
Pierre Ossman 已提交
269 270
	}

271 272 273 274
	card->ext_csd.raw_sectors[0] = ext_csd[EXT_CSD_SEC_CNT + 0];
	card->ext_csd.raw_sectors[1] = ext_csd[EXT_CSD_SEC_CNT + 1];
	card->ext_csd.raw_sectors[2] = ext_csd[EXT_CSD_SEC_CNT + 2];
	card->ext_csd.raw_sectors[3] = ext_csd[EXT_CSD_SEC_CNT + 3];
275
	if (card->ext_csd.rev >= 2) {
P
Pierre Ossman 已提交
276 277 278 279 280
		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;
281 282 283

		/* Cards with density > 2GiB are sector addressed */
		if (card->ext_csd.sectors > (2u * 1024 * 1024 * 1024) / 512)
P
Pierre Ossman 已提交
284 285
			mmc_card_set_blockaddr(card);
	}
286
	card->ext_csd.raw_card_type = ext_csd[EXT_CSD_CARD_TYPE];
287
	switch (ext_csd[EXT_CSD_CARD_TYPE] & EXT_CSD_CARD_TYPE_MASK) {
H
Hanumath Prasad 已提交
288 289 290 291 292 293 294 295 296 297 298 299 300 301 302
	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 已提交
303 304 305 306 307 308 309 310
	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 */
311
		pr_warning("%s: card is mmc v4 but doesn't "
P
Pierre Ossman 已提交
312 313 314 315
			"support any high-speed modes.\n",
			mmc_hostname(card->host));
	}

316 317 318 319 320
	card->ext_csd.raw_s_a_timeout = ext_csd[EXT_CSD_S_A_TIMEOUT];
	card->ext_csd.raw_erase_timeout_mult =
		ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT];
	card->ext_csd.raw_hc_erase_grp_size =
		ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
321 322
	if (card->ext_csd.rev >= 3) {
		u8 sa_shift = ext_csd[EXT_CSD_S_A_TIMEOUT];
323 324 325 326
		card->ext_csd.part_config = ext_csd[EXT_CSD_PART_CONFIG];

		/* EXT_CSD value is in units of 10ms, but we store in ms */
		card->ext_csd.part_time = 10 * ext_csd[EXT_CSD_PART_SWITCH_TIME];
327 328 329 330 331

		/* 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];
332 333 334 335 336 337
		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;
A
Andrei Warkentin 已提交
338 339

		card->ext_csd.rel_sectors = ext_csd[EXT_CSD_REL_WR_SEC_C];
340 341 342 343 344

		/*
		 * There are two boot regions of equal size, defined in
		 * multiples of 128K.
		 */
345 346 347 348 349 350 351 352
		if (ext_csd[EXT_CSD_BOOT_MULT] && mmc_boot_partition_access(card->host)) {
			for (idx = 0; idx < MMC_NUM_BOOT_PARTITION; idx++) {
				part_size = ext_csd[EXT_CSD_BOOT_MULT] << 17;
				mmc_part_add(card, part_size,
					EXT_CSD_PART_CONFIG_ACC_BOOT0 + idx,
					"boot%d", idx, true);
			}
		}
353 354
	}

355 356 357 358 359 360 361 362 363 364
	card->ext_csd.raw_hc_erase_gap_size =
		ext_csd[EXT_CSD_PARTITION_ATTRIBUTE];
	card->ext_csd.raw_sec_trim_mult =
		ext_csd[EXT_CSD_SEC_TRIM_MULT];
	card->ext_csd.raw_sec_erase_mult =
		ext_csd[EXT_CSD_SEC_ERASE_MULT];
	card->ext_csd.raw_sec_feature_support =
		ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT];
	card->ext_csd.raw_trim_mult =
		ext_csd[EXT_CSD_TRIM_MULT];
365
	if (card->ext_csd.rev >= 4) {
366 367 368 369 370
		/*
		 * Enhanced area feature support -- check whether the eMMC
		 * card has the Enhanced area enabled.  If so, export enhanced
		 * area offset and size to user by adding sysfs interface.
		 */
371
		card->ext_csd.raw_partition_support = ext_csd[EXT_CSD_PARTITION_SUPPORT];
372
		if ((ext_csd[EXT_CSD_PARTITION_SUPPORT] & 0x2) &&
373
		    (ext_csd[EXT_CSD_PARTITION_ATTRIBUTE] & 0x1)) {
374
			hc_erase_grp_sz =
375
				ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
376
			hc_wp_grp_sz =
377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404
				ext_csd[EXT_CSD_HC_WP_GRP_SIZE];

			card->ext_csd.enhanced_area_en = 1;
			/*
			 * calculate the enhanced data area offset, in bytes
			 */
			card->ext_csd.enhanced_area_offset =
				(ext_csd[139] << 24) + (ext_csd[138] << 16) +
				(ext_csd[137] << 8) + ext_csd[136];
			if (mmc_card_blockaddr(card))
				card->ext_csd.enhanced_area_offset <<= 9;
			/*
			 * calculate the enhanced data area size, in kilobytes
			 */
			card->ext_csd.enhanced_area_size =
				(ext_csd[142] << 16) + (ext_csd[141] << 8) +
				ext_csd[140];
			card->ext_csd.enhanced_area_size *=
				(size_t)(hc_erase_grp_sz * hc_wp_grp_sz);
			card->ext_csd.enhanced_area_size <<= 9;
		} else {
			/*
			 * If the enhanced area is not enabled, disable these
			 * device attributes.
			 */
			card->ext_csd.enhanced_area_offset = -EINVAL;
			card->ext_csd.enhanced_area_size = -EINVAL;
		}
405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439

		/*
		 * General purpose partition feature support --
		 * If ext_csd has the size of general purpose partitions,
		 * set size, part_cfg, partition name in mmc_part.
		 */
		if (ext_csd[EXT_CSD_PARTITION_SUPPORT] &
			EXT_CSD_PART_SUPPORT_PART_EN) {
			if (card->ext_csd.enhanced_area_en != 1) {
				hc_erase_grp_sz =
					ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
				hc_wp_grp_sz =
					ext_csd[EXT_CSD_HC_WP_GRP_SIZE];

				card->ext_csd.enhanced_area_en = 1;
			}

			for (idx = 0; idx < MMC_NUM_GP_PARTITION; idx++) {
				if (!ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3] &&
				!ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 1] &&
				!ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 2])
					continue;
				part_size =
				(ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 2]
					<< 16) +
				(ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3 + 1]
					<< 8) +
				ext_csd[EXT_CSD_GP_SIZE_MULT + idx * 3];
				part_size *= (size_t)(hc_erase_grp_sz *
					hc_wp_grp_sz);
				mmc_part_add(card, part_size << 19,
					EXT_CSD_PART_CONFIG_ACC_GP0 + idx,
					"gp%d", idx, false);
			}
		}
440 441 442 443 444 445 446 447
		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];
448 449
	}

450
	if (card->ext_csd.rev >= 5) {
451 452 453 454 455 456 457 458 459 460 461 462 463 464 465
		/* check whether the eMMC card supports HPI */
		if (ext_csd[EXT_CSD_HPI_FEATURES] & 0x1) {
			card->ext_csd.hpi = 1;
			if (ext_csd[EXT_CSD_HPI_FEATURES] & 0x2)
				card->ext_csd.hpi_cmd =	MMC_STOP_TRANSMISSION;
			else
				card->ext_csd.hpi_cmd = MMC_SEND_STATUS;
			/*
			 * Indicate the maximum timeout to close
			 * a command interrupted by HPI
			 */
			card->ext_csd.out_of_int_time =
				ext_csd[EXT_CSD_OUT_OF_INTERRUPT_TIME] * 10;
		}

A
Andrei Warkentin 已提交
466
		card->ext_csd.rel_param = ext_csd[EXT_CSD_WR_REL_PARAM];
467 468
		card->ext_csd.rst_n_function = ext_csd[EXT_CSD_RST_N_FUNCTION];
	}
A
Andrei Warkentin 已提交
469

470
	card->ext_csd.raw_erased_mem_count = ext_csd[EXT_CSD_ERASED_MEM_CONT];
471 472 473 474 475
	if (ext_csd[EXT_CSD_ERASED_MEM_CONT])
		card->erased_byte = 0xFF;
	else
		card->erased_byte = 0x0;

476
	/* eMMC v4.5 or later */
477
	if (card->ext_csd.rev >= 6) {
478 479
		card->ext_csd.feature_support |= MMC_DISCARD_FEATURE;

480 481
		card->ext_csd.generic_cmd6_time = 10 *
			ext_csd[EXT_CSD_GENERIC_CMD6_TIME];
482 483
		card->ext_csd.power_off_longtime = 10 *
			ext_csd[EXT_CSD_POWER_OFF_LONG_TIME];
484

485 486 487 488 489 490
		card->ext_csd.cache_size =
			ext_csd[EXT_CSD_CACHE_SIZE + 0] << 0 |
			ext_csd[EXT_CSD_CACHE_SIZE + 1] << 8 |
			ext_csd[EXT_CSD_CACHE_SIZE + 2] << 16 |
			ext_csd[EXT_CSD_CACHE_SIZE + 3] << 24;
	}
491

P
Pierre Ossman 已提交
492
out:
493 494 495 496 497
	return err;
}

static inline void mmc_free_ext_csd(u8 *ext_csd)
{
P
Pierre Ossman 已提交
498
	kfree(ext_csd);
499 500
}

P
Pierre Ossman 已提交
501

502
static int mmc_compare_ext_csds(struct mmc_card *card, unsigned bus_width)
503 504 505 506
{
	u8 *bw_ext_csd;
	int err;

507 508 509
	if (bus_width == MMC_BUS_WIDTH_1)
		return 0;

510 511
	err = mmc_get_ext_csd(card, &bw_ext_csd);

512
	if (err || bw_ext_csd == NULL) {
513 514 515 516 517 518 519 520 521
		if (bus_width != MMC_BUS_WIDTH_1)
			err = -EINVAL;
		goto out;
	}

	if (bus_width == MMC_BUS_WIDTH_1)
		goto out;

	/* only compare read only fields */
522
	err = (!(card->ext_csd.raw_partition_support ==
523
			bw_ext_csd[EXT_CSD_PARTITION_SUPPORT]) &&
524
		(card->ext_csd.raw_erased_mem_count ==
525
			bw_ext_csd[EXT_CSD_ERASED_MEM_CONT]) &&
526
		(card->ext_csd.rev ==
527
			bw_ext_csd[EXT_CSD_REV]) &&
528
		(card->ext_csd.raw_ext_csd_structure ==
529
			bw_ext_csd[EXT_CSD_STRUCTURE]) &&
530
		(card->ext_csd.raw_card_type ==
531
			bw_ext_csd[EXT_CSD_CARD_TYPE]) &&
532
		(card->ext_csd.raw_s_a_timeout ==
533
			bw_ext_csd[EXT_CSD_S_A_TIMEOUT]) &&
534
		(card->ext_csd.raw_hc_erase_gap_size ==
535
			bw_ext_csd[EXT_CSD_HC_WP_GRP_SIZE]) &&
536
		(card->ext_csd.raw_erase_timeout_mult ==
537
			bw_ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT]) &&
538
		(card->ext_csd.raw_hc_erase_grp_size ==
539
			bw_ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]) &&
540
		(card->ext_csd.raw_sec_trim_mult ==
541
			bw_ext_csd[EXT_CSD_SEC_TRIM_MULT]) &&
542
		(card->ext_csd.raw_sec_erase_mult ==
543
			bw_ext_csd[EXT_CSD_SEC_ERASE_MULT]) &&
544
		(card->ext_csd.raw_sec_feature_support ==
545
			bw_ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT]) &&
546
		(card->ext_csd.raw_trim_mult ==
547
			bw_ext_csd[EXT_CSD_TRIM_MULT]) &&
548 549 550 551 552 553 554 555
		(card->ext_csd.raw_sectors[0] ==
			bw_ext_csd[EXT_CSD_SEC_CNT + 0]) &&
		(card->ext_csd.raw_sectors[1] ==
			bw_ext_csd[EXT_CSD_SEC_CNT + 1]) &&
		(card->ext_csd.raw_sectors[2] ==
			bw_ext_csd[EXT_CSD_SEC_CNT + 2]) &&
		(card->ext_csd.raw_sectors[3] ==
			bw_ext_csd[EXT_CSD_SEC_CNT + 3]));
556 557 558 559 560
	if (err)
		err = -EINVAL;

out:
	mmc_free_ext_csd(bw_ext_csd);
P
Pierre Ossman 已提交
561 562 563
	return err;
}

564 565 566 567 568
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);
569 570
MMC_DEV_ATTR(erase_size, "%u\n", card->erase_size << 9);
MMC_DEV_ATTR(preferred_erase_size, "%u\n", card->pref_erase << 9);
571 572 573 574 575 576
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);
577 578 579
MMC_DEV_ATTR(enhanced_area_offset, "%llu\n",
		card->ext_csd.enhanced_area_offset);
MMC_DEV_ATTR(enhanced_area_size, "%u\n", card->ext_csd.enhanced_area_size);
580 581 582 583 584

static struct attribute *mmc_std_attrs[] = {
	&dev_attr_cid.attr,
	&dev_attr_csd.attr,
	&dev_attr_date.attr,
585 586
	&dev_attr_erase_size.attr,
	&dev_attr_preferred_erase_size.attr,
587 588 589 590 591 592
	&dev_attr_fwrev.attr,
	&dev_attr_hwrev.attr,
	&dev_attr_manfid.attr,
	&dev_attr_name.attr,
	&dev_attr_oemid.attr,
	&dev_attr_serial.attr,
593 594
	&dev_attr_enhanced_area_offset.attr,
	&dev_attr_enhanced_area_size.attr,
595 596 597 598 599 600 601
	NULL,
};

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

602
static const struct attribute_group *mmc_attr_groups[] = {
603 604 605 606 607 608 609 610
	&mmc_std_attr_group,
	NULL,
};

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

611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684
/*
 * Select the PowerClass for the current bus width
 * If power class is defined for 4/8 bit bus in the
 * extended CSD register, select it by executing the
 * mmc_switch command.
 */
static int mmc_select_powerclass(struct mmc_card *card,
		unsigned int bus_width, u8 *ext_csd)
{
	int err = 0;
	unsigned int pwrclass_val;
	unsigned int index = 0;
	struct mmc_host *host;

	BUG_ON(!card);

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

	if (ext_csd == NULL)
		return 0;

	/* Power class selection is supported for versions >= 4.0 */
	if (card->csd.mmca_vsn < CSD_SPEC_VER_4)
		return 0;

	/* Power class values are defined only for 4/8 bit bus */
	if (bus_width == EXT_CSD_BUS_WIDTH_1)
		return 0;

	switch (1 << host->ios.vdd) {
	case MMC_VDD_165_195:
		if (host->ios.clock <= 26000000)
			index = EXT_CSD_PWR_CL_26_195;
		else if	(host->ios.clock <= 52000000)
			index = (bus_width <= EXT_CSD_BUS_WIDTH_8) ?
				EXT_CSD_PWR_CL_52_195 :
				EXT_CSD_PWR_CL_DDR_52_195;
		else if (host->ios.clock <= 200000000)
			index = EXT_CSD_PWR_CL_200_195;
		break;
	case MMC_VDD_32_33:
	case MMC_VDD_33_34:
	case MMC_VDD_34_35:
	case MMC_VDD_35_36:
		if (host->ios.clock <= 26000000)
			index = EXT_CSD_PWR_CL_26_360;
		else if	(host->ios.clock <= 52000000)
			index = (bus_width <= EXT_CSD_BUS_WIDTH_8) ?
				EXT_CSD_PWR_CL_52_360 :
				EXT_CSD_PWR_CL_DDR_52_360;
		else if (host->ios.clock <= 200000000)
			index = EXT_CSD_PWR_CL_200_360;
		break;
	default:
		pr_warning("%s: Voltage range not supported "
			   "for power class.\n", mmc_hostname(host));
		return -EINVAL;
	}

	pwrclass_val = ext_csd[index];

	if (bus_width & (EXT_CSD_BUS_WIDTH_8 | EXT_CSD_DDR_BUS_WIDTH_8))
		pwrclass_val = (pwrclass_val & EXT_CSD_PWR_CL_8BIT_MASK) >>
				EXT_CSD_PWR_CL_8BIT_SHIFT;
	else
		pwrclass_val = (pwrclass_val & EXT_CSD_PWR_CL_4BIT_MASK) >>
				EXT_CSD_PWR_CL_4BIT_SHIFT;

	/* If the power class is different from the default value */
	if (pwrclass_val > 0) {
		err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
				 EXT_CSD_POWER_CLASS,
				 pwrclass_val,
685
				 card->ext_csd.generic_cmd6_time);
686 687 688 689 690
	}

	return err;
}

P
Pierre Ossman 已提交
691
/*
692 693
 * Handle the detection and initialisation of a card.
 *
D
Deepak Saxena 已提交
694
 * In the case of a resume, "oldcard" will contain the card
695
 * we're trying to reinitialise.
P
Pierre Ossman 已提交
696
 */
697
static int mmc_init_card(struct mmc_host *host, u32 ocr,
698
	struct mmc_card *oldcard)
P
Pierre Ossman 已提交
699 700
{
	struct mmc_card *card;
P
Philip Rakity 已提交
701
	int err, ddr = 0;
P
Pierre Ossman 已提交
702 703
	u32 cid[4];
	unsigned int max_dtr;
704
	u32 rocr;
705
	u8 *ext_csd = NULL;
P
Pierre Ossman 已提交
706 707

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

710 711 712 713
	/* Set correct bus mode for MMC before attempting init */
	if (!mmc_host_is_spi(host))
		mmc_set_bus_mode(host, MMC_BUSMODE_OPENDRAIN);

P
Pierre Ossman 已提交
714 715 716 717 718
	/*
	 * 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.
719
	 * mmc_go_idle is needed for eMMC that are asleep
P
Pierre Ossman 已提交
720 721 722 723
	 */
	mmc_go_idle(host);

	/* The extra bit indicates that we support high capacity */
724
	err = mmc_send_op_cond(host, ocr | (1 << 30), &rocr);
P
Pierre Ossman 已提交
725
	if (err)
726
		goto err;
P
Pierre Ossman 已提交
727

D
David Brownell 已提交
728 729 730 731 732 733 734 735 736
	/*
	 * 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 已提交
737 738 739
	/*
	 * Fetch CID from card.
	 */
D
David Brownell 已提交
740 741 742 743
	if (mmc_host_is_spi(host))
		err = mmc_send_cid(host, cid);
	else
		err = mmc_all_send_cid(host, cid);
P
Pierre Ossman 已提交
744
	if (err)
P
Pierre Ossman 已提交
745 746
		goto err;

747
	if (oldcard) {
P
Pierre Ossman 已提交
748 749
		if (memcmp(cid, oldcard->raw_cid, sizeof(cid)) != 0) {
			err = -ENOENT;
750
			goto err;
P
Pierre Ossman 已提交
751
		}
752 753 754 755 756 757

		card = oldcard;
	} else {
		/*
		 * Allocate card structure.
		 */
758
		card = mmc_alloc_card(host, &mmc_type);
P
Pierre Ossman 已提交
759 760
		if (IS_ERR(card)) {
			err = PTR_ERR(card);
761
			goto err;
P
Pierre Ossman 已提交
762
		}
P
Pierre Ossman 已提交
763

764 765 766 767
		card->type = MMC_TYPE_MMC;
		card->rca = 1;
		memcpy(card->raw_cid, cid, sizeof(card->raw_cid));
	}
P
Pierre Ossman 已提交
768 769

	/*
D
David Brownell 已提交
770
	 * For native busses:  set card RCA and quit open drain mode.
P
Pierre Ossman 已提交
771
	 */
D
David Brownell 已提交
772 773 774 775
	if (!mmc_host_is_spi(host)) {
		err = mmc_set_relative_addr(card);
		if (err)
			goto free_card;
P
Pierre Ossman 已提交
776

D
David Brownell 已提交
777 778
		mmc_set_bus_mode(host, MMC_BUSMODE_PUSHPULL);
	}
P
Pierre Ossman 已提交
779

780 781 782 783 784
	if (!oldcard) {
		/*
		 * Fetch CSD from card.
		 */
		err = mmc_send_csd(card, card->raw_csd);
P
Pierre Ossman 已提交
785
		if (err)
786
			goto free_card;
P
Pierre Ossman 已提交
787

P
Pierre Ossman 已提交
788
		err = mmc_decode_csd(card);
P
Pierre Ossman 已提交
789
		if (err)
P
Pierre Ossman 已提交
790 791
			goto free_card;
		err = mmc_decode_cid(card);
P
Pierre Ossman 已提交
792
		if (err)
P
Pierre Ossman 已提交
793
			goto free_card;
794
	}
P
Pierre Ossman 已提交
795 796

	/*
797
	 * Select card, as all following commands rely on that.
P
Pierre Ossman 已提交
798
	 */
D
David Brownell 已提交
799 800 801 802 803
	if (!mmc_host_is_spi(host)) {
		err = mmc_select_card(card);
		if (err)
			goto free_card;
	}
P
Pierre Ossman 已提交
804

805 806
	if (!oldcard) {
		/*
D
David Brownell 已提交
807
		 * Fetch and process extended CSD.
808
		 */
809 810 811 812 813

		err = mmc_get_ext_csd(card, &ext_csd);
		if (err)
			goto free_card;
		err = mmc_read_ext_csd(card, ext_csd);
P
Pierre Ossman 已提交
814
		if (err)
815
			goto free_card;
816 817 818 819 820 821 822 823 824

		/* If doing byte addressing, check if required to do sector
		 * addressing.  Handle the case of <2GB cards needing sector
		 * addressing.  See section 8.1 JEDEC Standard JED84-A441;
		 * ocr register has bit 30 set for sector addressing.
		 */
		if (!(mmc_card_blockaddr(card)) && (rocr & (1<<30)))
			mmc_card_set_blockaddr(card);

825 826
		/* Erase size depends on CSD and Extended CSD */
		mmc_set_erase_size(card);
827
	}
P
Pierre Ossman 已提交
828

829 830
	/*
	 * If enhanced_area_en is TRUE, host needs to enable ERASE_GRP_DEF
L
Lucas De Marchi 已提交
831
	 * bit.  This bit will be lost every time after a reset or power off.
832 833 834
	 */
	if (card->ext_csd.enhanced_area_en) {
		err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
835 836
				 EXT_CSD_ERASE_GROUP_DEF, 1,
				 card->ext_csd.generic_cmd6_time);
837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860

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

		if (err) {
			err = 0;
			/*
			 * Just disable enhanced area off & sz
			 * will try to enable ERASE_GROUP_DEF
			 * during next time reinit
			 */
			card->ext_csd.enhanced_area_offset = -EINVAL;
			card->ext_csd.enhanced_area_size = -EINVAL;
		} else {
			card->ext_csd.erase_group_def = 1;
			/*
			 * enable ERASE_GRP_DEF successfully.
			 * This will affect the erase size, so
			 * here need to reset erase size
			 */
			mmc_set_erase_size(card);
		}
	}

861 862 863
	/*
	 * Ensure eMMC user default partition is enabled
	 */
864 865 866 867 868 869 870
	if (card->ext_csd.part_config & EXT_CSD_PART_CONFIG_ACC_MASK) {
		card->ext_csd.part_config &= ~EXT_CSD_PART_CONFIG_ACC_MASK;
		err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_PART_CONFIG,
				 card->ext_csd.part_config,
				 card->ext_csd.part_time);
		if (err && err != -EBADMSG)
			goto free_card;
871 872
	}

873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889
	/*
	 * If the host supports the power_off_notify capability then
	 * set the notification byte in the ext_csd register of device
	 */
	if ((host->caps2 & MMC_CAP2_POWEROFF_NOTIFY) &&
	    (card->poweroff_notify_state == MMC_NO_POWER_NOTIFICATION)) {
		err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
				 EXT_CSD_POWER_OFF_NOTIFICATION,
				 EXT_CSD_POWER_ON,
				 card->ext_csd.generic_cmd6_time);
		if (err && err != -EBADMSG)
			goto free_card;
	}

	if (!err)
		card->poweroff_notify_state = MMC_POWERED_ON;

890 891 892 893 894 895
	/*
	 * 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,
896 897
				 EXT_CSD_HS_TIMING, 1,
				 card->ext_csd.generic_cmd6_time);
898
		if (err && err != -EBADMSG)
899 900
			goto free_card;

901
		if (err) {
902
			pr_warning("%s: switch to highspeed failed\n",
903 904 905 906 907 908
			       mmc_hostname(card->host));
			err = 0;
		} else {
			mmc_card_set_highspeed(card);
			mmc_set_timing(card->host, MMC_TIMING_MMC_HS);
		}
909 910
	}

911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926
	/*
	 * Enable HPI feature (if supported)
	 */
	if (card->ext_csd.hpi) {
		err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
			EXT_CSD_HPI_MGMT, 1, 0);
		if (err && err != -EBADMSG)
			goto free_card;
		if (err) {
			pr_warning("%s: Enabling HPI failed\n",
				   mmc_hostname(card->host));
			err = 0;
		} else
			card->ext_csd.hpi_en = 1;
	}

P
Pierre Ossman 已提交
927 928 929 930 931 932 933 934 935 936 937 938 939 940
	/*
	 * 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 已提交
941
	/*
942
	 * Indicate DDR mode (if supported).
H
Hanumath Prasad 已提交
943 944 945
	 */
	if (mmc_card_highspeed(card)) {
		if ((card->ext_csd.card_type & EXT_CSD_CARD_TYPE_DDR_1_8V)
946 947 948
			&& ((host->caps & (MMC_CAP_1_8V_DDR |
			     MMC_CAP_UHS_DDR50))
				== (MMC_CAP_1_8V_DDR | MMC_CAP_UHS_DDR50)))
A
Adrian Hunter 已提交
949
				ddr = MMC_1_8V_DDR_MODE;
H
Hanumath Prasad 已提交
950
		else if ((card->ext_csd.card_type & EXT_CSD_CARD_TYPE_DDR_1_2V)
951 952 953
			&& ((host->caps & (MMC_CAP_1_2V_DDR |
			     MMC_CAP_UHS_DDR50))
				== (MMC_CAP_1_2V_DDR | MMC_CAP_UHS_DDR50)))
A
Adrian Hunter 已提交
954
				ddr = MMC_1_2V_DDR_MODE;
H
Hanumath Prasad 已提交
955 956
	}

957
	/*
958
	 * Activate wide bus and DDR (if supported).
959 960
	 */
	if ((card->csd.mmca_vsn >= CSD_SPEC_VER_4) &&
J
Jarkko Lavinen 已提交
961
	    (host->caps & (MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA))) {
962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981
		static unsigned ext_csd_bits[][2] = {
			{ EXT_CSD_BUS_WIDTH_8, EXT_CSD_DDR_BUS_WIDTH_8 },
			{ EXT_CSD_BUS_WIDTH_4, EXT_CSD_DDR_BUS_WIDTH_4 },
			{ EXT_CSD_BUS_WIDTH_1, EXT_CSD_BUS_WIDTH_1 },
		};
		static unsigned bus_widths[] = {
			MMC_BUS_WIDTH_8,
			MMC_BUS_WIDTH_4,
			MMC_BUS_WIDTH_1
		};
		unsigned idx, bus_width = 0;

		if (host->caps & MMC_CAP_8_BIT_DATA)
			idx = 0;
		else
			idx = 1;
		for (; idx < ARRAY_SIZE(bus_widths); idx++) {
			bus_width = bus_widths[idx];
			if (bus_width == MMC_BUS_WIDTH_1)
				ddr = 0; /* no DDR for 1-bit width */
982 983 984 985 986 987 988 989
			err = mmc_select_powerclass(card, ext_csd_bits[idx][0],
						    ext_csd);
			if (err)
				pr_err("%s: power class selection to "
				       "bus width %d failed\n",
				       mmc_hostname(card->host),
				       1 << bus_width);

990 991
			err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
					 EXT_CSD_BUS_WIDTH,
992
					 ext_csd_bits[idx][0],
993
					 card->ext_csd.generic_cmd6_time);
994
			if (!err) {
995
				mmc_set_bus_width(card->host, bus_width);
996

997 998
				/*
				 * If controller can't handle bus width test,
999 1000
				 * compare ext_csd previously read in 1 bit mode
				 * against ext_csd at new bus width
1001 1002
				 */
				if (!(host->caps & MMC_CAP_BUS_WIDTH_TEST))
1003 1004 1005 1006
					err = mmc_compare_ext_csds(card,
						bus_width);
				else
					err = mmc_bus_test(card, bus_width);
1007 1008 1009
				if (!err)
					break;
			}
J
Jarkko Lavinen 已提交
1010 1011
		}

1012
		if (!err && ddr) {
1013 1014 1015 1016 1017 1018 1019 1020
			err = mmc_select_powerclass(card, ext_csd_bits[idx][1],
						    ext_csd);
			if (err)
				pr_err("%s: power class selection to "
				       "bus width %d ddr %d failed\n",
				       mmc_hostname(card->host),
				       1 << bus_width, ddr);

1021
			err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1022 1023
					 EXT_CSD_BUS_WIDTH,
					 ext_csd_bits[idx][1],
1024
					 card->ext_csd.generic_cmd6_time);
1025
		}
1026
		if (err) {
1027
			pr_warning("%s: switch to bus width %d ddr %d "
1028 1029 1030 1031
				"failed\n", mmc_hostname(card->host),
				1 << bus_width, ddr);
			goto free_card;
		} else if (ddr) {
1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051
			/*
			 * eMMC cards can support 3.3V to 1.2V i/o (vccq)
			 * signaling.
			 *
			 * EXT_CSD_CARD_TYPE_DDR_1_8V means 3.3V or 1.8V vccq.
			 *
			 * 1.8V vccq at 3.3V core voltage (vcc) is not required
			 * in the JEDEC spec for DDR.
			 *
			 * Do not force change in vccq since we are obviously
			 * working and no change to vccq is needed.
			 *
			 * WARNING: eMMC rules are NOT the same as SD DDR
			 */
			if (ddr == EXT_CSD_CARD_TYPE_DDR_1_2V) {
				err = mmc_set_signal_voltage(host,
					MMC_SIGNAL_VOLTAGE_120, 0);
				if (err)
					goto err;
			}
1052
			mmc_card_set_ddr_mode(card);
1053 1054
			mmc_set_timing(card->host, MMC_TIMING_UHS_DDR50);
			mmc_set_bus_width(card->host, bus_width);
1055
		}
1056 1057
	}

1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074
	/*
	 * If cache size is higher than 0, this indicates
	 * the existence of cache and it can be turned on.
	 */
	if ((host->caps2 & MMC_CAP2_CACHE_CTRL) &&
			card->ext_csd.cache_size > 0) {
		err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
				EXT_CSD_CACHE_CTRL, 1, 0);
		if (err && err != -EBADMSG)
			goto free_card;

		/*
		 * Only if no error, cache is turned on successfully.
		 */
		card->ext_csd.cache_ctrl = err ? 0 : 1;
	}

1075 1076 1077
	if (!oldcard)
		host->card = card;

1078
	mmc_free_ext_csd(ext_csd);
P
Pierre Ossman 已提交
1079
	return 0;
1080 1081 1082 1083 1084

free_card:
	if (!oldcard)
		mmc_remove_card(card);
err:
1085
	mmc_free_ext_csd(ext_csd);
1086

P
Pierre Ossman 已提交
1087
	return err;
1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120
}

/*
 * 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 已提交
1121
	if (err) {
P
Pierre Ossman 已提交
1122
		mmc_remove(host);
1123 1124 1125

		mmc_claim_host(host);
		mmc_detach_bus(host);
1126
		mmc_power_off(host);
1127 1128 1129 1130 1131 1132 1133
		mmc_release_host(host);
	}
}

/*
 * Suspend callback from host.
 */
1134
static int mmc_suspend(struct mmc_host *host)
1135
{
1136 1137
	int err = 0;

1138 1139
	BUG_ON(!host);
	BUG_ON(!host->card);
P
Pierre Ossman 已提交
1140

1141
	mmc_claim_host(host);
1142 1143 1144
	if (mmc_card_can_sleep(host))
		err = mmc_card_sleep(host);
	else if (!mmc_host_is_spi(host))
D
David Brownell 已提交
1145
		mmc_deselect_cards(host);
1146
	host->card->state &= ~MMC_STATE_HIGHSPEED;
P
Pierre Ossman 已提交
1147
	mmc_release_host(host);
1148

1149
	return err;
1150
}
P
Pierre Ossman 已提交
1151

1152 1153 1154 1155 1156 1157
/*
 * Resume callback from host.
 *
 * This function tries to determine if the same card is still present
 * and, if so, restore all state to it.
 */
1158
static int mmc_resume(struct mmc_host *host)
1159 1160 1161 1162 1163 1164 1165
{
	int err;

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

	mmc_claim_host(host);
1166
	err = mmc_init_card(host, host->ocr, host->card);
1167 1168
	mmc_release_host(host);

1169
	return err;
1170 1171
}

1172
static int mmc_power_restore(struct mmc_host *host)
1173
{
1174 1175
	int ret;

1176 1177
	host->card->state &= ~MMC_STATE_HIGHSPEED;
	mmc_claim_host(host);
1178
	ret = mmc_init_card(host, host->ocr, host->card);
1179
	mmc_release_host(host);
1180 1181

	return ret;
1182 1183
}

1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213
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;
}

1214
static const struct mmc_bus_ops mmc_ops = {
1215 1216
	.awake = mmc_awake,
	.sleep = mmc_sleep,
1217 1218 1219 1220
	.remove = mmc_remove,
	.detect = mmc_detect,
	.suspend = NULL,
	.resume = NULL,
1221
	.power_restore = mmc_power_restore,
1222 1223 1224
};

static const struct mmc_bus_ops mmc_ops_unsafe = {
1225 1226
	.awake = mmc_awake,
	.sleep = mmc_sleep,
1227 1228 1229 1230
	.remove = mmc_remove,
	.detect = mmc_detect,
	.suspend = mmc_suspend,
	.resume = mmc_resume,
1231
	.power_restore = mmc_power_restore,
1232 1233
};

1234 1235 1236 1237
static void mmc_attach_bus_ops(struct mmc_host *host)
{
	const struct mmc_bus_ops *bus_ops;

1238
	if (!mmc_card_is_removable(host))
1239 1240 1241 1242 1243 1244
		bus_ops = &mmc_ops_unsafe;
	else
		bus_ops = &mmc_ops;
	mmc_attach_bus(host, bus_ops);
}

1245 1246 1247
/*
 * Starting point for MMC card init.
 */
1248
int mmc_attach_mmc(struct mmc_host *host)
1249 1250
{
	int err;
1251
	u32 ocr;
1252 1253

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

1256 1257 1258 1259
	/* Set correct bus mode for MMC before attempting attach */
	if (!mmc_host_is_spi(host))
		mmc_set_bus_mode(host, MMC_BUSMODE_OPENDRAIN);

1260 1261 1262 1263
	err = mmc_send_op_cond(host, 0, &ocr);
	if (err)
		return err;

1264
	mmc_attach_bus_ops(host);
1265 1266
	if (host->ocr_avail_mmc)
		host->ocr_avail = host->ocr_avail_mmc;
1267

D
David Brownell 已提交
1268 1269 1270 1271 1272 1273 1274 1275 1276
	/*
	 * 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;
	}

1277 1278 1279 1280 1281
	/*
	 * Sanity check the voltages that the card claims to
	 * support.
	 */
	if (ocr & 0x7F) {
1282
		pr_warning("%s: card claims to support voltages "
1283 1284 1285 1286 1287 1288 1289 1290 1291 1292
		       "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?
	 */
1293 1294
	if (!host->ocr) {
		err = -EINVAL;
1295
		goto err;
1296
	}
1297 1298 1299 1300

	/*
	 * Detect and init the card.
	 */
1301
	err = mmc_init_card(host, host->ocr, NULL);
P
Pierre Ossman 已提交
1302
	if (err)
1303 1304 1305
		goto err;

	mmc_release_host(host);
P
Pierre Ossman 已提交
1306
	err = mmc_add_card(host->card);
1307
	mmc_claim_host(host);
P
Pierre Ossman 已提交
1308
	if (err)
1309
		goto remove_card;
P
Pierre Ossman 已提交
1310 1311 1312

	return 0;

1313
remove_card:
1314
	mmc_release_host(host);
1315
	mmc_remove_card(host->card);
1316
	mmc_claim_host(host);
1317
	host->card = NULL;
P
Pierre Ossman 已提交
1318 1319 1320
err:
	mmc_detach_bus(host);

1321
	pr_err("%s: error %d whilst initialising MMC card\n",
1322 1323
		mmc_hostname(host), err);

P
Pierre Ossman 已提交
1324
	return err;
P
Pierre Ossman 已提交
1325
}