xref: /openbmc/u-boot/drivers/mmc/mmc.c (revision 90101386)
1 /*
2  * Copyright 2008, Freescale Semiconductor, Inc
3  * Andy Fleming
4  *
5  * Based vaguely on the Linux code
6  *
7  * SPDX-License-Identifier:	GPL-2.0+
8  */
9 
10 #include <config.h>
11 #include <common.h>
12 #include <command.h>
13 #include <dm.h>
14 #include <dm/device-internal.h>
15 #include <errno.h>
16 #include <mmc.h>
17 #include <part.h>
18 #include <power/regulator.h>
19 #include <malloc.h>
20 #include <memalign.h>
21 #include <linux/list.h>
22 #include <div64.h>
23 #include "mmc_private.h"
24 
25 static const unsigned int sd_au_size[] = {
26 	0,		SZ_16K / 512,		SZ_32K / 512,
27 	SZ_64K / 512,	SZ_128K / 512,		SZ_256K / 512,
28 	SZ_512K / 512,	SZ_1M / 512,		SZ_2M / 512,
29 	SZ_4M / 512,	SZ_8M / 512,		(SZ_8M + SZ_4M) / 512,
30 	SZ_16M / 512,	(SZ_16M + SZ_8M) / 512,	SZ_32M / 512,	SZ_64M / 512,
31 };
32 
33 #if CONFIG_IS_ENABLED(MMC_TINY)
34 static struct mmc mmc_static;
35 struct mmc *find_mmc_device(int dev_num)
36 {
37 	return &mmc_static;
38 }
39 
40 void mmc_do_preinit(void)
41 {
42 	struct mmc *m = &mmc_static;
43 #ifdef CONFIG_FSL_ESDHC_ADAPTER_IDENT
44 	mmc_set_preinit(m, 1);
45 #endif
46 	if (m->preinit)
47 		mmc_start_init(m);
48 }
49 
50 struct blk_desc *mmc_get_blk_desc(struct mmc *mmc)
51 {
52 	return &mmc->block_dev;
53 }
54 #endif
55 
56 #ifndef CONFIG_DM_MMC_OPS
57 __weak int board_mmc_getwp(struct mmc *mmc)
58 {
59 	return -1;
60 }
61 
62 int mmc_getwp(struct mmc *mmc)
63 {
64 	int wp;
65 
66 	wp = board_mmc_getwp(mmc);
67 
68 	if (wp < 0) {
69 		if (mmc->cfg->ops->getwp)
70 			wp = mmc->cfg->ops->getwp(mmc);
71 		else
72 			wp = 0;
73 	}
74 
75 	return wp;
76 }
77 
78 __weak int board_mmc_getcd(struct mmc *mmc)
79 {
80 	return -1;
81 }
82 #endif
83 
84 #ifdef CONFIG_MMC_TRACE
85 void mmmc_trace_before_send(struct mmc *mmc, struct mmc_cmd *cmd)
86 {
87 	printf("CMD_SEND:%d\n", cmd->cmdidx);
88 	printf("\t\tARG\t\t\t 0x%08X\n", cmd->cmdarg);
89 }
90 
91 void mmmc_trace_after_send(struct mmc *mmc, struct mmc_cmd *cmd, int ret)
92 {
93 	int i;
94 	u8 *ptr;
95 
96 	if (ret) {
97 		printf("\t\tRET\t\t\t %d\n", ret);
98 	} else {
99 		switch (cmd->resp_type) {
100 		case MMC_RSP_NONE:
101 			printf("\t\tMMC_RSP_NONE\n");
102 			break;
103 		case MMC_RSP_R1:
104 			printf("\t\tMMC_RSP_R1,5,6,7 \t 0x%08X \n",
105 				cmd->response[0]);
106 			break;
107 		case MMC_RSP_R1b:
108 			printf("\t\tMMC_RSP_R1b\t\t 0x%08X \n",
109 				cmd->response[0]);
110 			break;
111 		case MMC_RSP_R2:
112 			printf("\t\tMMC_RSP_R2\t\t 0x%08X \n",
113 				cmd->response[0]);
114 			printf("\t\t          \t\t 0x%08X \n",
115 				cmd->response[1]);
116 			printf("\t\t          \t\t 0x%08X \n",
117 				cmd->response[2]);
118 			printf("\t\t          \t\t 0x%08X \n",
119 				cmd->response[3]);
120 			printf("\n");
121 			printf("\t\t\t\t\tDUMPING DATA\n");
122 			for (i = 0; i < 4; i++) {
123 				int j;
124 				printf("\t\t\t\t\t%03d - ", i*4);
125 				ptr = (u8 *)&cmd->response[i];
126 				ptr += 3;
127 				for (j = 0; j < 4; j++)
128 					printf("%02X ", *ptr--);
129 				printf("\n");
130 			}
131 			break;
132 		case MMC_RSP_R3:
133 			printf("\t\tMMC_RSP_R3,4\t\t 0x%08X \n",
134 				cmd->response[0]);
135 			break;
136 		default:
137 			printf("\t\tERROR MMC rsp not supported\n");
138 			break;
139 		}
140 	}
141 }
142 
143 void mmc_trace_state(struct mmc *mmc, struct mmc_cmd *cmd)
144 {
145 	int status;
146 
147 	status = (cmd->response[0] & MMC_STATUS_CURR_STATE) >> 9;
148 	printf("CURR STATE:%d\n", status);
149 }
150 #endif
151 
152 #ifndef CONFIG_DM_MMC_OPS
153 int mmc_send_cmd(struct mmc *mmc, struct mmc_cmd *cmd, struct mmc_data *data)
154 {
155 	int ret;
156 
157 	mmmc_trace_before_send(mmc, cmd);
158 	ret = mmc->cfg->ops->send_cmd(mmc, cmd, data);
159 	mmmc_trace_after_send(mmc, cmd, ret);
160 
161 	return ret;
162 }
163 #endif
164 
165 int mmc_send_status(struct mmc *mmc, int timeout)
166 {
167 	struct mmc_cmd cmd;
168 	int err, retries = 5;
169 
170 	cmd.cmdidx = MMC_CMD_SEND_STATUS;
171 	cmd.resp_type = MMC_RSP_R1;
172 	if (!mmc_host_is_spi(mmc))
173 		cmd.cmdarg = mmc->rca << 16;
174 
175 	while (1) {
176 		err = mmc_send_cmd(mmc, &cmd, NULL);
177 		if (!err) {
178 			if ((cmd.response[0] & MMC_STATUS_RDY_FOR_DATA) &&
179 			    (cmd.response[0] & MMC_STATUS_CURR_STATE) !=
180 			     MMC_STATE_PRG)
181 				break;
182 			else if (cmd.response[0] & MMC_STATUS_MASK) {
183 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
184 				printf("Status Error: 0x%08X\n",
185 					cmd.response[0]);
186 #endif
187 				return -ECOMM;
188 			}
189 		} else if (--retries < 0)
190 			return err;
191 
192 		if (timeout-- <= 0)
193 			break;
194 
195 		udelay(1000);
196 	}
197 
198 	mmc_trace_state(mmc, &cmd);
199 	if (timeout <= 0) {
200 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
201 		printf("Timeout waiting card ready\n");
202 #endif
203 		return -ETIMEDOUT;
204 	}
205 
206 	return 0;
207 }
208 
209 int mmc_set_blocklen(struct mmc *mmc, int len)
210 {
211 	struct mmc_cmd cmd;
212 
213 	if (mmc->ddr_mode)
214 		return 0;
215 
216 	cmd.cmdidx = MMC_CMD_SET_BLOCKLEN;
217 	cmd.resp_type = MMC_RSP_R1;
218 	cmd.cmdarg = len;
219 
220 	return mmc_send_cmd(mmc, &cmd, NULL);
221 }
222 
223 static int mmc_read_blocks(struct mmc *mmc, void *dst, lbaint_t start,
224 			   lbaint_t blkcnt)
225 {
226 	struct mmc_cmd cmd;
227 	struct mmc_data data;
228 
229 	if (blkcnt > 1)
230 		cmd.cmdidx = MMC_CMD_READ_MULTIPLE_BLOCK;
231 	else
232 		cmd.cmdidx = MMC_CMD_READ_SINGLE_BLOCK;
233 
234 	if (mmc->high_capacity)
235 		cmd.cmdarg = start;
236 	else
237 		cmd.cmdarg = start * mmc->read_bl_len;
238 
239 	cmd.resp_type = MMC_RSP_R1;
240 
241 	data.dest = dst;
242 	data.blocks = blkcnt;
243 	data.blocksize = mmc->read_bl_len;
244 	data.flags = MMC_DATA_READ;
245 
246 	if (mmc_send_cmd(mmc, &cmd, &data))
247 		return 0;
248 
249 	if (blkcnt > 1) {
250 		cmd.cmdidx = MMC_CMD_STOP_TRANSMISSION;
251 		cmd.cmdarg = 0;
252 		cmd.resp_type = MMC_RSP_R1b;
253 		if (mmc_send_cmd(mmc, &cmd, NULL)) {
254 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
255 			printf("mmc fail to send stop cmd\n");
256 #endif
257 			return 0;
258 		}
259 	}
260 
261 	return blkcnt;
262 }
263 
264 #ifdef CONFIG_BLK
265 ulong mmc_bread(struct udevice *dev, lbaint_t start, lbaint_t blkcnt, void *dst)
266 #else
267 ulong mmc_bread(struct blk_desc *block_dev, lbaint_t start, lbaint_t blkcnt,
268 		void *dst)
269 #endif
270 {
271 #ifdef CONFIG_BLK
272 	struct blk_desc *block_dev = dev_get_uclass_platdata(dev);
273 #endif
274 	int dev_num = block_dev->devnum;
275 	int err;
276 	lbaint_t cur, blocks_todo = blkcnt;
277 
278 	if (blkcnt == 0)
279 		return 0;
280 
281 	struct mmc *mmc = find_mmc_device(dev_num);
282 	if (!mmc)
283 		return 0;
284 
285 	if (CONFIG_IS_ENABLED(MMC_TINY))
286 		err = mmc_switch_part(mmc, block_dev->hwpart);
287 	else
288 		err = blk_dselect_hwpart(block_dev, block_dev->hwpart);
289 
290 	if (err < 0)
291 		return 0;
292 
293 	if ((start + blkcnt) > block_dev->lba) {
294 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
295 		printf("MMC: block number 0x" LBAF " exceeds max(0x" LBAF ")\n",
296 			start + blkcnt, block_dev->lba);
297 #endif
298 		return 0;
299 	}
300 
301 	if (mmc_set_blocklen(mmc, mmc->read_bl_len)) {
302 		debug("%s: Failed to set blocklen\n", __func__);
303 		return 0;
304 	}
305 
306 	do {
307 		cur = (blocks_todo > mmc->cfg->b_max) ?
308 			mmc->cfg->b_max : blocks_todo;
309 		if (mmc_read_blocks(mmc, dst, start, cur) != cur) {
310 			debug("%s: Failed to read blocks\n", __func__);
311 			return 0;
312 		}
313 		blocks_todo -= cur;
314 		start += cur;
315 		dst += cur * mmc->read_bl_len;
316 	} while (blocks_todo > 0);
317 
318 	return blkcnt;
319 }
320 
321 static int mmc_go_idle(struct mmc *mmc)
322 {
323 	struct mmc_cmd cmd;
324 	int err;
325 
326 	udelay(1000);
327 
328 	cmd.cmdidx = MMC_CMD_GO_IDLE_STATE;
329 	cmd.cmdarg = 0;
330 	cmd.resp_type = MMC_RSP_NONE;
331 
332 	err = mmc_send_cmd(mmc, &cmd, NULL);
333 
334 	if (err)
335 		return err;
336 
337 	udelay(2000);
338 
339 	return 0;
340 }
341 
342 static int sd_send_op_cond(struct mmc *mmc)
343 {
344 	int timeout = 1000;
345 	int err;
346 	struct mmc_cmd cmd;
347 
348 	while (1) {
349 		cmd.cmdidx = MMC_CMD_APP_CMD;
350 		cmd.resp_type = MMC_RSP_R1;
351 		cmd.cmdarg = 0;
352 
353 		err = mmc_send_cmd(mmc, &cmd, NULL);
354 
355 		if (err)
356 			return err;
357 
358 		cmd.cmdidx = SD_CMD_APP_SEND_OP_COND;
359 		cmd.resp_type = MMC_RSP_R3;
360 
361 		/*
362 		 * Most cards do not answer if some reserved bits
363 		 * in the ocr are set. However, Some controller
364 		 * can set bit 7 (reserved for low voltages), but
365 		 * how to manage low voltages SD card is not yet
366 		 * specified.
367 		 */
368 		cmd.cmdarg = mmc_host_is_spi(mmc) ? 0 :
369 			(mmc->cfg->voltages & 0xff8000);
370 
371 		if (mmc->version == SD_VERSION_2)
372 			cmd.cmdarg |= OCR_HCS;
373 
374 		err = mmc_send_cmd(mmc, &cmd, NULL);
375 
376 		if (err)
377 			return err;
378 
379 		if (cmd.response[0] & OCR_BUSY)
380 			break;
381 
382 		if (timeout-- <= 0)
383 			return -EOPNOTSUPP;
384 
385 		udelay(1000);
386 	}
387 
388 	if (mmc->version != SD_VERSION_2)
389 		mmc->version = SD_VERSION_1_0;
390 
391 	if (mmc_host_is_spi(mmc)) { /* read OCR for spi */
392 		cmd.cmdidx = MMC_CMD_SPI_READ_OCR;
393 		cmd.resp_type = MMC_RSP_R3;
394 		cmd.cmdarg = 0;
395 
396 		err = mmc_send_cmd(mmc, &cmd, NULL);
397 
398 		if (err)
399 			return err;
400 	}
401 
402 	mmc->ocr = cmd.response[0];
403 
404 	mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
405 	mmc->rca = 0;
406 
407 	return 0;
408 }
409 
410 static int mmc_send_op_cond_iter(struct mmc *mmc, int use_arg)
411 {
412 	struct mmc_cmd cmd;
413 	int err;
414 
415 	cmd.cmdidx = MMC_CMD_SEND_OP_COND;
416 	cmd.resp_type = MMC_RSP_R3;
417 	cmd.cmdarg = 0;
418 	if (use_arg && !mmc_host_is_spi(mmc))
419 		cmd.cmdarg = OCR_HCS |
420 			(mmc->cfg->voltages &
421 			(mmc->ocr & OCR_VOLTAGE_MASK)) |
422 			(mmc->ocr & OCR_ACCESS_MODE);
423 
424 	err = mmc_send_cmd(mmc, &cmd, NULL);
425 	if (err)
426 		return err;
427 	mmc->ocr = cmd.response[0];
428 	return 0;
429 }
430 
431 static int mmc_send_op_cond(struct mmc *mmc)
432 {
433 	int err, i;
434 
435 	/* Some cards seem to need this */
436 	mmc_go_idle(mmc);
437 
438  	/* Asking to the card its capabilities */
439 	for (i = 0; i < 2; i++) {
440 		err = mmc_send_op_cond_iter(mmc, i != 0);
441 		if (err)
442 			return err;
443 
444 		/* exit if not busy (flag seems to be inverted) */
445 		if (mmc->ocr & OCR_BUSY)
446 			break;
447 	}
448 	mmc->op_cond_pending = 1;
449 	return 0;
450 }
451 
452 static int mmc_complete_op_cond(struct mmc *mmc)
453 {
454 	struct mmc_cmd cmd;
455 	int timeout = 1000;
456 	uint start;
457 	int err;
458 
459 	mmc->op_cond_pending = 0;
460 	if (!(mmc->ocr & OCR_BUSY)) {
461 		/* Some cards seem to need this */
462 		mmc_go_idle(mmc);
463 
464 		start = get_timer(0);
465 		while (1) {
466 			err = mmc_send_op_cond_iter(mmc, 1);
467 			if (err)
468 				return err;
469 			if (mmc->ocr & OCR_BUSY)
470 				break;
471 			if (get_timer(start) > timeout)
472 				return -EOPNOTSUPP;
473 			udelay(100);
474 		}
475 	}
476 
477 	if (mmc_host_is_spi(mmc)) { /* read OCR for spi */
478 		cmd.cmdidx = MMC_CMD_SPI_READ_OCR;
479 		cmd.resp_type = MMC_RSP_R3;
480 		cmd.cmdarg = 0;
481 
482 		err = mmc_send_cmd(mmc, &cmd, NULL);
483 
484 		if (err)
485 			return err;
486 
487 		mmc->ocr = cmd.response[0];
488 	}
489 
490 	mmc->version = MMC_VERSION_UNKNOWN;
491 
492 	mmc->high_capacity = ((mmc->ocr & OCR_HCS) == OCR_HCS);
493 	mmc->rca = 1;
494 
495 	return 0;
496 }
497 
498 
499 static int mmc_send_ext_csd(struct mmc *mmc, u8 *ext_csd)
500 {
501 	struct mmc_cmd cmd;
502 	struct mmc_data data;
503 	int err;
504 
505 	/* Get the Card Status Register */
506 	cmd.cmdidx = MMC_CMD_SEND_EXT_CSD;
507 	cmd.resp_type = MMC_RSP_R1;
508 	cmd.cmdarg = 0;
509 
510 	data.dest = (char *)ext_csd;
511 	data.blocks = 1;
512 	data.blocksize = MMC_MAX_BLOCK_LEN;
513 	data.flags = MMC_DATA_READ;
514 
515 	err = mmc_send_cmd(mmc, &cmd, &data);
516 
517 	return err;
518 }
519 
520 int mmc_switch(struct mmc *mmc, u8 set, u8 index, u8 value)
521 {
522 	struct mmc_cmd cmd;
523 	int timeout = 1000;
524 	int retries = 3;
525 	int ret;
526 
527 	cmd.cmdidx = MMC_CMD_SWITCH;
528 	cmd.resp_type = MMC_RSP_R1b;
529 	cmd.cmdarg = (MMC_SWITCH_MODE_WRITE_BYTE << 24) |
530 				 (index << 16) |
531 				 (value << 8);
532 
533 	while (retries > 0) {
534 		ret = mmc_send_cmd(mmc, &cmd, NULL);
535 
536 		/* Waiting for the ready status */
537 		if (!ret) {
538 			ret = mmc_send_status(mmc, timeout);
539 			return ret;
540 		}
541 
542 		retries--;
543 	}
544 
545 	return ret;
546 
547 }
548 
549 static int mmc_change_freq(struct mmc *mmc)
550 {
551 	ALLOC_CACHE_ALIGN_BUFFER(u8, ext_csd, MMC_MAX_BLOCK_LEN);
552 	char cardtype;
553 	int err;
554 
555 	mmc->card_caps = 0;
556 
557 	if (mmc_host_is_spi(mmc))
558 		return 0;
559 
560 	/* Only version 4 supports high-speed */
561 	if (mmc->version < MMC_VERSION_4)
562 		return 0;
563 
564 	mmc->card_caps |= MMC_MODE_4BIT | MMC_MODE_8BIT;
565 
566 	err = mmc_send_ext_csd(mmc, ext_csd);
567 
568 	if (err)
569 		return err;
570 
571 	cardtype = ext_csd[EXT_CSD_CARD_TYPE] & 0xf;
572 
573 	err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_HS_TIMING, 1);
574 
575 	if (err)
576 		return err;
577 
578 	/* Now check to see that it worked */
579 	err = mmc_send_ext_csd(mmc, ext_csd);
580 
581 	if (err)
582 		return err;
583 
584 	/* No high-speed support */
585 	if (!ext_csd[EXT_CSD_HS_TIMING])
586 		return 0;
587 
588 	/* High Speed is set, there are two types: 52MHz and 26MHz */
589 	if (cardtype & EXT_CSD_CARD_TYPE_52) {
590 		if (cardtype & EXT_CSD_CARD_TYPE_DDR_1_8V)
591 			mmc->card_caps |= MMC_MODE_DDR_52MHz;
592 		mmc->card_caps |= MMC_MODE_HS_52MHz | MMC_MODE_HS;
593 	} else {
594 		mmc->card_caps |= MMC_MODE_HS;
595 	}
596 
597 	return 0;
598 }
599 
600 static int mmc_set_capacity(struct mmc *mmc, int part_num)
601 {
602 	switch (part_num) {
603 	case 0:
604 		mmc->capacity = mmc->capacity_user;
605 		break;
606 	case 1:
607 	case 2:
608 		mmc->capacity = mmc->capacity_boot;
609 		break;
610 	case 3:
611 		mmc->capacity = mmc->capacity_rpmb;
612 		break;
613 	case 4:
614 	case 5:
615 	case 6:
616 	case 7:
617 		mmc->capacity = mmc->capacity_gp[part_num - 4];
618 		break;
619 	default:
620 		return -1;
621 	}
622 
623 	mmc_get_blk_desc(mmc)->lba = lldiv(mmc->capacity, mmc->read_bl_len);
624 
625 	return 0;
626 }
627 
628 int mmc_switch_part(struct mmc *mmc, unsigned int part_num)
629 {
630 	int ret;
631 
632 	ret = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_PART_CONF,
633 			 (mmc->part_config & ~PART_ACCESS_MASK)
634 			 | (part_num & PART_ACCESS_MASK));
635 
636 	/*
637 	 * Set the capacity if the switch succeeded or was intended
638 	 * to return to representing the raw device.
639 	 */
640 	if ((ret == 0) || ((ret == -ENODEV) && (part_num == 0))) {
641 		ret = mmc_set_capacity(mmc, part_num);
642 		mmc_get_blk_desc(mmc)->hwpart = part_num;
643 	}
644 
645 	return ret;
646 }
647 
648 int mmc_hwpart_config(struct mmc *mmc,
649 		      const struct mmc_hwpart_conf *conf,
650 		      enum mmc_hwpart_conf_mode mode)
651 {
652 	u8 part_attrs = 0;
653 	u32 enh_size_mult;
654 	u32 enh_start_addr;
655 	u32 gp_size_mult[4];
656 	u32 max_enh_size_mult;
657 	u32 tot_enh_size_mult = 0;
658 	u8 wr_rel_set;
659 	int i, pidx, err;
660 	ALLOC_CACHE_ALIGN_BUFFER(u8, ext_csd, MMC_MAX_BLOCK_LEN);
661 
662 	if (mode < MMC_HWPART_CONF_CHECK || mode > MMC_HWPART_CONF_COMPLETE)
663 		return -EINVAL;
664 
665 	if (IS_SD(mmc) || (mmc->version < MMC_VERSION_4_41)) {
666 		printf("eMMC >= 4.4 required for enhanced user data area\n");
667 		return -EMEDIUMTYPE;
668 	}
669 
670 	if (!(mmc->part_support & PART_SUPPORT)) {
671 		printf("Card does not support partitioning\n");
672 		return -EMEDIUMTYPE;
673 	}
674 
675 	if (!mmc->hc_wp_grp_size) {
676 		printf("Card does not define HC WP group size\n");
677 		return -EMEDIUMTYPE;
678 	}
679 
680 	/* check partition alignment and total enhanced size */
681 	if (conf->user.enh_size) {
682 		if (conf->user.enh_size % mmc->hc_wp_grp_size ||
683 		    conf->user.enh_start % mmc->hc_wp_grp_size) {
684 			printf("User data enhanced area not HC WP group "
685 			       "size aligned\n");
686 			return -EINVAL;
687 		}
688 		part_attrs |= EXT_CSD_ENH_USR;
689 		enh_size_mult = conf->user.enh_size / mmc->hc_wp_grp_size;
690 		if (mmc->high_capacity) {
691 			enh_start_addr = conf->user.enh_start;
692 		} else {
693 			enh_start_addr = (conf->user.enh_start << 9);
694 		}
695 	} else {
696 		enh_size_mult = 0;
697 		enh_start_addr = 0;
698 	}
699 	tot_enh_size_mult += enh_size_mult;
700 
701 	for (pidx = 0; pidx < 4; pidx++) {
702 		if (conf->gp_part[pidx].size % mmc->hc_wp_grp_size) {
703 			printf("GP%i partition not HC WP group size "
704 			       "aligned\n", pidx+1);
705 			return -EINVAL;
706 		}
707 		gp_size_mult[pidx] = conf->gp_part[pidx].size / mmc->hc_wp_grp_size;
708 		if (conf->gp_part[pidx].size && conf->gp_part[pidx].enhanced) {
709 			part_attrs |= EXT_CSD_ENH_GP(pidx);
710 			tot_enh_size_mult += gp_size_mult[pidx];
711 		}
712 	}
713 
714 	if (part_attrs && ! (mmc->part_support & ENHNCD_SUPPORT)) {
715 		printf("Card does not support enhanced attribute\n");
716 		return -EMEDIUMTYPE;
717 	}
718 
719 	err = mmc_send_ext_csd(mmc, ext_csd);
720 	if (err)
721 		return err;
722 
723 	max_enh_size_mult =
724 		(ext_csd[EXT_CSD_MAX_ENH_SIZE_MULT+2] << 16) +
725 		(ext_csd[EXT_CSD_MAX_ENH_SIZE_MULT+1] << 8) +
726 		ext_csd[EXT_CSD_MAX_ENH_SIZE_MULT];
727 	if (tot_enh_size_mult > max_enh_size_mult) {
728 		printf("Total enhanced size exceeds maximum (%u > %u)\n",
729 		       tot_enh_size_mult, max_enh_size_mult);
730 		return -EMEDIUMTYPE;
731 	}
732 
733 	/* The default value of EXT_CSD_WR_REL_SET is device
734 	 * dependent, the values can only be changed if the
735 	 * EXT_CSD_HS_CTRL_REL bit is set. The values can be
736 	 * changed only once and before partitioning is completed. */
737 	wr_rel_set = ext_csd[EXT_CSD_WR_REL_SET];
738 	if (conf->user.wr_rel_change) {
739 		if (conf->user.wr_rel_set)
740 			wr_rel_set |= EXT_CSD_WR_DATA_REL_USR;
741 		else
742 			wr_rel_set &= ~EXT_CSD_WR_DATA_REL_USR;
743 	}
744 	for (pidx = 0; pidx < 4; pidx++) {
745 		if (conf->gp_part[pidx].wr_rel_change) {
746 			if (conf->gp_part[pidx].wr_rel_set)
747 				wr_rel_set |= EXT_CSD_WR_DATA_REL_GP(pidx);
748 			else
749 				wr_rel_set &= ~EXT_CSD_WR_DATA_REL_GP(pidx);
750 		}
751 	}
752 
753 	if (wr_rel_set != ext_csd[EXT_CSD_WR_REL_SET] &&
754 	    !(ext_csd[EXT_CSD_WR_REL_PARAM] & EXT_CSD_HS_CTRL_REL)) {
755 		puts("Card does not support host controlled partition write "
756 		     "reliability settings\n");
757 		return -EMEDIUMTYPE;
758 	}
759 
760 	if (ext_csd[EXT_CSD_PARTITION_SETTING] &
761 	    EXT_CSD_PARTITION_SETTING_COMPLETED) {
762 		printf("Card already partitioned\n");
763 		return -EPERM;
764 	}
765 
766 	if (mode == MMC_HWPART_CONF_CHECK)
767 		return 0;
768 
769 	/* Partitioning requires high-capacity size definitions */
770 	if (!(ext_csd[EXT_CSD_ERASE_GROUP_DEF] & 0x01)) {
771 		err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
772 				 EXT_CSD_ERASE_GROUP_DEF, 1);
773 
774 		if (err)
775 			return err;
776 
777 		ext_csd[EXT_CSD_ERASE_GROUP_DEF] = 1;
778 
779 		/* update erase group size to be high-capacity */
780 		mmc->erase_grp_size =
781 			ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE] * 1024;
782 
783 	}
784 
785 	/* all OK, write the configuration */
786 	for (i = 0; i < 4; i++) {
787 		err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
788 				 EXT_CSD_ENH_START_ADDR+i,
789 				 (enh_start_addr >> (i*8)) & 0xFF);
790 		if (err)
791 			return err;
792 	}
793 	for (i = 0; i < 3; i++) {
794 		err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
795 				 EXT_CSD_ENH_SIZE_MULT+i,
796 				 (enh_size_mult >> (i*8)) & 0xFF);
797 		if (err)
798 			return err;
799 	}
800 	for (pidx = 0; pidx < 4; pidx++) {
801 		for (i = 0; i < 3; i++) {
802 			err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
803 					 EXT_CSD_GP_SIZE_MULT+pidx*3+i,
804 					 (gp_size_mult[pidx] >> (i*8)) & 0xFF);
805 			if (err)
806 				return err;
807 		}
808 	}
809 	err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
810 			 EXT_CSD_PARTITIONS_ATTRIBUTE, part_attrs);
811 	if (err)
812 		return err;
813 
814 	if (mode == MMC_HWPART_CONF_SET)
815 		return 0;
816 
817 	/* The WR_REL_SET is a write-once register but shall be
818 	 * written before setting PART_SETTING_COMPLETED. As it is
819 	 * write-once we can only write it when completing the
820 	 * partitioning. */
821 	if (wr_rel_set != ext_csd[EXT_CSD_WR_REL_SET]) {
822 		err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
823 				 EXT_CSD_WR_REL_SET, wr_rel_set);
824 		if (err)
825 			return err;
826 	}
827 
828 	/* Setting PART_SETTING_COMPLETED confirms the partition
829 	 * configuration but it only becomes effective after power
830 	 * cycle, so we do not adjust the partition related settings
831 	 * in the mmc struct. */
832 
833 	err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
834 			 EXT_CSD_PARTITION_SETTING,
835 			 EXT_CSD_PARTITION_SETTING_COMPLETED);
836 	if (err)
837 		return err;
838 
839 	return 0;
840 }
841 
842 #ifndef CONFIG_DM_MMC_OPS
843 int mmc_getcd(struct mmc *mmc)
844 {
845 	int cd;
846 
847 	cd = board_mmc_getcd(mmc);
848 
849 	if (cd < 0) {
850 		if (mmc->cfg->ops->getcd)
851 			cd = mmc->cfg->ops->getcd(mmc);
852 		else
853 			cd = 1;
854 	}
855 
856 	return cd;
857 }
858 #endif
859 
860 static int sd_switch(struct mmc *mmc, int mode, int group, u8 value, u8 *resp)
861 {
862 	struct mmc_cmd cmd;
863 	struct mmc_data data;
864 
865 	/* Switch the frequency */
866 	cmd.cmdidx = SD_CMD_SWITCH_FUNC;
867 	cmd.resp_type = MMC_RSP_R1;
868 	cmd.cmdarg = (mode << 31) | 0xffffff;
869 	cmd.cmdarg &= ~(0xf << (group * 4));
870 	cmd.cmdarg |= value << (group * 4);
871 
872 	data.dest = (char *)resp;
873 	data.blocksize = 64;
874 	data.blocks = 1;
875 	data.flags = MMC_DATA_READ;
876 
877 	return mmc_send_cmd(mmc, &cmd, &data);
878 }
879 
880 
881 static int sd_change_freq(struct mmc *mmc)
882 {
883 	int err;
884 	struct mmc_cmd cmd;
885 	ALLOC_CACHE_ALIGN_BUFFER(uint, scr, 2);
886 	ALLOC_CACHE_ALIGN_BUFFER(uint, switch_status, 16);
887 	struct mmc_data data;
888 	int timeout;
889 
890 	mmc->card_caps = 0;
891 
892 	if (mmc_host_is_spi(mmc))
893 		return 0;
894 
895 	/* Read the SCR to find out if this card supports higher speeds */
896 	cmd.cmdidx = MMC_CMD_APP_CMD;
897 	cmd.resp_type = MMC_RSP_R1;
898 	cmd.cmdarg = mmc->rca << 16;
899 
900 	err = mmc_send_cmd(mmc, &cmd, NULL);
901 
902 	if (err)
903 		return err;
904 
905 	cmd.cmdidx = SD_CMD_APP_SEND_SCR;
906 	cmd.resp_type = MMC_RSP_R1;
907 	cmd.cmdarg = 0;
908 
909 	timeout = 3;
910 
911 retry_scr:
912 	data.dest = (char *)scr;
913 	data.blocksize = 8;
914 	data.blocks = 1;
915 	data.flags = MMC_DATA_READ;
916 
917 	err = mmc_send_cmd(mmc, &cmd, &data);
918 
919 	if (err) {
920 		if (timeout--)
921 			goto retry_scr;
922 
923 		return err;
924 	}
925 
926 	mmc->scr[0] = __be32_to_cpu(scr[0]);
927 	mmc->scr[1] = __be32_to_cpu(scr[1]);
928 
929 	switch ((mmc->scr[0] >> 24) & 0xf) {
930 	case 0:
931 		mmc->version = SD_VERSION_1_0;
932 		break;
933 	case 1:
934 		mmc->version = SD_VERSION_1_10;
935 		break;
936 	case 2:
937 		mmc->version = SD_VERSION_2;
938 		if ((mmc->scr[0] >> 15) & 0x1)
939 			mmc->version = SD_VERSION_3;
940 		break;
941 	default:
942 		mmc->version = SD_VERSION_1_0;
943 		break;
944 	}
945 
946 	if (mmc->scr[0] & SD_DATA_4BIT)
947 		mmc->card_caps |= MMC_MODE_4BIT;
948 
949 	/* Version 1.0 doesn't support switching */
950 	if (mmc->version == SD_VERSION_1_0)
951 		return 0;
952 
953 	timeout = 4;
954 	while (timeout--) {
955 		err = sd_switch(mmc, SD_SWITCH_CHECK, 0, 1,
956 				(u8 *)switch_status);
957 
958 		if (err)
959 			return err;
960 
961 		/* The high-speed function is busy.  Try again */
962 		if (!(__be32_to_cpu(switch_status[7]) & SD_HIGHSPEED_BUSY))
963 			break;
964 	}
965 
966 	/* If high-speed isn't supported, we return */
967 	if (!(__be32_to_cpu(switch_status[3]) & SD_HIGHSPEED_SUPPORTED))
968 		return 0;
969 
970 	/*
971 	 * If the host doesn't support SD_HIGHSPEED, do not switch card to
972 	 * HIGHSPEED mode even if the card support SD_HIGHSPPED.
973 	 * This can avoid furthur problem when the card runs in different
974 	 * mode between the host.
975 	 */
976 	if (!((mmc->cfg->host_caps & MMC_MODE_HS_52MHz) &&
977 		(mmc->cfg->host_caps & MMC_MODE_HS)))
978 		return 0;
979 
980 	err = sd_switch(mmc, SD_SWITCH_SWITCH, 0, 1, (u8 *)switch_status);
981 
982 	if (err)
983 		return err;
984 
985 	if ((__be32_to_cpu(switch_status[4]) & 0x0f000000) == 0x01000000)
986 		mmc->card_caps |= MMC_MODE_HS;
987 
988 	return 0;
989 }
990 
991 static int sd_read_ssr(struct mmc *mmc)
992 {
993 	int err, i;
994 	struct mmc_cmd cmd;
995 	ALLOC_CACHE_ALIGN_BUFFER(uint, ssr, 16);
996 	struct mmc_data data;
997 	int timeout = 3;
998 	unsigned int au, eo, et, es;
999 
1000 	cmd.cmdidx = MMC_CMD_APP_CMD;
1001 	cmd.resp_type = MMC_RSP_R1;
1002 	cmd.cmdarg = mmc->rca << 16;
1003 
1004 	err = mmc_send_cmd(mmc, &cmd, NULL);
1005 	if (err)
1006 		return err;
1007 
1008 	cmd.cmdidx = SD_CMD_APP_SD_STATUS;
1009 	cmd.resp_type = MMC_RSP_R1;
1010 	cmd.cmdarg = 0;
1011 
1012 retry_ssr:
1013 	data.dest = (char *)ssr;
1014 	data.blocksize = 64;
1015 	data.blocks = 1;
1016 	data.flags = MMC_DATA_READ;
1017 
1018 	err = mmc_send_cmd(mmc, &cmd, &data);
1019 	if (err) {
1020 		if (timeout--)
1021 			goto retry_ssr;
1022 
1023 		return err;
1024 	}
1025 
1026 	for (i = 0; i < 16; i++)
1027 		ssr[i] = be32_to_cpu(ssr[i]);
1028 
1029 	au = (ssr[2] >> 12) & 0xF;
1030 	if ((au <= 9) || (mmc->version == SD_VERSION_3)) {
1031 		mmc->ssr.au = sd_au_size[au];
1032 		es = (ssr[3] >> 24) & 0xFF;
1033 		es |= (ssr[2] & 0xFF) << 8;
1034 		et = (ssr[3] >> 18) & 0x3F;
1035 		if (es && et) {
1036 			eo = (ssr[3] >> 16) & 0x3;
1037 			mmc->ssr.erase_timeout = (et * 1000) / es;
1038 			mmc->ssr.erase_offset = eo * 1000;
1039 		}
1040 	} else {
1041 		debug("Invalid Allocation Unit Size.\n");
1042 	}
1043 
1044 	return 0;
1045 }
1046 
1047 /* frequency bases */
1048 /* divided by 10 to be nice to platforms without floating point */
1049 static const int fbase[] = {
1050 	10000,
1051 	100000,
1052 	1000000,
1053 	10000000,
1054 };
1055 
1056 /* Multiplier values for TRAN_SPEED.  Multiplied by 10 to be nice
1057  * to platforms without floating point.
1058  */
1059 static const u8 multipliers[] = {
1060 	0,	/* reserved */
1061 	10,
1062 	12,
1063 	13,
1064 	15,
1065 	20,
1066 	25,
1067 	30,
1068 	35,
1069 	40,
1070 	45,
1071 	50,
1072 	55,
1073 	60,
1074 	70,
1075 	80,
1076 };
1077 
1078 #ifndef CONFIG_DM_MMC_OPS
1079 static void mmc_set_ios(struct mmc *mmc)
1080 {
1081 	if (mmc->cfg->ops->set_ios)
1082 		mmc->cfg->ops->set_ios(mmc);
1083 }
1084 #endif
1085 
1086 void mmc_set_clock(struct mmc *mmc, uint clock)
1087 {
1088 	if (clock > mmc->cfg->f_max)
1089 		clock = mmc->cfg->f_max;
1090 
1091 	if (clock < mmc->cfg->f_min)
1092 		clock = mmc->cfg->f_min;
1093 
1094 	mmc->clock = clock;
1095 
1096 	mmc_set_ios(mmc);
1097 }
1098 
1099 static void mmc_set_bus_width(struct mmc *mmc, uint width)
1100 {
1101 	mmc->bus_width = width;
1102 
1103 	mmc_set_ios(mmc);
1104 }
1105 
1106 static int mmc_startup(struct mmc *mmc)
1107 {
1108 	int err, i;
1109 	uint mult, freq;
1110 	u64 cmult, csize, capacity;
1111 	struct mmc_cmd cmd;
1112 	ALLOC_CACHE_ALIGN_BUFFER(u8, ext_csd, MMC_MAX_BLOCK_LEN);
1113 	ALLOC_CACHE_ALIGN_BUFFER(u8, test_csd, MMC_MAX_BLOCK_LEN);
1114 	int timeout = 1000;
1115 	bool has_parts = false;
1116 	bool part_completed;
1117 	struct blk_desc *bdesc;
1118 
1119 #ifdef CONFIG_MMC_SPI_CRC_ON
1120 	if (mmc_host_is_spi(mmc)) { /* enable CRC check for spi */
1121 		cmd.cmdidx = MMC_CMD_SPI_CRC_ON_OFF;
1122 		cmd.resp_type = MMC_RSP_R1;
1123 		cmd.cmdarg = 1;
1124 		err = mmc_send_cmd(mmc, &cmd, NULL);
1125 
1126 		if (err)
1127 			return err;
1128 	}
1129 #endif
1130 
1131 	/* Put the Card in Identify Mode */
1132 	cmd.cmdidx = mmc_host_is_spi(mmc) ? MMC_CMD_SEND_CID :
1133 		MMC_CMD_ALL_SEND_CID; /* cmd not supported in spi */
1134 	cmd.resp_type = MMC_RSP_R2;
1135 	cmd.cmdarg = 0;
1136 
1137 	err = mmc_send_cmd(mmc, &cmd, NULL);
1138 
1139 	if (err)
1140 		return err;
1141 
1142 	memcpy(mmc->cid, cmd.response, 16);
1143 
1144 	/*
1145 	 * For MMC cards, set the Relative Address.
1146 	 * For SD cards, get the Relatvie Address.
1147 	 * This also puts the cards into Standby State
1148 	 */
1149 	if (!mmc_host_is_spi(mmc)) { /* cmd not supported in spi */
1150 		cmd.cmdidx = SD_CMD_SEND_RELATIVE_ADDR;
1151 		cmd.cmdarg = mmc->rca << 16;
1152 		cmd.resp_type = MMC_RSP_R6;
1153 
1154 		err = mmc_send_cmd(mmc, &cmd, NULL);
1155 
1156 		if (err)
1157 			return err;
1158 
1159 		if (IS_SD(mmc))
1160 			mmc->rca = (cmd.response[0] >> 16) & 0xffff;
1161 	}
1162 
1163 	/* Get the Card-Specific Data */
1164 	cmd.cmdidx = MMC_CMD_SEND_CSD;
1165 	cmd.resp_type = MMC_RSP_R2;
1166 	cmd.cmdarg = mmc->rca << 16;
1167 
1168 	err = mmc_send_cmd(mmc, &cmd, NULL);
1169 
1170 	/* Waiting for the ready status */
1171 	mmc_send_status(mmc, timeout);
1172 
1173 	if (err)
1174 		return err;
1175 
1176 	mmc->csd[0] = cmd.response[0];
1177 	mmc->csd[1] = cmd.response[1];
1178 	mmc->csd[2] = cmd.response[2];
1179 	mmc->csd[3] = cmd.response[3];
1180 
1181 	if (mmc->version == MMC_VERSION_UNKNOWN) {
1182 		int version = (cmd.response[0] >> 26) & 0xf;
1183 
1184 		switch (version) {
1185 		case 0:
1186 			mmc->version = MMC_VERSION_1_2;
1187 			break;
1188 		case 1:
1189 			mmc->version = MMC_VERSION_1_4;
1190 			break;
1191 		case 2:
1192 			mmc->version = MMC_VERSION_2_2;
1193 			break;
1194 		case 3:
1195 			mmc->version = MMC_VERSION_3;
1196 			break;
1197 		case 4:
1198 			mmc->version = MMC_VERSION_4;
1199 			break;
1200 		default:
1201 			mmc->version = MMC_VERSION_1_2;
1202 			break;
1203 		}
1204 	}
1205 
1206 	/* divide frequency by 10, since the mults are 10x bigger */
1207 	freq = fbase[(cmd.response[0] & 0x7)];
1208 	mult = multipliers[((cmd.response[0] >> 3) & 0xf)];
1209 
1210 	mmc->tran_speed = freq * mult;
1211 
1212 	mmc->dsr_imp = ((cmd.response[1] >> 12) & 0x1);
1213 	mmc->read_bl_len = 1 << ((cmd.response[1] >> 16) & 0xf);
1214 
1215 	if (IS_SD(mmc))
1216 		mmc->write_bl_len = mmc->read_bl_len;
1217 	else
1218 		mmc->write_bl_len = 1 << ((cmd.response[3] >> 22) & 0xf);
1219 
1220 	if (mmc->high_capacity) {
1221 		csize = (mmc->csd[1] & 0x3f) << 16
1222 			| (mmc->csd[2] & 0xffff0000) >> 16;
1223 		cmult = 8;
1224 	} else {
1225 		csize = (mmc->csd[1] & 0x3ff) << 2
1226 			| (mmc->csd[2] & 0xc0000000) >> 30;
1227 		cmult = (mmc->csd[2] & 0x00038000) >> 15;
1228 	}
1229 
1230 	mmc->capacity_user = (csize + 1) << (cmult + 2);
1231 	mmc->capacity_user *= mmc->read_bl_len;
1232 	mmc->capacity_boot = 0;
1233 	mmc->capacity_rpmb = 0;
1234 	for (i = 0; i < 4; i++)
1235 		mmc->capacity_gp[i] = 0;
1236 
1237 	if (mmc->read_bl_len > MMC_MAX_BLOCK_LEN)
1238 		mmc->read_bl_len = MMC_MAX_BLOCK_LEN;
1239 
1240 	if (mmc->write_bl_len > MMC_MAX_BLOCK_LEN)
1241 		mmc->write_bl_len = MMC_MAX_BLOCK_LEN;
1242 
1243 	if ((mmc->dsr_imp) && (0xffffffff != mmc->dsr)) {
1244 		cmd.cmdidx = MMC_CMD_SET_DSR;
1245 		cmd.cmdarg = (mmc->dsr & 0xffff) << 16;
1246 		cmd.resp_type = MMC_RSP_NONE;
1247 		if (mmc_send_cmd(mmc, &cmd, NULL))
1248 			printf("MMC: SET_DSR failed\n");
1249 	}
1250 
1251 	/* Select the card, and put it into Transfer Mode */
1252 	if (!mmc_host_is_spi(mmc)) { /* cmd not supported in spi */
1253 		cmd.cmdidx = MMC_CMD_SELECT_CARD;
1254 		cmd.resp_type = MMC_RSP_R1;
1255 		cmd.cmdarg = mmc->rca << 16;
1256 		err = mmc_send_cmd(mmc, &cmd, NULL);
1257 
1258 		if (err)
1259 			return err;
1260 	}
1261 
1262 	/*
1263 	 * For SD, its erase group is always one sector
1264 	 */
1265 	mmc->erase_grp_size = 1;
1266 	mmc->part_config = MMCPART_NOAVAILABLE;
1267 	if (!IS_SD(mmc) && (mmc->version >= MMC_VERSION_4)) {
1268 		/* check  ext_csd version and capacity */
1269 		err = mmc_send_ext_csd(mmc, ext_csd);
1270 		if (err)
1271 			return err;
1272 		if (ext_csd[EXT_CSD_REV] >= 2) {
1273 			/*
1274 			 * According to the JEDEC Standard, the value of
1275 			 * ext_csd's capacity is valid if the value is more
1276 			 * than 2GB
1277 			 */
1278 			capacity = ext_csd[EXT_CSD_SEC_CNT] << 0
1279 					| ext_csd[EXT_CSD_SEC_CNT + 1] << 8
1280 					| ext_csd[EXT_CSD_SEC_CNT + 2] << 16
1281 					| ext_csd[EXT_CSD_SEC_CNT + 3] << 24;
1282 			capacity *= MMC_MAX_BLOCK_LEN;
1283 			if ((capacity >> 20) > 2 * 1024)
1284 				mmc->capacity_user = capacity;
1285 		}
1286 
1287 		switch (ext_csd[EXT_CSD_REV]) {
1288 		case 1:
1289 			mmc->version = MMC_VERSION_4_1;
1290 			break;
1291 		case 2:
1292 			mmc->version = MMC_VERSION_4_2;
1293 			break;
1294 		case 3:
1295 			mmc->version = MMC_VERSION_4_3;
1296 			break;
1297 		case 5:
1298 			mmc->version = MMC_VERSION_4_41;
1299 			break;
1300 		case 6:
1301 			mmc->version = MMC_VERSION_4_5;
1302 			break;
1303 		case 7:
1304 			mmc->version = MMC_VERSION_5_0;
1305 			break;
1306 		case 8:
1307 			mmc->version = MMC_VERSION_5_1;
1308 			break;
1309 		}
1310 
1311 		/* The partition data may be non-zero but it is only
1312 		 * effective if PARTITION_SETTING_COMPLETED is set in
1313 		 * EXT_CSD, so ignore any data if this bit is not set,
1314 		 * except for enabling the high-capacity group size
1315 		 * definition (see below). */
1316 		part_completed = !!(ext_csd[EXT_CSD_PARTITION_SETTING] &
1317 				    EXT_CSD_PARTITION_SETTING_COMPLETED);
1318 
1319 		/* store the partition info of emmc */
1320 		mmc->part_support = ext_csd[EXT_CSD_PARTITIONING_SUPPORT];
1321 		if ((ext_csd[EXT_CSD_PARTITIONING_SUPPORT] & PART_SUPPORT) ||
1322 		    ext_csd[EXT_CSD_BOOT_MULT])
1323 			mmc->part_config = ext_csd[EXT_CSD_PART_CONF];
1324 		if (part_completed &&
1325 		    (ext_csd[EXT_CSD_PARTITIONING_SUPPORT] & ENHNCD_SUPPORT))
1326 			mmc->part_attr = ext_csd[EXT_CSD_PARTITIONS_ATTRIBUTE];
1327 
1328 		mmc->capacity_boot = ext_csd[EXT_CSD_BOOT_MULT] << 17;
1329 
1330 		mmc->capacity_rpmb = ext_csd[EXT_CSD_RPMB_MULT] << 17;
1331 
1332 		for (i = 0; i < 4; i++) {
1333 			int idx = EXT_CSD_GP_SIZE_MULT + i * 3;
1334 			uint mult = (ext_csd[idx + 2] << 16) +
1335 				(ext_csd[idx + 1] << 8) + ext_csd[idx];
1336 			if (mult)
1337 				has_parts = true;
1338 			if (!part_completed)
1339 				continue;
1340 			mmc->capacity_gp[i] = mult;
1341 			mmc->capacity_gp[i] *=
1342 				ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
1343 			mmc->capacity_gp[i] *= ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
1344 			mmc->capacity_gp[i] <<= 19;
1345 		}
1346 
1347 		if (part_completed) {
1348 			mmc->enh_user_size =
1349 				(ext_csd[EXT_CSD_ENH_SIZE_MULT+2] << 16) +
1350 				(ext_csd[EXT_CSD_ENH_SIZE_MULT+1] << 8) +
1351 				ext_csd[EXT_CSD_ENH_SIZE_MULT];
1352 			mmc->enh_user_size *= ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
1353 			mmc->enh_user_size *= ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
1354 			mmc->enh_user_size <<= 19;
1355 			mmc->enh_user_start =
1356 				(ext_csd[EXT_CSD_ENH_START_ADDR+3] << 24) +
1357 				(ext_csd[EXT_CSD_ENH_START_ADDR+2] << 16) +
1358 				(ext_csd[EXT_CSD_ENH_START_ADDR+1] << 8) +
1359 				ext_csd[EXT_CSD_ENH_START_ADDR];
1360 			if (mmc->high_capacity)
1361 				mmc->enh_user_start <<= 9;
1362 		}
1363 
1364 		/*
1365 		 * Host needs to enable ERASE_GRP_DEF bit if device is
1366 		 * partitioned. This bit will be lost every time after a reset
1367 		 * or power off. This will affect erase size.
1368 		 */
1369 		if (part_completed)
1370 			has_parts = true;
1371 		if ((ext_csd[EXT_CSD_PARTITIONING_SUPPORT] & PART_SUPPORT) &&
1372 		    (ext_csd[EXT_CSD_PARTITIONS_ATTRIBUTE] & PART_ENH_ATTRIB))
1373 			has_parts = true;
1374 		if (has_parts) {
1375 			err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
1376 				EXT_CSD_ERASE_GROUP_DEF, 1);
1377 
1378 			if (err)
1379 				return err;
1380 			else
1381 				ext_csd[EXT_CSD_ERASE_GROUP_DEF] = 1;
1382 		}
1383 
1384 		if (ext_csd[EXT_CSD_ERASE_GROUP_DEF] & 0x01) {
1385 			/* Read out group size from ext_csd */
1386 			mmc->erase_grp_size =
1387 				ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE] * 1024;
1388 			/*
1389 			 * if high capacity and partition setting completed
1390 			 * SEC_COUNT is valid even if it is smaller than 2 GiB
1391 			 * JEDEC Standard JESD84-B45, 6.2.4
1392 			 */
1393 			if (mmc->high_capacity && part_completed) {
1394 				capacity = (ext_csd[EXT_CSD_SEC_CNT]) |
1395 					(ext_csd[EXT_CSD_SEC_CNT + 1] << 8) |
1396 					(ext_csd[EXT_CSD_SEC_CNT + 2] << 16) |
1397 					(ext_csd[EXT_CSD_SEC_CNT + 3] << 24);
1398 				capacity *= MMC_MAX_BLOCK_LEN;
1399 				mmc->capacity_user = capacity;
1400 			}
1401 		} else {
1402 			/* Calculate the group size from the csd value. */
1403 			int erase_gsz, erase_gmul;
1404 			erase_gsz = (mmc->csd[2] & 0x00007c00) >> 10;
1405 			erase_gmul = (mmc->csd[2] & 0x000003e0) >> 5;
1406 			mmc->erase_grp_size = (erase_gsz + 1)
1407 				* (erase_gmul + 1);
1408 		}
1409 
1410 		mmc->hc_wp_grp_size = 1024
1411 			* ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]
1412 			* ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
1413 
1414 		mmc->wr_rel_set = ext_csd[EXT_CSD_WR_REL_SET];
1415 	}
1416 
1417 	err = mmc_set_capacity(mmc, mmc_get_blk_desc(mmc)->hwpart);
1418 	if (err)
1419 		return err;
1420 
1421 	if (IS_SD(mmc))
1422 		err = sd_change_freq(mmc);
1423 	else
1424 		err = mmc_change_freq(mmc);
1425 
1426 	if (err)
1427 		return err;
1428 
1429 	/* Restrict card's capabilities by what the host can do */
1430 	mmc->card_caps &= mmc->cfg->host_caps;
1431 
1432 	if (IS_SD(mmc)) {
1433 		if (mmc->card_caps & MMC_MODE_4BIT) {
1434 			cmd.cmdidx = MMC_CMD_APP_CMD;
1435 			cmd.resp_type = MMC_RSP_R1;
1436 			cmd.cmdarg = mmc->rca << 16;
1437 
1438 			err = mmc_send_cmd(mmc, &cmd, NULL);
1439 			if (err)
1440 				return err;
1441 
1442 			cmd.cmdidx = SD_CMD_APP_SET_BUS_WIDTH;
1443 			cmd.resp_type = MMC_RSP_R1;
1444 			cmd.cmdarg = 2;
1445 			err = mmc_send_cmd(mmc, &cmd, NULL);
1446 			if (err)
1447 				return err;
1448 
1449 			mmc_set_bus_width(mmc, 4);
1450 		}
1451 
1452 		err = sd_read_ssr(mmc);
1453 		if (err)
1454 			return err;
1455 
1456 		if (mmc->card_caps & MMC_MODE_HS)
1457 			mmc->tran_speed = 50000000;
1458 		else
1459 			mmc->tran_speed = 25000000;
1460 	} else if (mmc->version >= MMC_VERSION_4) {
1461 		/* Only version 4 of MMC supports wider bus widths */
1462 		int idx;
1463 
1464 		/* An array of possible bus widths in order of preference */
1465 		static unsigned ext_csd_bits[] = {
1466 			EXT_CSD_DDR_BUS_WIDTH_8,
1467 			EXT_CSD_DDR_BUS_WIDTH_4,
1468 			EXT_CSD_BUS_WIDTH_8,
1469 			EXT_CSD_BUS_WIDTH_4,
1470 			EXT_CSD_BUS_WIDTH_1,
1471 		};
1472 
1473 		/* An array to map CSD bus widths to host cap bits */
1474 		static unsigned ext_to_hostcaps[] = {
1475 			[EXT_CSD_DDR_BUS_WIDTH_4] =
1476 				MMC_MODE_DDR_52MHz | MMC_MODE_4BIT,
1477 			[EXT_CSD_DDR_BUS_WIDTH_8] =
1478 				MMC_MODE_DDR_52MHz | MMC_MODE_8BIT,
1479 			[EXT_CSD_BUS_WIDTH_4] = MMC_MODE_4BIT,
1480 			[EXT_CSD_BUS_WIDTH_8] = MMC_MODE_8BIT,
1481 		};
1482 
1483 		/* An array to map chosen bus width to an integer */
1484 		static unsigned widths[] = {
1485 			8, 4, 8, 4, 1,
1486 		};
1487 
1488 		for (idx=0; idx < ARRAY_SIZE(ext_csd_bits); idx++) {
1489 			unsigned int extw = ext_csd_bits[idx];
1490 			unsigned int caps = ext_to_hostcaps[extw];
1491 
1492 			/*
1493 			 * If the bus width is still not changed,
1494 			 * don't try to set the default again.
1495 			 * Otherwise, recover from switch attempts
1496 			 * by switching to 1-bit bus width.
1497 			 */
1498 			if (extw == EXT_CSD_BUS_WIDTH_1 &&
1499 					mmc->bus_width == 1) {
1500 				err = 0;
1501 				break;
1502 			}
1503 
1504 			/*
1505 			 * Check to make sure the card and controller support
1506 			 * these capabilities
1507 			 */
1508 			if ((mmc->card_caps & caps) != caps)
1509 				continue;
1510 
1511 			err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
1512 					EXT_CSD_BUS_WIDTH, extw);
1513 
1514 			if (err)
1515 				continue;
1516 
1517 			mmc->ddr_mode = (caps & MMC_MODE_DDR_52MHz) ? 1 : 0;
1518 			mmc_set_bus_width(mmc, widths[idx]);
1519 
1520 			err = mmc_send_ext_csd(mmc, test_csd);
1521 
1522 			if (err)
1523 				continue;
1524 
1525 			/* Only compare read only fields */
1526 			if (ext_csd[EXT_CSD_PARTITIONING_SUPPORT]
1527 				== test_csd[EXT_CSD_PARTITIONING_SUPPORT] &&
1528 			    ext_csd[EXT_CSD_HC_WP_GRP_SIZE]
1529 				== test_csd[EXT_CSD_HC_WP_GRP_SIZE] &&
1530 			    ext_csd[EXT_CSD_REV]
1531 				== test_csd[EXT_CSD_REV] &&
1532 			    ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]
1533 				== test_csd[EXT_CSD_HC_ERASE_GRP_SIZE] &&
1534 			    memcmp(&ext_csd[EXT_CSD_SEC_CNT],
1535 				   &test_csd[EXT_CSD_SEC_CNT], 4) == 0)
1536 				break;
1537 			else
1538 				err = -EBADMSG;
1539 		}
1540 
1541 		if (err)
1542 			return err;
1543 
1544 		if (mmc->card_caps & MMC_MODE_HS) {
1545 			if (mmc->card_caps & MMC_MODE_HS_52MHz)
1546 				mmc->tran_speed = 52000000;
1547 			else
1548 				mmc->tran_speed = 26000000;
1549 		}
1550 	}
1551 
1552 	mmc_set_clock(mmc, mmc->tran_speed);
1553 
1554 	/* Fix the block length for DDR mode */
1555 	if (mmc->ddr_mode) {
1556 		mmc->read_bl_len = MMC_MAX_BLOCK_LEN;
1557 		mmc->write_bl_len = MMC_MAX_BLOCK_LEN;
1558 	}
1559 
1560 	/* fill in device description */
1561 	bdesc = mmc_get_blk_desc(mmc);
1562 	bdesc->lun = 0;
1563 	bdesc->hwpart = 0;
1564 	bdesc->type = 0;
1565 	bdesc->blksz = mmc->read_bl_len;
1566 	bdesc->log2blksz = LOG2(bdesc->blksz);
1567 	bdesc->lba = lldiv(mmc->capacity, mmc->read_bl_len);
1568 #if !defined(CONFIG_SPL_BUILD) || \
1569 		(defined(CONFIG_SPL_LIBCOMMON_SUPPORT) && \
1570 		!defined(CONFIG_USE_TINY_PRINTF))
1571 	sprintf(bdesc->vendor, "Man %06x Snr %04x%04x",
1572 		mmc->cid[0] >> 24, (mmc->cid[2] & 0xffff),
1573 		(mmc->cid[3] >> 16) & 0xffff);
1574 	sprintf(bdesc->product, "%c%c%c%c%c%c", mmc->cid[0] & 0xff,
1575 		(mmc->cid[1] >> 24), (mmc->cid[1] >> 16) & 0xff,
1576 		(mmc->cid[1] >> 8) & 0xff, mmc->cid[1] & 0xff,
1577 		(mmc->cid[2] >> 24) & 0xff);
1578 	sprintf(bdesc->revision, "%d.%d", (mmc->cid[2] >> 20) & 0xf,
1579 		(mmc->cid[2] >> 16) & 0xf);
1580 #else
1581 	bdesc->vendor[0] = 0;
1582 	bdesc->product[0] = 0;
1583 	bdesc->revision[0] = 0;
1584 #endif
1585 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBDISK_SUPPORT)
1586 	part_init(bdesc);
1587 #endif
1588 
1589 	return 0;
1590 }
1591 
1592 static int mmc_send_if_cond(struct mmc *mmc)
1593 {
1594 	struct mmc_cmd cmd;
1595 	int err;
1596 
1597 	cmd.cmdidx = SD_CMD_SEND_IF_COND;
1598 	/* We set the bit if the host supports voltages between 2.7 and 3.6 V */
1599 	cmd.cmdarg = ((mmc->cfg->voltages & 0xff8000) != 0) << 8 | 0xaa;
1600 	cmd.resp_type = MMC_RSP_R7;
1601 
1602 	err = mmc_send_cmd(mmc, &cmd, NULL);
1603 
1604 	if (err)
1605 		return err;
1606 
1607 	if ((cmd.response[0] & 0xff) != 0xaa)
1608 		return -EOPNOTSUPP;
1609 	else
1610 		mmc->version = SD_VERSION_2;
1611 
1612 	return 0;
1613 }
1614 
1615 /* board-specific MMC power initializations. */
1616 __weak void board_mmc_power_init(void)
1617 {
1618 }
1619 
1620 static int mmc_power_init(struct mmc *mmc)
1621 {
1622 	board_mmc_power_init();
1623 
1624 #if defined(CONFIG_DM_MMC) && defined(CONFIG_DM_REGULATOR) && \
1625 	!defined(CONFIG_SPL_BUILD)
1626 	struct udevice *vmmc_supply;
1627 	int ret;
1628 
1629 	ret = device_get_supply_regulator(mmc->dev, "vmmc-supply",
1630 					  &vmmc_supply);
1631 	if (ret) {
1632 		debug("%s: No vmmc supply\n", mmc->dev->name);
1633 		return 0;
1634 	}
1635 
1636 	ret = regulator_set_enable(vmmc_supply, true);
1637 	if (ret) {
1638 		puts("Error enabling VMMC supply\n");
1639 		return ret;
1640 	}
1641 #endif
1642 	return 0;
1643 }
1644 
1645 int mmc_start_init(struct mmc *mmc)
1646 {
1647 	bool no_card;
1648 	int err;
1649 
1650 	/* we pretend there's no card when init is NULL */
1651 	no_card = mmc_getcd(mmc) == 0;
1652 #ifndef CONFIG_DM_MMC_OPS
1653 	no_card = no_card || (mmc->cfg->ops->init == NULL);
1654 #endif
1655 	if (no_card) {
1656 		mmc->has_init = 0;
1657 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
1658 		printf("MMC: no card present\n");
1659 #endif
1660 		return -ENOMEDIUM;
1661 	}
1662 
1663 	if (mmc->has_init)
1664 		return 0;
1665 
1666 #ifdef CONFIG_FSL_ESDHC_ADAPTER_IDENT
1667 	mmc_adapter_card_type_ident();
1668 #endif
1669 	err = mmc_power_init(mmc);
1670 	if (err)
1671 		return err;
1672 
1673 #ifdef CONFIG_DM_MMC_OPS
1674 	/* The device has already been probed ready for use */
1675 #else
1676 	/* made sure it's not NULL earlier */
1677 	err = mmc->cfg->ops->init(mmc);
1678 	if (err)
1679 		return err;
1680 #endif
1681 	mmc->ddr_mode = 0;
1682 	mmc_set_bus_width(mmc, 1);
1683 	mmc_set_clock(mmc, 1);
1684 
1685 	/* Reset the Card */
1686 	err = mmc_go_idle(mmc);
1687 
1688 	if (err)
1689 		return err;
1690 
1691 	/* The internal partition reset to user partition(0) at every CMD0*/
1692 	mmc_get_blk_desc(mmc)->hwpart = 0;
1693 
1694 	/* Test for SD version 2 */
1695 	err = mmc_send_if_cond(mmc);
1696 
1697 	/* Now try to get the SD card's operating condition */
1698 	err = sd_send_op_cond(mmc);
1699 
1700 	/* If the command timed out, we check for an MMC card */
1701 	if (err == -ETIMEDOUT) {
1702 		err = mmc_send_op_cond(mmc);
1703 
1704 		if (err) {
1705 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
1706 			printf("Card did not respond to voltage select!\n");
1707 #endif
1708 			return -EOPNOTSUPP;
1709 		}
1710 	}
1711 
1712 	if (!err)
1713 		mmc->init_in_progress = 1;
1714 
1715 	return err;
1716 }
1717 
1718 static int mmc_complete_init(struct mmc *mmc)
1719 {
1720 	int err = 0;
1721 
1722 	mmc->init_in_progress = 0;
1723 	if (mmc->op_cond_pending)
1724 		err = mmc_complete_op_cond(mmc);
1725 
1726 	if (!err)
1727 		err = mmc_startup(mmc);
1728 	if (err)
1729 		mmc->has_init = 0;
1730 	else
1731 		mmc->has_init = 1;
1732 	return err;
1733 }
1734 
1735 int mmc_init(struct mmc *mmc)
1736 {
1737 	int err = 0;
1738 	__maybe_unused unsigned start;
1739 #ifdef CONFIG_DM_MMC
1740 	struct mmc_uclass_priv *upriv = dev_get_uclass_priv(mmc->dev);
1741 
1742 	upriv->mmc = mmc;
1743 #endif
1744 	if (mmc->has_init)
1745 		return 0;
1746 
1747 	start = get_timer(0);
1748 
1749 	if (!mmc->init_in_progress)
1750 		err = mmc_start_init(mmc);
1751 
1752 	if (!err)
1753 		err = mmc_complete_init(mmc);
1754 	debug("%s: %d, time %lu\n", __func__, err, get_timer(start));
1755 	return err;
1756 }
1757 
1758 int mmc_set_dsr(struct mmc *mmc, u16 val)
1759 {
1760 	mmc->dsr = val;
1761 	return 0;
1762 }
1763 
1764 /* CPU-specific MMC initializations */
1765 __weak int cpu_mmc_init(bd_t *bis)
1766 {
1767 	return -1;
1768 }
1769 
1770 /* board-specific MMC initializations. */
1771 __weak int board_mmc_init(bd_t *bis)
1772 {
1773 	return -1;
1774 }
1775 
1776 void mmc_set_preinit(struct mmc *mmc, int preinit)
1777 {
1778 	mmc->preinit = preinit;
1779 }
1780 
1781 #if defined(CONFIG_DM_MMC) && defined(CONFIG_SPL_BUILD)
1782 static int mmc_probe(bd_t *bis)
1783 {
1784 	return 0;
1785 }
1786 #elif defined(CONFIG_DM_MMC)
1787 static int mmc_probe(bd_t *bis)
1788 {
1789 	int ret, i;
1790 	struct uclass *uc;
1791 	struct udevice *dev;
1792 
1793 	ret = uclass_get(UCLASS_MMC, &uc);
1794 	if (ret)
1795 		return ret;
1796 
1797 	/*
1798 	 * Try to add them in sequence order. Really with driver model we
1799 	 * should allow holes, but the current MMC list does not allow that.
1800 	 * So if we request 0, 1, 3 we will get 0, 1, 2.
1801 	 */
1802 	for (i = 0; ; i++) {
1803 		ret = uclass_get_device_by_seq(UCLASS_MMC, i, &dev);
1804 		if (ret == -ENODEV)
1805 			break;
1806 	}
1807 	uclass_foreach_dev(dev, uc) {
1808 		ret = device_probe(dev);
1809 		if (ret)
1810 			printf("%s - probe failed: %d\n", dev->name, ret);
1811 	}
1812 
1813 	return 0;
1814 }
1815 #else
1816 static int mmc_probe(bd_t *bis)
1817 {
1818 	if (board_mmc_init(bis) < 0)
1819 		cpu_mmc_init(bis);
1820 
1821 	return 0;
1822 }
1823 #endif
1824 
1825 int mmc_initialize(bd_t *bis)
1826 {
1827 	static int initialized = 0;
1828 	int ret;
1829 	if (initialized)	/* Avoid initializing mmc multiple times */
1830 		return 0;
1831 	initialized = 1;
1832 
1833 #ifndef CONFIG_BLK
1834 #if !CONFIG_IS_ENABLED(MMC_TINY)
1835 	mmc_list_init();
1836 #endif
1837 #endif
1838 	ret = mmc_probe(bis);
1839 	if (ret)
1840 		return ret;
1841 
1842 #ifndef CONFIG_SPL_BUILD
1843 	print_mmc_devices(',');
1844 #endif
1845 
1846 	mmc_do_preinit();
1847 	return 0;
1848 }
1849 
1850 #ifdef CONFIG_CMD_BKOPS_ENABLE
1851 int mmc_set_bkops_enable(struct mmc *mmc)
1852 {
1853 	int err;
1854 	ALLOC_CACHE_ALIGN_BUFFER(u8, ext_csd, MMC_MAX_BLOCK_LEN);
1855 
1856 	err = mmc_send_ext_csd(mmc, ext_csd);
1857 	if (err) {
1858 		puts("Could not get ext_csd register values\n");
1859 		return err;
1860 	}
1861 
1862 	if (!(ext_csd[EXT_CSD_BKOPS_SUPPORT] & 0x1)) {
1863 		puts("Background operations not supported on device\n");
1864 		return -EMEDIUMTYPE;
1865 	}
1866 
1867 	if (ext_csd[EXT_CSD_BKOPS_EN] & 0x1) {
1868 		puts("Background operations already enabled\n");
1869 		return 0;
1870 	}
1871 
1872 	err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_BKOPS_EN, 1);
1873 	if (err) {
1874 		puts("Failed to enable manual background operations\n");
1875 		return err;
1876 	}
1877 
1878 	puts("Enabled manual background operations\n");
1879 
1880 	return 0;
1881 }
1882 #endif
1883