xref: /openbmc/u-boot/drivers/mmc/mmc.c (revision a3b36c84)
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 #if !CONFIG_IS_ENABLED(DM_MMC)
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 #if !CONFIG_IS_ENABLED(DM_MMC)
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 #if CONFIG_IS_ENABLED(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 #if CONFIG_IS_ENABLED(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 #if !CONFIG_IS_ENABLED(DM_MMC)
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 #if !CONFIG_IS_ENABLED(DM_MMC)
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 	bool has_parts = false;
1115 	bool part_completed;
1116 	struct blk_desc *bdesc;
1117 
1118 #ifdef CONFIG_MMC_SPI_CRC_ON
1119 	if (mmc_host_is_spi(mmc)) { /* enable CRC check for spi */
1120 		cmd.cmdidx = MMC_CMD_SPI_CRC_ON_OFF;
1121 		cmd.resp_type = MMC_RSP_R1;
1122 		cmd.cmdarg = 1;
1123 		err = mmc_send_cmd(mmc, &cmd, NULL);
1124 
1125 		if (err)
1126 			return err;
1127 	}
1128 #endif
1129 
1130 	/* Put the Card in Identify Mode */
1131 	cmd.cmdidx = mmc_host_is_spi(mmc) ? MMC_CMD_SEND_CID :
1132 		MMC_CMD_ALL_SEND_CID; /* cmd not supported in spi */
1133 	cmd.resp_type = MMC_RSP_R2;
1134 	cmd.cmdarg = 0;
1135 
1136 	err = mmc_send_cmd(mmc, &cmd, NULL);
1137 
1138 	if (err)
1139 		return err;
1140 
1141 	memcpy(mmc->cid, cmd.response, 16);
1142 
1143 	/*
1144 	 * For MMC cards, set the Relative Address.
1145 	 * For SD cards, get the Relatvie Address.
1146 	 * This also puts the cards into Standby State
1147 	 */
1148 	if (!mmc_host_is_spi(mmc)) { /* cmd not supported in spi */
1149 		cmd.cmdidx = SD_CMD_SEND_RELATIVE_ADDR;
1150 		cmd.cmdarg = mmc->rca << 16;
1151 		cmd.resp_type = MMC_RSP_R6;
1152 
1153 		err = mmc_send_cmd(mmc, &cmd, NULL);
1154 
1155 		if (err)
1156 			return err;
1157 
1158 		if (IS_SD(mmc))
1159 			mmc->rca = (cmd.response[0] >> 16) & 0xffff;
1160 	}
1161 
1162 	/* Get the Card-Specific Data */
1163 	cmd.cmdidx = MMC_CMD_SEND_CSD;
1164 	cmd.resp_type = MMC_RSP_R2;
1165 	cmd.cmdarg = mmc->rca << 16;
1166 
1167 	err = mmc_send_cmd(mmc, &cmd, NULL);
1168 
1169 	if (err)
1170 		return err;
1171 
1172 	mmc->csd[0] = cmd.response[0];
1173 	mmc->csd[1] = cmd.response[1];
1174 	mmc->csd[2] = cmd.response[2];
1175 	mmc->csd[3] = cmd.response[3];
1176 
1177 	if (mmc->version == MMC_VERSION_UNKNOWN) {
1178 		int version = (cmd.response[0] >> 26) & 0xf;
1179 
1180 		switch (version) {
1181 		case 0:
1182 			mmc->version = MMC_VERSION_1_2;
1183 			break;
1184 		case 1:
1185 			mmc->version = MMC_VERSION_1_4;
1186 			break;
1187 		case 2:
1188 			mmc->version = MMC_VERSION_2_2;
1189 			break;
1190 		case 3:
1191 			mmc->version = MMC_VERSION_3;
1192 			break;
1193 		case 4:
1194 			mmc->version = MMC_VERSION_4;
1195 			break;
1196 		default:
1197 			mmc->version = MMC_VERSION_1_2;
1198 			break;
1199 		}
1200 	}
1201 
1202 	/* divide frequency by 10, since the mults are 10x bigger */
1203 	freq = fbase[(cmd.response[0] & 0x7)];
1204 	mult = multipliers[((cmd.response[0] >> 3) & 0xf)];
1205 
1206 	mmc->tran_speed = freq * mult;
1207 
1208 	mmc->dsr_imp = ((cmd.response[1] >> 12) & 0x1);
1209 	mmc->read_bl_len = 1 << ((cmd.response[1] >> 16) & 0xf);
1210 
1211 	if (IS_SD(mmc))
1212 		mmc->write_bl_len = mmc->read_bl_len;
1213 	else
1214 		mmc->write_bl_len = 1 << ((cmd.response[3] >> 22) & 0xf);
1215 
1216 	if (mmc->high_capacity) {
1217 		csize = (mmc->csd[1] & 0x3f) << 16
1218 			| (mmc->csd[2] & 0xffff0000) >> 16;
1219 		cmult = 8;
1220 	} else {
1221 		csize = (mmc->csd[1] & 0x3ff) << 2
1222 			| (mmc->csd[2] & 0xc0000000) >> 30;
1223 		cmult = (mmc->csd[2] & 0x00038000) >> 15;
1224 	}
1225 
1226 	mmc->capacity_user = (csize + 1) << (cmult + 2);
1227 	mmc->capacity_user *= mmc->read_bl_len;
1228 	mmc->capacity_boot = 0;
1229 	mmc->capacity_rpmb = 0;
1230 	for (i = 0; i < 4; i++)
1231 		mmc->capacity_gp[i] = 0;
1232 
1233 	if (mmc->read_bl_len > MMC_MAX_BLOCK_LEN)
1234 		mmc->read_bl_len = MMC_MAX_BLOCK_LEN;
1235 
1236 	if (mmc->write_bl_len > MMC_MAX_BLOCK_LEN)
1237 		mmc->write_bl_len = MMC_MAX_BLOCK_LEN;
1238 
1239 	if ((mmc->dsr_imp) && (0xffffffff != mmc->dsr)) {
1240 		cmd.cmdidx = MMC_CMD_SET_DSR;
1241 		cmd.cmdarg = (mmc->dsr & 0xffff) << 16;
1242 		cmd.resp_type = MMC_RSP_NONE;
1243 		if (mmc_send_cmd(mmc, &cmd, NULL))
1244 			printf("MMC: SET_DSR failed\n");
1245 	}
1246 
1247 	/* Select the card, and put it into Transfer Mode */
1248 	if (!mmc_host_is_spi(mmc)) { /* cmd not supported in spi */
1249 		cmd.cmdidx = MMC_CMD_SELECT_CARD;
1250 		cmd.resp_type = MMC_RSP_R1;
1251 		cmd.cmdarg = mmc->rca << 16;
1252 		err = mmc_send_cmd(mmc, &cmd, NULL);
1253 
1254 		if (err)
1255 			return err;
1256 	}
1257 
1258 	/*
1259 	 * For SD, its erase group is always one sector
1260 	 */
1261 	mmc->erase_grp_size = 1;
1262 	mmc->part_config = MMCPART_NOAVAILABLE;
1263 	if (!IS_SD(mmc) && (mmc->version >= MMC_VERSION_4)) {
1264 		/* check  ext_csd version and capacity */
1265 		err = mmc_send_ext_csd(mmc, ext_csd);
1266 		if (err)
1267 			return err;
1268 		if (ext_csd[EXT_CSD_REV] >= 2) {
1269 			/*
1270 			 * According to the JEDEC Standard, the value of
1271 			 * ext_csd's capacity is valid if the value is more
1272 			 * than 2GB
1273 			 */
1274 			capacity = ext_csd[EXT_CSD_SEC_CNT] << 0
1275 					| ext_csd[EXT_CSD_SEC_CNT + 1] << 8
1276 					| ext_csd[EXT_CSD_SEC_CNT + 2] << 16
1277 					| ext_csd[EXT_CSD_SEC_CNT + 3] << 24;
1278 			capacity *= MMC_MAX_BLOCK_LEN;
1279 			if ((capacity >> 20) > 2 * 1024)
1280 				mmc->capacity_user = capacity;
1281 		}
1282 
1283 		switch (ext_csd[EXT_CSD_REV]) {
1284 		case 1:
1285 			mmc->version = MMC_VERSION_4_1;
1286 			break;
1287 		case 2:
1288 			mmc->version = MMC_VERSION_4_2;
1289 			break;
1290 		case 3:
1291 			mmc->version = MMC_VERSION_4_3;
1292 			break;
1293 		case 5:
1294 			mmc->version = MMC_VERSION_4_41;
1295 			break;
1296 		case 6:
1297 			mmc->version = MMC_VERSION_4_5;
1298 			break;
1299 		case 7:
1300 			mmc->version = MMC_VERSION_5_0;
1301 			break;
1302 		case 8:
1303 			mmc->version = MMC_VERSION_5_1;
1304 			break;
1305 		}
1306 
1307 		/* The partition data may be non-zero but it is only
1308 		 * effective if PARTITION_SETTING_COMPLETED is set in
1309 		 * EXT_CSD, so ignore any data if this bit is not set,
1310 		 * except for enabling the high-capacity group size
1311 		 * definition (see below). */
1312 		part_completed = !!(ext_csd[EXT_CSD_PARTITION_SETTING] &
1313 				    EXT_CSD_PARTITION_SETTING_COMPLETED);
1314 
1315 		/* store the partition info of emmc */
1316 		mmc->part_support = ext_csd[EXT_CSD_PARTITIONING_SUPPORT];
1317 		if ((ext_csd[EXT_CSD_PARTITIONING_SUPPORT] & PART_SUPPORT) ||
1318 		    ext_csd[EXT_CSD_BOOT_MULT])
1319 			mmc->part_config = ext_csd[EXT_CSD_PART_CONF];
1320 		if (part_completed &&
1321 		    (ext_csd[EXT_CSD_PARTITIONING_SUPPORT] & ENHNCD_SUPPORT))
1322 			mmc->part_attr = ext_csd[EXT_CSD_PARTITIONS_ATTRIBUTE];
1323 
1324 		mmc->capacity_boot = ext_csd[EXT_CSD_BOOT_MULT] << 17;
1325 
1326 		mmc->capacity_rpmb = ext_csd[EXT_CSD_RPMB_MULT] << 17;
1327 
1328 		for (i = 0; i < 4; i++) {
1329 			int idx = EXT_CSD_GP_SIZE_MULT + i * 3;
1330 			uint mult = (ext_csd[idx + 2] << 16) +
1331 				(ext_csd[idx + 1] << 8) + ext_csd[idx];
1332 			if (mult)
1333 				has_parts = true;
1334 			if (!part_completed)
1335 				continue;
1336 			mmc->capacity_gp[i] = mult;
1337 			mmc->capacity_gp[i] *=
1338 				ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
1339 			mmc->capacity_gp[i] *= ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
1340 			mmc->capacity_gp[i] <<= 19;
1341 		}
1342 
1343 		if (part_completed) {
1344 			mmc->enh_user_size =
1345 				(ext_csd[EXT_CSD_ENH_SIZE_MULT+2] << 16) +
1346 				(ext_csd[EXT_CSD_ENH_SIZE_MULT+1] << 8) +
1347 				ext_csd[EXT_CSD_ENH_SIZE_MULT];
1348 			mmc->enh_user_size *= ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE];
1349 			mmc->enh_user_size *= ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
1350 			mmc->enh_user_size <<= 19;
1351 			mmc->enh_user_start =
1352 				(ext_csd[EXT_CSD_ENH_START_ADDR+3] << 24) +
1353 				(ext_csd[EXT_CSD_ENH_START_ADDR+2] << 16) +
1354 				(ext_csd[EXT_CSD_ENH_START_ADDR+1] << 8) +
1355 				ext_csd[EXT_CSD_ENH_START_ADDR];
1356 			if (mmc->high_capacity)
1357 				mmc->enh_user_start <<= 9;
1358 		}
1359 
1360 		/*
1361 		 * Host needs to enable ERASE_GRP_DEF bit if device is
1362 		 * partitioned. This bit will be lost every time after a reset
1363 		 * or power off. This will affect erase size.
1364 		 */
1365 		if (part_completed)
1366 			has_parts = true;
1367 		if ((ext_csd[EXT_CSD_PARTITIONING_SUPPORT] & PART_SUPPORT) &&
1368 		    (ext_csd[EXT_CSD_PARTITIONS_ATTRIBUTE] & PART_ENH_ATTRIB))
1369 			has_parts = true;
1370 		if (has_parts) {
1371 			err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
1372 				EXT_CSD_ERASE_GROUP_DEF, 1);
1373 
1374 			if (err)
1375 				return err;
1376 			else
1377 				ext_csd[EXT_CSD_ERASE_GROUP_DEF] = 1;
1378 		}
1379 
1380 		if (ext_csd[EXT_CSD_ERASE_GROUP_DEF] & 0x01) {
1381 			/* Read out group size from ext_csd */
1382 			mmc->erase_grp_size =
1383 				ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE] * 1024;
1384 			/*
1385 			 * if high capacity and partition setting completed
1386 			 * SEC_COUNT is valid even if it is smaller than 2 GiB
1387 			 * JEDEC Standard JESD84-B45, 6.2.4
1388 			 */
1389 			if (mmc->high_capacity && part_completed) {
1390 				capacity = (ext_csd[EXT_CSD_SEC_CNT]) |
1391 					(ext_csd[EXT_CSD_SEC_CNT + 1] << 8) |
1392 					(ext_csd[EXT_CSD_SEC_CNT + 2] << 16) |
1393 					(ext_csd[EXT_CSD_SEC_CNT + 3] << 24);
1394 				capacity *= MMC_MAX_BLOCK_LEN;
1395 				mmc->capacity_user = capacity;
1396 			}
1397 		} else {
1398 			/* Calculate the group size from the csd value. */
1399 			int erase_gsz, erase_gmul;
1400 			erase_gsz = (mmc->csd[2] & 0x00007c00) >> 10;
1401 			erase_gmul = (mmc->csd[2] & 0x000003e0) >> 5;
1402 			mmc->erase_grp_size = (erase_gsz + 1)
1403 				* (erase_gmul + 1);
1404 		}
1405 
1406 		mmc->hc_wp_grp_size = 1024
1407 			* ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]
1408 			* ext_csd[EXT_CSD_HC_WP_GRP_SIZE];
1409 
1410 		mmc->wr_rel_set = ext_csd[EXT_CSD_WR_REL_SET];
1411 	}
1412 
1413 	err = mmc_set_capacity(mmc, mmc_get_blk_desc(mmc)->hwpart);
1414 	if (err)
1415 		return err;
1416 
1417 	if (IS_SD(mmc))
1418 		err = sd_change_freq(mmc);
1419 	else
1420 		err = mmc_change_freq(mmc);
1421 
1422 	if (err)
1423 		return err;
1424 
1425 	/* Restrict card's capabilities by what the host can do */
1426 	mmc->card_caps &= mmc->cfg->host_caps;
1427 
1428 	if (IS_SD(mmc)) {
1429 		if (mmc->card_caps & MMC_MODE_4BIT) {
1430 			cmd.cmdidx = MMC_CMD_APP_CMD;
1431 			cmd.resp_type = MMC_RSP_R1;
1432 			cmd.cmdarg = mmc->rca << 16;
1433 
1434 			err = mmc_send_cmd(mmc, &cmd, NULL);
1435 			if (err)
1436 				return err;
1437 
1438 			cmd.cmdidx = SD_CMD_APP_SET_BUS_WIDTH;
1439 			cmd.resp_type = MMC_RSP_R1;
1440 			cmd.cmdarg = 2;
1441 			err = mmc_send_cmd(mmc, &cmd, NULL);
1442 			if (err)
1443 				return err;
1444 
1445 			mmc_set_bus_width(mmc, 4);
1446 		}
1447 
1448 		err = sd_read_ssr(mmc);
1449 		if (err)
1450 			return err;
1451 
1452 		if (mmc->card_caps & MMC_MODE_HS)
1453 			mmc->tran_speed = 50000000;
1454 		else
1455 			mmc->tran_speed = 25000000;
1456 	} else if (mmc->version >= MMC_VERSION_4) {
1457 		/* Only version 4 of MMC supports wider bus widths */
1458 		int idx;
1459 
1460 		/* An array of possible bus widths in order of preference */
1461 		static unsigned ext_csd_bits[] = {
1462 			EXT_CSD_DDR_BUS_WIDTH_8,
1463 			EXT_CSD_DDR_BUS_WIDTH_4,
1464 			EXT_CSD_BUS_WIDTH_8,
1465 			EXT_CSD_BUS_WIDTH_4,
1466 			EXT_CSD_BUS_WIDTH_1,
1467 		};
1468 
1469 		/* An array to map CSD bus widths to host cap bits */
1470 		static unsigned ext_to_hostcaps[] = {
1471 			[EXT_CSD_DDR_BUS_WIDTH_4] =
1472 				MMC_MODE_DDR_52MHz | MMC_MODE_4BIT,
1473 			[EXT_CSD_DDR_BUS_WIDTH_8] =
1474 				MMC_MODE_DDR_52MHz | MMC_MODE_8BIT,
1475 			[EXT_CSD_BUS_WIDTH_4] = MMC_MODE_4BIT,
1476 			[EXT_CSD_BUS_WIDTH_8] = MMC_MODE_8BIT,
1477 		};
1478 
1479 		/* An array to map chosen bus width to an integer */
1480 		static unsigned widths[] = {
1481 			8, 4, 8, 4, 1,
1482 		};
1483 
1484 		for (idx=0; idx < ARRAY_SIZE(ext_csd_bits); idx++) {
1485 			unsigned int extw = ext_csd_bits[idx];
1486 			unsigned int caps = ext_to_hostcaps[extw];
1487 
1488 			/*
1489 			 * If the bus width is still not changed,
1490 			 * don't try to set the default again.
1491 			 * Otherwise, recover from switch attempts
1492 			 * by switching to 1-bit bus width.
1493 			 */
1494 			if (extw == EXT_CSD_BUS_WIDTH_1 &&
1495 					mmc->bus_width == 1) {
1496 				err = 0;
1497 				break;
1498 			}
1499 
1500 			/*
1501 			 * Check to make sure the card and controller support
1502 			 * these capabilities
1503 			 */
1504 			if ((mmc->card_caps & caps) != caps)
1505 				continue;
1506 
1507 			err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL,
1508 					EXT_CSD_BUS_WIDTH, extw);
1509 
1510 			if (err)
1511 				continue;
1512 
1513 			mmc->ddr_mode = (caps & MMC_MODE_DDR_52MHz) ? 1 : 0;
1514 			mmc_set_bus_width(mmc, widths[idx]);
1515 
1516 			err = mmc_send_ext_csd(mmc, test_csd);
1517 
1518 			if (err)
1519 				continue;
1520 
1521 			/* Only compare read only fields */
1522 			if (ext_csd[EXT_CSD_PARTITIONING_SUPPORT]
1523 				== test_csd[EXT_CSD_PARTITIONING_SUPPORT] &&
1524 			    ext_csd[EXT_CSD_HC_WP_GRP_SIZE]
1525 				== test_csd[EXT_CSD_HC_WP_GRP_SIZE] &&
1526 			    ext_csd[EXT_CSD_REV]
1527 				== test_csd[EXT_CSD_REV] &&
1528 			    ext_csd[EXT_CSD_HC_ERASE_GRP_SIZE]
1529 				== test_csd[EXT_CSD_HC_ERASE_GRP_SIZE] &&
1530 			    memcmp(&ext_csd[EXT_CSD_SEC_CNT],
1531 				   &test_csd[EXT_CSD_SEC_CNT], 4) == 0)
1532 				break;
1533 			else
1534 				err = -EBADMSG;
1535 		}
1536 
1537 		if (err)
1538 			return err;
1539 
1540 		if (mmc->card_caps & MMC_MODE_HS) {
1541 			if (mmc->card_caps & MMC_MODE_HS_52MHz)
1542 				mmc->tran_speed = 52000000;
1543 			else
1544 				mmc->tran_speed = 26000000;
1545 		}
1546 	}
1547 
1548 	mmc_set_clock(mmc, mmc->tran_speed);
1549 
1550 	/* Fix the block length for DDR mode */
1551 	if (mmc->ddr_mode) {
1552 		mmc->read_bl_len = MMC_MAX_BLOCK_LEN;
1553 		mmc->write_bl_len = MMC_MAX_BLOCK_LEN;
1554 	}
1555 
1556 	/* fill in device description */
1557 	bdesc = mmc_get_blk_desc(mmc);
1558 	bdesc->lun = 0;
1559 	bdesc->hwpart = 0;
1560 	bdesc->type = 0;
1561 	bdesc->blksz = mmc->read_bl_len;
1562 	bdesc->log2blksz = LOG2(bdesc->blksz);
1563 	bdesc->lba = lldiv(mmc->capacity, mmc->read_bl_len);
1564 #if !defined(CONFIG_SPL_BUILD) || \
1565 		(defined(CONFIG_SPL_LIBCOMMON_SUPPORT) && \
1566 		!defined(CONFIG_USE_TINY_PRINTF))
1567 	sprintf(bdesc->vendor, "Man %06x Snr %04x%04x",
1568 		mmc->cid[0] >> 24, (mmc->cid[2] & 0xffff),
1569 		(mmc->cid[3] >> 16) & 0xffff);
1570 	sprintf(bdesc->product, "%c%c%c%c%c%c", mmc->cid[0] & 0xff,
1571 		(mmc->cid[1] >> 24), (mmc->cid[1] >> 16) & 0xff,
1572 		(mmc->cid[1] >> 8) & 0xff, mmc->cid[1] & 0xff,
1573 		(mmc->cid[2] >> 24) & 0xff);
1574 	sprintf(bdesc->revision, "%d.%d", (mmc->cid[2] >> 20) & 0xf,
1575 		(mmc->cid[2] >> 16) & 0xf);
1576 #else
1577 	bdesc->vendor[0] = 0;
1578 	bdesc->product[0] = 0;
1579 	bdesc->revision[0] = 0;
1580 #endif
1581 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBDISK_SUPPORT)
1582 	part_init(bdesc);
1583 #endif
1584 
1585 	return 0;
1586 }
1587 
1588 static int mmc_send_if_cond(struct mmc *mmc)
1589 {
1590 	struct mmc_cmd cmd;
1591 	int err;
1592 
1593 	cmd.cmdidx = SD_CMD_SEND_IF_COND;
1594 	/* We set the bit if the host supports voltages between 2.7 and 3.6 V */
1595 	cmd.cmdarg = ((mmc->cfg->voltages & 0xff8000) != 0) << 8 | 0xaa;
1596 	cmd.resp_type = MMC_RSP_R7;
1597 
1598 	err = mmc_send_cmd(mmc, &cmd, NULL);
1599 
1600 	if (err)
1601 		return err;
1602 
1603 	if ((cmd.response[0] & 0xff) != 0xaa)
1604 		return -EOPNOTSUPP;
1605 	else
1606 		mmc->version = SD_VERSION_2;
1607 
1608 	return 0;
1609 }
1610 
1611 #if !CONFIG_IS_ENABLED(DM_MMC)
1612 /* board-specific MMC power initializations. */
1613 __weak void board_mmc_power_init(void)
1614 {
1615 }
1616 #endif
1617 
1618 static int mmc_power_init(struct mmc *mmc)
1619 {
1620 #if CONFIG_IS_ENABLED(DM_MMC)
1621 #if defined(CONFIG_DM_REGULATOR) && !defined(CONFIG_SPL_BUILD)
1622 	struct udevice *vmmc_supply;
1623 	int ret;
1624 
1625 	ret = device_get_supply_regulator(mmc->dev, "vmmc-supply",
1626 					  &vmmc_supply);
1627 	if (ret) {
1628 		debug("%s: No vmmc supply\n", mmc->dev->name);
1629 		return 0;
1630 	}
1631 
1632 	ret = regulator_set_enable(vmmc_supply, true);
1633 	if (ret) {
1634 		puts("Error enabling VMMC supply\n");
1635 		return ret;
1636 	}
1637 #endif
1638 #else /* !CONFIG_DM_MMC */
1639 	/*
1640 	 * Driver model should use a regulator, as above, rather than calling
1641 	 * out to board code.
1642 	 */
1643 	board_mmc_power_init();
1644 #endif
1645 	return 0;
1646 }
1647 
1648 int mmc_start_init(struct mmc *mmc)
1649 {
1650 	bool no_card;
1651 	int err;
1652 
1653 	/* we pretend there's no card when init is NULL */
1654 	no_card = mmc_getcd(mmc) == 0;
1655 #if !CONFIG_IS_ENABLED(DM_MMC)
1656 	no_card = no_card || (mmc->cfg->ops->init == NULL);
1657 #endif
1658 	if (no_card) {
1659 		mmc->has_init = 0;
1660 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
1661 		printf("MMC: no card present\n");
1662 #endif
1663 		return -ENOMEDIUM;
1664 	}
1665 
1666 	if (mmc->has_init)
1667 		return 0;
1668 
1669 #ifdef CONFIG_FSL_ESDHC_ADAPTER_IDENT
1670 	mmc_adapter_card_type_ident();
1671 #endif
1672 	err = mmc_power_init(mmc);
1673 	if (err)
1674 		return err;
1675 
1676 #if CONFIG_IS_ENABLED(DM_MMC)
1677 	/* The device has already been probed ready for use */
1678 #else
1679 	/* made sure it's not NULL earlier */
1680 	err = mmc->cfg->ops->init(mmc);
1681 	if (err)
1682 		return err;
1683 #endif
1684 	mmc->ddr_mode = 0;
1685 	mmc_set_bus_width(mmc, 1);
1686 	mmc_set_clock(mmc, 1);
1687 
1688 	/* Reset the Card */
1689 	err = mmc_go_idle(mmc);
1690 
1691 	if (err)
1692 		return err;
1693 
1694 	/* The internal partition reset to user partition(0) at every CMD0*/
1695 	mmc_get_blk_desc(mmc)->hwpart = 0;
1696 
1697 	/* Test for SD version 2 */
1698 	err = mmc_send_if_cond(mmc);
1699 
1700 	/* Now try to get the SD card's operating condition */
1701 	err = sd_send_op_cond(mmc);
1702 
1703 	/* If the command timed out, we check for an MMC card */
1704 	if (err == -ETIMEDOUT) {
1705 		err = mmc_send_op_cond(mmc);
1706 
1707 		if (err) {
1708 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_LIBCOMMON_SUPPORT)
1709 			printf("Card did not respond to voltage select!\n");
1710 #endif
1711 			return -EOPNOTSUPP;
1712 		}
1713 	}
1714 
1715 	if (!err)
1716 		mmc->init_in_progress = 1;
1717 
1718 	return err;
1719 }
1720 
1721 static int mmc_complete_init(struct mmc *mmc)
1722 {
1723 	int err = 0;
1724 
1725 	mmc->init_in_progress = 0;
1726 	if (mmc->op_cond_pending)
1727 		err = mmc_complete_op_cond(mmc);
1728 
1729 	if (!err)
1730 		err = mmc_startup(mmc);
1731 	if (err)
1732 		mmc->has_init = 0;
1733 	else
1734 		mmc->has_init = 1;
1735 	return err;
1736 }
1737 
1738 int mmc_init(struct mmc *mmc)
1739 {
1740 	int err = 0;
1741 	__maybe_unused unsigned start;
1742 #if CONFIG_IS_ENABLED(DM_MMC)
1743 	struct mmc_uclass_priv *upriv = dev_get_uclass_priv(mmc->dev);
1744 
1745 	upriv->mmc = mmc;
1746 #endif
1747 	if (mmc->has_init)
1748 		return 0;
1749 
1750 	start = get_timer(0);
1751 
1752 	if (!mmc->init_in_progress)
1753 		err = mmc_start_init(mmc);
1754 
1755 	if (!err)
1756 		err = mmc_complete_init(mmc);
1757 	if (err)
1758 		printf("%s: %d, time %lu\n", __func__, err, get_timer(start));
1759 
1760 	return err;
1761 }
1762 
1763 int mmc_set_dsr(struct mmc *mmc, u16 val)
1764 {
1765 	mmc->dsr = val;
1766 	return 0;
1767 }
1768 
1769 /* CPU-specific MMC initializations */
1770 __weak int cpu_mmc_init(bd_t *bis)
1771 {
1772 	return -1;
1773 }
1774 
1775 /* board-specific MMC initializations. */
1776 __weak int board_mmc_init(bd_t *bis)
1777 {
1778 	return -1;
1779 }
1780 
1781 void mmc_set_preinit(struct mmc *mmc, int preinit)
1782 {
1783 	mmc->preinit = preinit;
1784 }
1785 
1786 #if CONFIG_IS_ENABLED(DM_MMC) && defined(CONFIG_SPL_BUILD)
1787 static int mmc_probe(bd_t *bis)
1788 {
1789 	return 0;
1790 }
1791 #elif CONFIG_IS_ENABLED(DM_MMC)
1792 static int mmc_probe(bd_t *bis)
1793 {
1794 	int ret, i;
1795 	struct uclass *uc;
1796 	struct udevice *dev;
1797 
1798 	ret = uclass_get(UCLASS_MMC, &uc);
1799 	if (ret)
1800 		return ret;
1801 
1802 	/*
1803 	 * Try to add them in sequence order. Really with driver model we
1804 	 * should allow holes, but the current MMC list does not allow that.
1805 	 * So if we request 0, 1, 3 we will get 0, 1, 2.
1806 	 */
1807 	for (i = 0; ; i++) {
1808 		ret = uclass_get_device_by_seq(UCLASS_MMC, i, &dev);
1809 		if (ret == -ENODEV)
1810 			break;
1811 	}
1812 	uclass_foreach_dev(dev, uc) {
1813 		ret = device_probe(dev);
1814 		if (ret)
1815 			printf("%s - probe failed: %d\n", dev->name, ret);
1816 	}
1817 
1818 	return 0;
1819 }
1820 #else
1821 static int mmc_probe(bd_t *bis)
1822 {
1823 	if (board_mmc_init(bis) < 0)
1824 		cpu_mmc_init(bis);
1825 
1826 	return 0;
1827 }
1828 #endif
1829 
1830 int mmc_initialize(bd_t *bis)
1831 {
1832 	static int initialized = 0;
1833 	int ret;
1834 	if (initialized)	/* Avoid initializing mmc multiple times */
1835 		return 0;
1836 	initialized = 1;
1837 
1838 #if !CONFIG_IS_ENABLED(BLK)
1839 #if !CONFIG_IS_ENABLED(MMC_TINY)
1840 	mmc_list_init();
1841 #endif
1842 #endif
1843 	ret = mmc_probe(bis);
1844 	if (ret)
1845 		return ret;
1846 
1847 #ifndef CONFIG_SPL_BUILD
1848 	print_mmc_devices(',');
1849 #endif
1850 
1851 	mmc_do_preinit();
1852 	return 0;
1853 }
1854 
1855 #ifdef CONFIG_CMD_BKOPS_ENABLE
1856 int mmc_set_bkops_enable(struct mmc *mmc)
1857 {
1858 	int err;
1859 	ALLOC_CACHE_ALIGN_BUFFER(u8, ext_csd, MMC_MAX_BLOCK_LEN);
1860 
1861 	err = mmc_send_ext_csd(mmc, ext_csd);
1862 	if (err) {
1863 		puts("Could not get ext_csd register values\n");
1864 		return err;
1865 	}
1866 
1867 	if (!(ext_csd[EXT_CSD_BKOPS_SUPPORT] & 0x1)) {
1868 		puts("Background operations not supported on device\n");
1869 		return -EMEDIUMTYPE;
1870 	}
1871 
1872 	if (ext_csd[EXT_CSD_BKOPS_EN] & 0x1) {
1873 		puts("Background operations already enabled\n");
1874 		return 0;
1875 	}
1876 
1877 	err = mmc_switch(mmc, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_BKOPS_EN, 1);
1878 	if (err) {
1879 		puts("Failed to enable manual background operations\n");
1880 		return err;
1881 	}
1882 
1883 	puts("Enabled manual background operations\n");
1884 
1885 	return 0;
1886 }
1887 #endif
1888