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>
15
#include <linux/stat.h>
P
Pierre Ossman 已提交
16 17 18 19 20 21

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

#include "core.h"
P
Pierre Ossman 已提交
22
#include "bus.h"
P
Pierre Ossman 已提交
23
#include "mmc_ops.h"
24
#include "sd_ops.h"
P
Pierre Ossman 已提交
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 61

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

	BUG_ON(!card);

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

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

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

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

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

317 318 319 320 321
	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];
322 323
	if (card->ext_csd.rev >= 3) {
		u8 sa_shift = ext_csd[EXT_CSD_S_A_TIMEOUT];
324 325 326 327
		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];
328 329 330 331 332

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

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

		/*
		 * There are two boot regions of equal size, defined in
		 * multiples of 128K.
		 */
346 347 348 349 350 351 352 353
		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);
			}
		}
354 355
	}

356 357 358 359 360 361 362 363 364 365
	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];
366
	if (card->ext_csd.rev >= 4) {
367 368 369 370 371
		/*
		 * 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.
		 */
372
		card->ext_csd.raw_partition_support = ext_csd[EXT_CSD_PARTITION_SUPPORT];
373
		if ((ext_csd[EXT_CSD_PARTITION_SUPPORT] & 0x2) &&
374
		    (ext_csd[EXT_CSD_PARTITION_ATTRIBUTE] & 0x1)) {
375
			hc_erase_grp_sz =
376
				ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
377
			hc_wp_grp_sz =
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 405
				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;
		}
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 440

		/*
		 * 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);
			}
		}
441 442 443 444 445 446 447 448
		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];
449 450
	}

451
	if (card->ext_csd.rev >= 5) {
452 453 454 455 456 457 458 459 460 461 462 463 464 465 466
		/* 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 已提交
467
		card->ext_csd.rel_param = ext_csd[EXT_CSD_WR_REL_PARAM];
468 469
		card->ext_csd.rst_n_function = ext_csd[EXT_CSD_RST_N_FUNCTION];
	}
A
Andrei Warkentin 已提交
470

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

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

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

486 487 488 489 490 491
		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;
	}
492

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

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

P
Pierre Ossman 已提交
502

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

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

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

513
	if (err || bw_ext_csd == NULL) {
514 515 516 517 518 519 520 521 522
		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 */
523
	err = (!(card->ext_csd.raw_partition_support ==
524
			bw_ext_csd[EXT_CSD_PARTITION_SUPPORT]) &&
525
		(card->ext_csd.raw_erased_mem_count ==
526
			bw_ext_csd[EXT_CSD_ERASED_MEM_CONT]) &&
527
		(card->ext_csd.rev ==
528
			bw_ext_csd[EXT_CSD_REV]) &&
529
		(card->ext_csd.raw_ext_csd_structure ==
530
			bw_ext_csd[EXT_CSD_STRUCTURE]) &&
531
		(card->ext_csd.raw_card_type ==
532
			bw_ext_csd[EXT_CSD_CARD_TYPE]) &&
533
		(card->ext_csd.raw_s_a_timeout ==
534
			bw_ext_csd[EXT_CSD_S_A_TIMEOUT]) &&
535
		(card->ext_csd.raw_hc_erase_gap_size ==
536
			bw_ext_csd[EXT_CSD_HC_WP_GRP_SIZE]) &&
537
		(card->ext_csd.raw_erase_timeout_mult ==
538
			bw_ext_csd[EXT_CSD_ERASE_TIMEOUT_MULT]) &&
539
		(card->ext_csd.raw_hc_erase_grp_size ==
540
			bw_ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]) &&
541
		(card->ext_csd.raw_sec_trim_mult ==
542
			bw_ext_csd[EXT_CSD_SEC_TRIM_MULT]) &&
543
		(card->ext_csd.raw_sec_erase_mult ==
544
			bw_ext_csd[EXT_CSD_SEC_ERASE_MULT]) &&
545
		(card->ext_csd.raw_sec_feature_support ==
546
			bw_ext_csd[EXT_CSD_SEC_FEATURE_SUPPORT]) &&
547
		(card->ext_csd.raw_trim_mult ==
548
			bw_ext_csd[EXT_CSD_TRIM_MULT]) &&
549 550 551 552 553 554 555 556
		(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]));
557 558 559 560 561
	if (err)
		err = -EINVAL;

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

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

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

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

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

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

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 685
/*
 * 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,
686
				 card->ext_csd.generic_cmd6_time);
687 688 689 690 691
	}

	return err;
}

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

		/* 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);

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

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

		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);
		}
	}

862 863 864
	/*
	 * Ensure eMMC user default partition is enabled
	 */
865 866 867 868 869 870 871
	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;
872 873
	}

874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890
	/*
	 * 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;

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

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

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

958
	/*
959
	 * Activate wide bus and DDR (if supported).
960 961
	 */
	if ((card->csd.mmca_vsn >= CSD_SPEC_VER_4) &&
J
Jarkko Lavinen 已提交
962
	    (host->caps & (MMC_CAP_4_BIT_DATA | MMC_CAP_8_BIT_DATA))) {
963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982
		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 */
983 984 985 986 987 988 989 990
			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);

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

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

1013
		if (!err && ddr) {
1014 1015 1016 1017 1018 1019 1020 1021
			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);

1022
			err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
1023 1024
					 EXT_CSD_BUS_WIDTH,
					 ext_csd_bits[idx][1],
1025
					 card->ext_csd.generic_cmd6_time);
1026
		}
1027
		if (err) {
1028
			pr_warning("%s: switch to bus width %d ddr %d "
1029 1030 1031 1032
				"failed\n", mmc_hostname(card->host),
				1 << bus_width, ddr);
			goto free_card;
		} else if (ddr) {
1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052
			/*
			 * 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;
			}
1053
			mmc_card_set_ddr_mode(card);
1054 1055
			mmc_set_timing(card->host, MMC_TIMING_UHS_DDR50);
			mmc_set_bus_width(card->host, bus_width);
1056
		}
1057 1058
	}

1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075
	/*
	 * 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;
	}

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

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

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

P
Pierre Ossman 已提交
1088
	return err;
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 1121
}

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

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

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

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

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

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

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

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

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

1170
	return err;
1171 1172
}

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

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

	return ret;
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 1214
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;
}

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

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

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

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

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

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

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

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

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

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

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

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

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

	return 0;

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

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

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