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

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