[u-boot.git] / env / mmc.c

// SPDX-License-Identifier: GPL-2.0+
/*
 * (C) Copyright 2008-2011 Freescale Semiconductor, Inc.
 */

/* #define DEBUG */

#include <common.h>
#include <asm/global_data.h>

#include <command.h>
#include <env.h>
#include <env_internal.h>
#include <fdtdec.h>
#include <linux/stddef.h>
#include <malloc.h>
#include <memalign.h>
#include <mmc.h>
#include <part.h>
#include <search.h>
#include <errno.h>

#define __STR(X) #X
#define STR(X) __STR(X)

DECLARE_GLOBAL_DATA_PTR;

#if CONFIG_IS_ENABLED(OF_CONTROL)
static inline int mmc_offset_try_partition(const char *str, int copy, s64 *val)
{
	struct disk_partition info;
	struct blk_desc *desc;
	int len, i, ret;
	char dev_str[4];

	snprintf(dev_str, sizeof(dev_str), "%d", mmc_get_env_dev());
	ret = blk_get_device_by_str("mmc", dev_str, &desc);
	if (ret < 0)
		return (ret);

	for (i = 1;;i++) {
		ret = part_get_info(desc, i, &info);
		if (ret < 0)
			return ret;

		if (!strncmp((const char *)info.name, str, sizeof(info.name)))
			break;
	}

	/* round up to info.blksz */
	len = DIV_ROUND_UP(CONFIG_ENV_SIZE, info.blksz);

	/* use the top of the partion for the environment */
	*val = (info.start + info.size - (1 + copy) * len) * info.blksz;

	return 0;
}

static inline s64 mmc_offset(int copy)
{
	const struct {
		const char *offset_redund;
		const char *partition;
		const char *offset;
	} dt_prop = {
		.offset_redund = "u-boot,mmc-env-offset-redundant",
		.partition = "u-boot,mmc-env-partition",
		.offset = "u-boot,mmc-env-offset",
	};
	s64 val = 0, defvalue;
	const char *propname;
	const char *str;
	int err;

	/* look for the partition in mmc CONFIG_SYS_MMC_ENV_DEV */
	str = fdtdec_get_config_string(gd->fdt_blob, dt_prop.partition);
	if (str) {
		/* try to place the environment at end of the partition */
		err = mmc_offset_try_partition(str, copy, &val);
		if (!err)
			return val;
	}

	defvalue = CONFIG_ENV_OFFSET;
	propname = dt_prop.offset;

#if defined(CONFIG_ENV_OFFSET_REDUND)
	if (copy) {
		defvalue = CONFIG_ENV_OFFSET_REDUND;
		propname = dt_prop.offset_redund;
	}
#endif
	return fdtdec_get_config_int(gd->fdt_blob, propname, defvalue);
}
#else
static inline s64 mmc_offset(int copy)
{
	s64 offset = CONFIG_ENV_OFFSET;

#if defined(CONFIG_ENV_OFFSET_REDUND)
	if (copy)
		offset = CONFIG_ENV_OFFSET_REDUND;
#endif
	return offset;
}
#endif

__weak int mmc_get_env_addr(struct mmc *mmc, int copy, u32 *env_addr)
{
	s64 offset = mmc_offset(copy);

	if (offset < 0)
		offset += mmc->capacity;

	*env_addr = offset;

	return 0;
}

#ifdef CONFIG_SYS_MMC_ENV_PART
__weak uint mmc_get_env_part(struct mmc *mmc)
{
	return CONFIG_SYS_MMC_ENV_PART;
}

static unsigned char env_mmc_orig_hwpart;

static int mmc_set_env_part(struct mmc *mmc)
{
	uint part = mmc_get_env_part(mmc);
	int dev = mmc_get_env_dev();
	int ret = 0;

	env_mmc_orig_hwpart = mmc_get_blk_desc(mmc)->hwpart;
	ret = blk_select_hwpart_devnum(IF_TYPE_MMC, dev, part);
	if (ret)
		puts("MMC partition switch failed\n");

	return ret;
}
#else
static inline int mmc_set_env_part(struct mmc *mmc) {return 0; };
#endif

static const char *init_mmc_for_env(struct mmc *mmc)
{
	if (!mmc)
		return "No MMC card found";

#if CONFIG_IS_ENABLED(BLK)
	struct udevice *dev;

	if (blk_get_from_parent(mmc->dev, &dev))
		return "No block device";
#else
	if (mmc_init(mmc))
		return "MMC init failed";
#endif
	if (mmc_set_env_part(mmc))
		return "MMC partition switch failed";

	return NULL;
}

static void fini_mmc_for_env(struct mmc *mmc)
{
#ifdef CONFIG_SYS_MMC_ENV_PART
	int dev = mmc_get_env_dev();

	blk_select_hwpart_devnum(IF_TYPE_MMC, dev, env_mmc_orig_hwpart);
#endif
}

#if defined(CONFIG_CMD_SAVEENV) && !defined(CONFIG_SPL_BUILD)
static inline int write_env(struct mmc *mmc, unsigned long size,
			    unsigned long offset, const void *buffer)
{
	uint blk_start, blk_cnt, n;
	struct blk_desc *desc = mmc_get_blk_desc(mmc);

	blk_start	= ALIGN(offset, mmc->write_bl_len) / mmc->write_bl_len;
	blk_cnt		= ALIGN(size, mmc->write_bl_len) / mmc->write_bl_len;

	n = blk_dwrite(desc, blk_start, blk_cnt, (u_char *)buffer);

	return (n == blk_cnt) ? 0 : -1;
}

static int env_mmc_save(void)
{
	ALLOC_CACHE_ALIGN_BUFFER(env_t, env_new, 1);
	int dev = mmc_get_env_dev();
	struct mmc *mmc = find_mmc_device(dev);
	u32	offset;
	int	ret, copy = 0;
	const char *errmsg;

	errmsg = init_mmc_for_env(mmc);
	if (errmsg) {
		printf("%s\n", errmsg);
		return 1;
	}

	ret = env_export(env_new);
	if (ret)
		goto fini;

#ifdef CONFIG_ENV_OFFSET_REDUND
	if (gd->env_valid == ENV_VALID)
		copy = 1;
#endif

	if (mmc_get_env_addr(mmc, copy, &offset)) {
		ret = 1;
		goto fini;
	}

	printf("Writing to %sMMC(%d)... ", copy ? "redundant " : "", dev);
	if (write_env(mmc, CONFIG_ENV_SIZE, offset, (u_char *)env_new)) {
		puts("failed\n");
		ret = 1;
		goto fini;
	}

	ret = 0;

#ifdef CONFIG_ENV_OFFSET_REDUND
	gd->env_valid = gd->env_valid == ENV_REDUND ? ENV_VALID : ENV_REDUND;
#endif

fini:
	fini_mmc_for_env(mmc);
	return ret;
}

static inline int erase_env(struct mmc *mmc, unsigned long size,
			    unsigned long offset)
{
	uint blk_start, blk_cnt, n;
	struct blk_desc *desc = mmc_get_blk_desc(mmc);

	blk_start	= ALIGN(offset, mmc->write_bl_len) / mmc->write_bl_len;
	blk_cnt		= ALIGN(size, mmc->write_bl_len) / mmc->write_bl_len;

	n = blk_derase(desc, blk_start, blk_cnt);
	printf("%d blocks erased: %s\n", n, (n == blk_cnt) ? "OK" : "ERROR");

	return (n == blk_cnt) ? 0 : 1;
}

static int env_mmc_erase(void)
{
	int dev = mmc_get_env_dev();
	struct mmc *mmc = find_mmc_device(dev);
	int	ret, copy = 0;
	u32	offset;
	const char *errmsg;

	errmsg = init_mmc_for_env(mmc);
	if (errmsg) {
		printf("%s\n", errmsg);
		return 1;
	}

	if (mmc_get_env_addr(mmc, copy, &offset))
		return CMD_RET_FAILURE;

	ret = erase_env(mmc, CONFIG_ENV_SIZE, offset);

#ifdef CONFIG_ENV_OFFSET_REDUND
	copy = 1;

	if (mmc_get_env_addr(mmc, copy, &offset))
		return CMD_RET_FAILURE;

	ret |= erase_env(mmc, CONFIG_ENV_SIZE, offset);
#endif

	return ret;
}
#endif /* CONFIG_CMD_SAVEENV && !CONFIG_SPL_BUILD */

static inline int read_env(struct mmc *mmc, unsigned long size,
			   unsigned long offset, const void *buffer)
{
	uint blk_start, blk_cnt, n;
	struct blk_desc *desc = mmc_get_blk_desc(mmc);

	blk_start	= ALIGN(offset, mmc->read_bl_len) / mmc->read_bl_len;
	blk_cnt		= ALIGN(size, mmc->read_bl_len) / mmc->read_bl_len;

	n = blk_dread(desc, blk_start, blk_cnt, (uchar *)buffer);

	return (n == blk_cnt) ? 0 : -1;
}

#ifdef CONFIG_ENV_OFFSET_REDUND
static int env_mmc_load(void)
{
#if !defined(ENV_IS_EMBEDDED)
	struct mmc *mmc;
	u32 offset1, offset2;
	int read1_fail = 0, read2_fail = 0;
	int ret;
	int dev = mmc_get_env_dev();
	const char *errmsg = NULL;

	ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env1, 1);
	ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env2, 1);

	mmc_initialize(NULL);

	mmc = find_mmc_device(dev);

	errmsg = init_mmc_for_env(mmc);
	if (errmsg) {
		ret = -EIO;
		goto err;
	}

	if (mmc_get_env_addr(mmc, 0, &offset1) ||
	    mmc_get_env_addr(mmc, 1, &offset2)) {
		ret = -EIO;
		goto fini;
	}

	read1_fail = read_env(mmc, CONFIG_ENV_SIZE, offset1, tmp_env1);
	read2_fail = read_env(mmc, CONFIG_ENV_SIZE, offset2, tmp_env2);

	ret = env_import_redund((char *)tmp_env1, read1_fail, (char *)tmp_env2,
				read2_fail, H_EXTERNAL);

fini:
	fini_mmc_for_env(mmc);
err:
	if (ret)
		env_set_default(errmsg, 0);

#endif
	return ret;
}
#else /* ! CONFIG_ENV_OFFSET_REDUND */
static int env_mmc_load(void)
{
#if !defined(ENV_IS_EMBEDDED)
	ALLOC_CACHE_ALIGN_BUFFER(char, buf, CONFIG_ENV_SIZE);
	struct mmc *mmc;
	u32 offset;
	int ret;
	int dev = mmc_get_env_dev();
	const char *errmsg;
	env_t *ep = NULL;

	mmc = find_mmc_device(dev);

	errmsg = init_mmc_for_env(mmc);
	if (errmsg) {
		ret = -EIO;
		goto err;
	}

	if (mmc_get_env_addr(mmc, 0, &offset)) {
		ret = -EIO;
		goto fini;
	}

	if (read_env(mmc, CONFIG_ENV_SIZE, offset, buf)) {
		errmsg = "!read failed";
		ret = -EIO;
		goto fini;
	}

	ret = env_import(buf, 1, H_EXTERNAL);
	if (!ret) {
		ep = (env_t *)buf;
		gd->env_addr = (ulong)&ep->data;
	}

fini:
	fini_mmc_for_env(mmc);
err:
	if (ret)
		env_set_default(errmsg, 0);
#endif
	return ret;
}
#endif /* CONFIG_ENV_OFFSET_REDUND */

U_BOOT_ENV_LOCATION(mmc) = {
	.location	= ENVL_MMC,
	ENV_NAME("MMC")
	.load		= env_mmc_load,
#ifndef CONFIG_SPL_BUILD
	.save		= env_save_ptr(env_mmc_save),
	.erase		= ENV_ERASE_PTR(env_mmc_erase)
#endif
};
Commit	Line	Data
83d290c5	1	// SPDX-License-Identifier: GPL-2.0+
a8060359	2	/*
97039ab9	3	* (C) Copyright 2008-2011 Freescale Semiconductor, Inc.
a8060359 TL	4	*/
	5
	6	/* #define DEBUG */
	7
	8	#include <common.h>
401d1c4f	9	#include <asm/global_data.h>
a8060359 TL	10
a8060359 TL	11	#include <command.h>
0ac7d722	12	#include <env.h>
f3998fdc	13	#include <env_internal.h>
f8b8a554	14	#include <fdtdec.h>
a8060359 TL	15	#include <linux/stddef.h>
a8060359 TL	16	#include <malloc.h>
cf92e05c	17	#include <memalign.h>
a8060359	18	#include <mmc.h>
c9e87ba6	19	#include <part.h>
6d1d51b3	20	#include <search.h>
e79f4839	21	#include <errno.h>
a8060359	22
c9e87ba6 JRO	23	#define __STR(X) #X
	24	#define STR(X) __STR(X)
	25
a8060359 TL	26	DECLARE_GLOBAL_DATA_PTR;
a8060359 TL	27
f8b8a554	28	#if CONFIG_IS_ENABLED(OF_CONTROL)
5d4f7b4e	29	static inline int mmc_offset_try_partition(const char str, int copy, s64 val)
c9e87ba6	30	{
0528979f	31	struct disk_partition info;
c9e87ba6 JRO	32	struct blk_desc *desc;
c9e87ba6 JRO	33	int len, i, ret;
2b2f7275	34	char dev_str[4];
c9e87ba6	35
2b2f7275 PD	36	snprintf(dev_str, sizeof(dev_str), "%d", mmc_get_env_dev());
2b2f7275 PD	37	ret = blk_get_device_by_str("mmc", dev_str, &desc);
c9e87ba6 JRO	38	if (ret < 0)
	39	return (ret);
	40
	41	for (i = 1;;i++) {
	42	ret = part_get_info(desc, i, &info);
	43	if (ret < 0)
	44	return ret;
	45
2a0a577a	46	if (!strncmp((const char *)info.name, str, sizeof(info.name)))
c9e87ba6 JRO	47	break;
	48	}
	49
	50	/* round up to info.blksz */
76b640c3	51	len = DIV_ROUND_UP(CONFIG_ENV_SIZE, info.blksz);
c9e87ba6 JRO	52
c9e87ba6 JRO	53	/* use the top of the partion for the environment */
5d4f7b4e	54	val = (info.start + info.size - (1 + copy) len) * info.blksz;
c9e87ba6 JRO	55
	56	return 0;
	57	}
	58
f8b8a554 PT	59	static inline s64 mmc_offset(int copy)
f8b8a554 PT	60	{
c9e87ba6 JRO	61	const struct {
	62	const char *offset_redund;
	63	const char *partition;
	64	const char *offset;
	65	} dt_prop = {
	66	.offset_redund = "u-boot,mmc-env-offset-redundant",
	67	.partition = "u-boot,mmc-env-partition",
	68	.offset = "u-boot,mmc-env-offset",
	69	};
fd374665	70	s64 val = 0, defvalue;
c9e87ba6 JRO	71	const char *propname;
	72	const char *str;
	73	int err;
	74
	75	/* look for the partition in mmc CONFIG_SYS_MMC_ENV_DEV */
	76	str = fdtdec_get_config_string(gd->fdt_blob, dt_prop.partition);
	77	if (str) {
	78	/* try to place the environment at end of the partition */
5d4f7b4e	79	err = mmc_offset_try_partition(str, copy, &val);
c9e87ba6 JRO	80	if (!err)
	81	return val;
	82	}
	83
	84	defvalue = CONFIG_ENV_OFFSET;
	85	propname = dt_prop.offset;
f8b8a554 PT	86
	87	#if defined(CONFIG_ENV_OFFSET_REDUND)
	88	if (copy) {
f8b8a554	89	defvalue = CONFIG_ENV_OFFSET_REDUND;
c9e87ba6	90	propname = dt_prop.offset_redund;
f8b8a554 PT	91	}
f8b8a554 PT	92	#endif
f8b8a554 PT	93	return fdtdec_get_config_int(gd->fdt_blob, propname, defvalue);
	94	}
	95	#else
	96	static inline s64 mmc_offset(int copy)
97039ab9	97	{
f8b8a554	98	s64 offset = CONFIG_ENV_OFFSET;
5c088ee8	99
f8b8a554	100	#if defined(CONFIG_ENV_OFFSET_REDUND)
d196bd88	101	if (copy)
5c088ee8	102	offset = CONFIG_ENV_OFFSET_REDUND;
d196bd88	103	#endif
f8b8a554 PT	104	return offset;
	105	}
	106	#endif
	107
	108	__weak int mmc_get_env_addr(struct mmc mmc, int copy, u32 env_addr)
	109	{
	110	s64 offset = mmc_offset(copy);
5c088ee8 SW	111
	112	if (offset < 0)
	113	offset += mmc->capacity;
	114
	115	*env_addr = offset;
	116
97039ab9 MH	117	return 0;
97039ab9 MH	118	}
97039ab9	119
b9c8ccab	120	#ifdef CONFIG_SYS_MMC_ENV_PART
6e7b7df4 DL	121	__weak uint mmc_get_env_part(struct mmc *mmc)
	122	{
	123	return CONFIG_SYS_MMC_ENV_PART;
	124	}
	125
873cc1d7 SW	126	static unsigned char env_mmc_orig_hwpart;
873cc1d7 SW	127
6e7b7df4 DL	128	static int mmc_set_env_part(struct mmc *mmc)
	129	{
	130	uint part = mmc_get_env_part(mmc);
e92029c0	131	int dev = mmc_get_env_dev();
6e7b7df4	132	int ret = 0;
b9c8ccab	133
69f45cd5 SG	134	env_mmc_orig_hwpart = mmc_get_blk_desc(mmc)->hwpart;
69f45cd5 SG	135	ret = blk_select_hwpart_devnum(IF_TYPE_MMC, dev, part);
873cc1d7 SW	136	if (ret)
873cc1d7 SW	137	puts("MMC partition switch failed\n");
6e7b7df4 DL	138
	139	return ret;
	140	}
	141	#else
	142	static inline int mmc_set_env_part(struct mmc *mmc) {return 0; };
b9c8ccab TR	143	#endif
b9c8ccab TR	144
c75648d7	145	static const char init_mmc_for_env(struct mmc mmc)
6e7b7df4	146	{
c75648d7	147	if (!mmc)
c5d548a9	148	return "No MMC card found";
a8060359	149
d48b8d11	150	#if CONFIG_IS_ENABLED(BLK)
01b73fe6 SG	151	struct udevice *dev;
	152
	153	if (blk_get_from_parent(mmc->dev, &dev))
c5d548a9	154	return "No block device";
01b73fe6	155	#else
c75648d7	156	if (mmc_init(mmc))
c5d548a9	157	return "MMC init failed";
e7017a3c	158	#endif
c75648d7	159	if (mmc_set_env_part(mmc))
c5d548a9	160	return "MMC partition switch failed";
a8060359	161
c75648d7	162	return NULL;
a8060359 TL	163	}
a8060359 TL	164
9404a5fc SW	165	static void fini_mmc_for_env(struct mmc *mmc)
	166	{
	167	#ifdef CONFIG_SYS_MMC_ENV_PART
e92029c0	168	int dev = mmc_get_env_dev();
b9c8ccab	169
69f45cd5	170	blk_select_hwpart_devnum(IF_TYPE_MMC, dev, env_mmc_orig_hwpart);
9404a5fc SW	171	#endif
	172	}
	173
e5bce247	174	#if defined(CONFIG_CMD_SAVEENV) && !defined(CONFIG_SPL_BUILD)
e8db8f71 IG	175	static inline int write_env(struct mmc *mmc, unsigned long size,
e8db8f71 IG	176	unsigned long offset, const void *buffer)
a8060359 TL	177	{
a8060359 TL	178	uint blk_start, blk_cnt, n;
5461acba	179	struct blk_desc *desc = mmc_get_blk_desc(mmc);
a8060359	180
e8db8f71 IG	181	blk_start = ALIGN(offset, mmc->write_bl_len) / mmc->write_bl_len;
e8db8f71 IG	182	blk_cnt = ALIGN(size, mmc->write_bl_len) / mmc->write_bl_len;
a8060359	183
5461acba	184	n = blk_dwrite(desc, blk_start, blk_cnt, (u_char *)buffer);
a8060359 TL	185
	186	return (n == blk_cnt) ? 0 : -1;
	187	}
	188
e5bce247	189	static int env_mmc_save(void)
a8060359	190	{
cd0f4fa1	191	ALLOC_CACHE_ALIGN_BUFFER(env_t, env_new, 1);
e92029c0 CG	192	int dev = mmc_get_env_dev();
e92029c0 CG	193	struct mmc *mmc = find_mmc_device(dev);
e8db8f71	194	u32 offset;
d196bd88	195	int ret, copy = 0;
c75648d7	196	const char *errmsg;
a8060359	197
c75648d7 TH	198	errmsg = init_mmc_for_env(mmc);
	199	if (errmsg) {
	200	printf("%s\n", errmsg);
97039ab9	201	return 1;
c75648d7	202	}
97039ab9	203
7ce1526e MV	204	ret = env_export(env_new);
7ce1526e MV	205	if (ret)
9404a5fc	206	goto fini;
d196bd88 MH	207
d196bd88 MH	208	#ifdef CONFIG_ENV_OFFSET_REDUND
203e94f6	209	if (gd->env_valid == ENV_VALID)
d196bd88 MH	210	copy = 1;
	211	#endif
	212
	213	if (mmc_get_env_addr(mmc, copy, &offset)) {
	214	ret = 1;
	215	goto fini;
	216	}
	217
e92029c0	218	printf("Writing to %sMMC(%d)... ", copy ? "redundant " : "", dev);
4036b630	219	if (write_env(mmc, CONFIG_ENV_SIZE, offset, (u_char *)env_new)) {
a8060359	220	puts("failed\n");
9404a5fc SW	221	ret = 1;
9404a5fc SW	222	goto fini;
a8060359 TL	223	}
a8060359 TL	224
9404a5fc SW	225	ret = 0;
9404a5fc SW	226
d196bd88	227	#ifdef CONFIG_ENV_OFFSET_REDUND
203e94f6	228	gd->env_valid = gd->env_valid == ENV_REDUND ? ENV_VALID : ENV_REDUND;
d196bd88 MH	229	#endif
d196bd88 MH	230
9404a5fc SW	231	fini:
	232	fini_mmc_for_env(mmc);
	233	return ret;
a8060359	234	}
34853925	235
34853925 FW	236	static inline int erase_env(struct mmc *mmc, unsigned long size,
	237	unsigned long offset)
	238	{
	239	uint blk_start, blk_cnt, n;
	240	struct blk_desc *desc = mmc_get_blk_desc(mmc);
	241
	242	blk_start = ALIGN(offset, mmc->write_bl_len) / mmc->write_bl_len;
	243	blk_cnt = ALIGN(size, mmc->write_bl_len) / mmc->write_bl_len;
	244
	245	n = blk_derase(desc, blk_start, blk_cnt);
	246	printf("%d blocks erased: %s\n", n, (n == blk_cnt) ? "OK" : "ERROR");
	247
	248	return (n == blk_cnt) ? 0 : 1;
	249	}
	250
	251	static int env_mmc_erase(void)
	252	{
	253	int dev = mmc_get_env_dev();
	254	struct mmc *mmc = find_mmc_device(dev);
	255	int ret, copy = 0;
	256	u32 offset;
	257	const char *errmsg;
	258
	259	errmsg = init_mmc_for_env(mmc);
	260	if (errmsg) {
	261	printf("%s\n", errmsg);
	262	return 1;
	263	}
	264
	265	if (mmc_get_env_addr(mmc, copy, &offset))
	266	return CMD_RET_FAILURE;
	267
	268	ret = erase_env(mmc, CONFIG_ENV_SIZE, offset);
	269
	270	#ifdef CONFIG_ENV_OFFSET_REDUND
	271	copy = 1;
	272
	273	if (mmc_get_env_addr(mmc, copy, &offset))
	274	return CMD_RET_FAILURE;
	275
	276	ret \|= erase_env(mmc, CONFIG_ENV_SIZE, offset);
	277	#endif
	278
	279	return ret;
	280	}
e5bce247	281	#endif /* CONFIG_CMD_SAVEENV && !CONFIG_SPL_BUILD */
a8060359	282
e8db8f71 IG	283	static inline int read_env(struct mmc *mmc, unsigned long size,
e8db8f71 IG	284	unsigned long offset, const void *buffer)
a8060359 TL	285	{
a8060359 TL	286	uint blk_start, blk_cnt, n;
5461acba	287	struct blk_desc *desc = mmc_get_blk_desc(mmc);
a8060359	288
e8db8f71 IG	289	blk_start = ALIGN(offset, mmc->read_bl_len) / mmc->read_bl_len;
e8db8f71 IG	290	blk_cnt = ALIGN(size, mmc->read_bl_len) / mmc->read_bl_len;
a8060359	291
5461acba	292	n = blk_dread(desc, blk_start, blk_cnt, (uchar *)buffer);
a8060359 TL	293
	294	return (n == blk_cnt) ? 0 : -1;
	295	}
	296
d196bd88	297	#ifdef CONFIG_ENV_OFFSET_REDUND
c5951991	298	static int env_mmc_load(void)
d196bd88 MH	299	{
d196bd88 MH	300	#if !defined(ENV_IS_EMBEDDED)
b9c8ccab	301	struct mmc *mmc;
d196bd88 MH	302	u32 offset1, offset2;
d196bd88 MH	303	int read1_fail = 0, read2_fail = 0;
d196bd88	304	int ret;
e92029c0	305	int dev = mmc_get_env_dev();
c75648d7	306	const char *errmsg = NULL;
d196bd88	307
452a2722 MN	308	ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env1, 1);
	309	ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env2, 1);
	310
26862b4a FA	311	mmc_initialize(NULL);
26862b4a FA	312
b9c8ccab TR	313	mmc = find_mmc_device(dev);
b9c8ccab TR	314
c75648d7 TH	315	errmsg = init_mmc_for_env(mmc);
c75648d7 TH	316	if (errmsg) {
c5951991	317	ret = -EIO;
d196bd88 MH	318	goto err;
	319	}
	320
	321	if (mmc_get_env_addr(mmc, 0, &offset1) \|\|
	322	mmc_get_env_addr(mmc, 1, &offset2)) {
c5951991	323	ret = -EIO;
d196bd88 MH	324	goto fini;
	325	}
	326
	327	read1_fail = read_env(mmc, CONFIG_ENV_SIZE, offset1, tmp_env1);
	328	read2_fail = read_env(mmc, CONFIG_ENV_SIZE, offset2, tmp_env2);
	329
31f044bd	330	ret = env_import_redund((char )tmp_env1, read1_fail, (char )tmp_env2,
890feeca	331	read2_fail, H_EXTERNAL);
d196bd88 MH	332
	333	fini:
	334	fini_mmc_for_env(mmc);
	335	err:
	336	if (ret)
0ac7d722	337	env_set_default(errmsg, 0);
c5951991	338
d196bd88	339	#endif
c5951991	340	return ret;
d196bd88 MH	341	}
d196bd88 MH	342	#else /* ! CONFIG_ENV_OFFSET_REDUND */
c5951991	343	static int env_mmc_load(void)
a8060359 TL	344	{
a8060359 TL	345	#if !defined(ENV_IS_EMBEDDED)
cd0f4fa1	346	ALLOC_CACHE_ALIGN_BUFFER(char, buf, CONFIG_ENV_SIZE);
b9c8ccab	347	struct mmc *mmc;
97039ab9	348	u32 offset;
9404a5fc	349	int ret;
e92029c0	350	int dev = mmc_get_env_dev();
c75648d7	351	const char *errmsg;
0536b440	352	env_t *ep = NULL;
b9c8ccab	353
b9c8ccab	354	mmc = find_mmc_device(dev);
a8060359	355
c75648d7 TH	356	errmsg = init_mmc_for_env(mmc);
c75648d7 TH	357	if (errmsg) {
c5951991	358	ret = -EIO;
9404a5fc SW	359	goto err;
9404a5fc SW	360	}
a8060359	361
d196bd88	362	if (mmc_get_env_addr(mmc, 0, &offset)) {
c5951991	363	ret = -EIO;
9404a5fc SW	364	goto fini;
	365	}
	366
cd0f4fa1	367	if (read_env(mmc, CONFIG_ENV_SIZE, offset, buf)) {
c75648d7	368	errmsg = "!read failed";
c5951991	369	ret = -EIO;
9404a5fc SW	370	goto fini;
9404a5fc SW	371	}
a8060359	372
890feeca	373	ret = env_import(buf, 1, H_EXTERNAL);
0536b440 PG	374	if (!ret) {
	375	ep = (env_t *)buf;
	376	gd->env_addr = (ulong)&ep->data;
	377	}
9404a5fc SW	378
	379	fini:
	380	fini_mmc_for_env(mmc);
	381	err:
	382	if (ret)
0ac7d722	383	env_set_default(errmsg, 0);
a8060359	384	#endif
c5951991	385	return ret;
a8060359	386	}
d196bd88	387	#endif /* CONFIG_ENV_OFFSET_REDUND */
4415f1d1 SG	388
	389	U_BOOT_ENV_LOCATION(mmc) = {
	390	.location = ENVL_MMC,
ac358beb	391	ENV_NAME("MMC")
e5bce247	392	.load = env_mmc_load,
4415f1d1	393	#ifndef CONFIG_SPL_BUILD
e5bce247	394	.save = env_save_ptr(env_mmc_save),
1af031ac	395	.erase = ENV_ERASE_PTR(env_mmc_erase)
4415f1d1	396	#endif
4415f1d1	397	};