[people/ms/u-boot.git] / common / env_nand.c

/*
 * (C) Copyright 2008
 * Stuart Wood, Lab X Technologies <stuart.wood@labxtechnologies.com>
 *
 * (C) Copyright 2004
 * Jian Zhang, Texas Instruments, jzhang@ti.com.

 * (C) Copyright 2000-2006
 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
 *
 * (C) Copyright 2001 Sysgo Real-Time Solutions, GmbH <www.elinos.com>
 * Andreas Heppel <aheppel@sysgo.de>

 * See file CREDITS for list of people who contributed to this
 * project.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.	 See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 * MA 02111-1307 USA
 */

/* #define DEBUG */

#include <common.h>
#include <command.h>
#include <environment.h>
#include <linux/stddef.h>
#include <malloc.h>
#include <nand.h>
#include <asm/errno.h>

#if defined(CONFIG_CMD_SAVEENV) && defined(CONFIG_CMD_NAND)
#define CMD_SAVEENV
#elif defined(CONFIG_ENV_OFFSET_REDUND)
#error Cannot use CONFIG_ENV_OFFSET_REDUND without CONFIG_CMD_SAVEENV & CONFIG_CMD_NAND
#endif

#if defined(CONFIG_ENV_SIZE_REDUND) && (CONFIG_ENV_SIZE_REDUND != CONFIG_ENV_SIZE)
#error CONFIG_ENV_SIZE_REDUND should be the same as CONFIG_ENV_SIZE
#endif

#ifndef CONFIG_ENV_RANGE
#define CONFIG_ENV_RANGE	CONFIG_ENV_SIZE
#endif

/* references to names in env_common.c */
extern uchar default_environment[];

char * env_name_spec = "NAND";


#if defined(ENV_IS_EMBEDDED)
extern uchar environment[];
env_t *env_ptr = (env_t *)(&environment[0]);
#elif defined(CONFIG_NAND_ENV_DST)
env_t *env_ptr = (env_t *)CONFIG_NAND_ENV_DST;
#else /* ! ENV_IS_EMBEDDED */
env_t *env_ptr = 0;
#endif /* ENV_IS_EMBEDDED */


/* local functions */
#if !defined(ENV_IS_EMBEDDED)
static void use_default(void);
#endif

DECLARE_GLOBAL_DATA_PTR;

uchar env_get_char_spec (int index)
{
	return ( *((uchar *)(gd->env_addr + index)) );
}


/* this is called before nand_init()
 * so we can't read Nand to validate env data.
 * Mark it OK for now. env_relocate() in env_common.c
 * will call our relocate function which does the real
 * validation.
 *
 * When using a NAND boot image (like sequoia_nand), the environment
 * can be embedded or attached to the U-Boot image in NAND flash. This way
 * the SPL loads not only the U-Boot image from NAND but also the
 * environment.
 */
int env_init(void)
{
#if defined(ENV_IS_EMBEDDED) || defined(CONFIG_NAND_ENV_DST)
	int crc1_ok = 0, crc2_ok = 0;
	env_t *tmp_env1;

#ifdef CONFIG_ENV_OFFSET_REDUND
	env_t *tmp_env2;

	tmp_env2 = (env_t *)((ulong)env_ptr + CONFIG_ENV_SIZE);
	crc2_ok = (crc32(0, tmp_env2->data, ENV_SIZE) == tmp_env2->crc);
#endif

	tmp_env1 = env_ptr;

	crc1_ok = (crc32(0, tmp_env1->data, ENV_SIZE) == tmp_env1->crc);

	if (!crc1_ok && !crc2_ok) {
		gd->env_addr  = 0;
		gd->env_valid = 0;

		return 0;
	} else if (crc1_ok && !crc2_ok) {
		gd->env_valid = 1;
	}
#ifdef CONFIG_ENV_OFFSET_REDUND
	else if (!crc1_ok && crc2_ok) {
		gd->env_valid = 2;
	} else {
		/* both ok - check serial */
		if(tmp_env1->flags == 255 && tmp_env2->flags == 0)
			gd->env_valid = 2;
		else if(tmp_env2->flags == 255 && tmp_env1->flags == 0)
			gd->env_valid = 1;
		else if(tmp_env1->flags > tmp_env2->flags)
			gd->env_valid = 1;
		else if(tmp_env2->flags > tmp_env1->flags)
			gd->env_valid = 2;
		else /* flags are equal - almost impossible */
			gd->env_valid = 1;
	}

	if (gd->env_valid == 2)
		env_ptr = tmp_env2;
	else
#endif
	if (gd->env_valid == 1)
		env_ptr = tmp_env1;

	gd->env_addr = (ulong)env_ptr->data;

#else /* ENV_IS_EMBEDDED || CONFIG_NAND_ENV_DST */
	gd->env_addr  = (ulong)&default_environment[0];
	gd->env_valid = 1;
#endif /* ENV_IS_EMBEDDED || CONFIG_NAND_ENV_DST */

	return (0);
}

#ifdef CMD_SAVEENV
/*
 * The legacy NAND code saved the environment in the first NAND device i.e.,
 * nand_dev_desc + 0. This is also the behaviour using the new NAND code.
 */
int writeenv(size_t offset, u_char *buf)
{
	size_t end = offset + CONFIG_ENV_RANGE;
	size_t amount_saved = 0;
	size_t blocksize, len;

	u_char *char_ptr;

	blocksize = nand_info[0].erasesize;
	len = min(blocksize, CONFIG_ENV_SIZE);

	while (amount_saved < CONFIG_ENV_SIZE && offset < end) {
		if (nand_block_isbad(&nand_info[0], offset)) {
			offset += blocksize;
		} else {
			char_ptr = &buf[amount_saved];
			if (nand_write(&nand_info[0], offset, &len,
					char_ptr))
				return 1;
			offset += blocksize;
			amount_saved += len;
		}
	}
	if (amount_saved != CONFIG_ENV_SIZE)
		return 1;

	return 0;
}
#ifdef CONFIG_ENV_OFFSET_REDUND
int saveenv(void)
{
	int ret = 0;
	nand_erase_options_t nand_erase_options;

	env_ptr->flags++;

	nand_erase_options.length = CONFIG_ENV_RANGE;
	nand_erase_options.quiet = 0;
	nand_erase_options.jffs2 = 0;
	nand_erase_options.scrub = 0;

	if (CONFIG_ENV_RANGE < CONFIG_ENV_SIZE)
		return 1;
	if(gd->env_valid == 1) {
		puts ("Erasing redundant Nand...\n");
		nand_erase_options.offset = CONFIG_ENV_OFFSET_REDUND;
		if (nand_erase_opts(&nand_info[0], &nand_erase_options))
			return 1;

		puts ("Writing to redundant Nand... ");
		ret = writeenv(CONFIG_ENV_OFFSET_REDUND, (u_char *) env_ptr);
	} else {
		puts ("Erasing Nand...\n");
		nand_erase_options.offset = CONFIG_ENV_OFFSET;
		if (nand_erase_opts(&nand_info[0], &nand_erase_options))
			return 1;

		puts ("Writing to Nand... ");
		ret = writeenv(CONFIG_ENV_OFFSET, (u_char *) env_ptr);
	}
	if (ret) {
		puts("FAILED!\n");
		return 1;
	}

	puts ("done\n");
	gd->env_valid = (gd->env_valid == 2 ? 1 : 2);
	return ret;
}
#else /* ! CONFIG_ENV_OFFSET_REDUND */
int saveenv(void)
{
	int ret = 0;
	nand_erase_options_t nand_erase_options;

	nand_erase_options.length = CONFIG_ENV_RANGE;
	nand_erase_options.quiet = 0;
	nand_erase_options.jffs2 = 0;
	nand_erase_options.scrub = 0;
	nand_erase_options.offset = CONFIG_ENV_OFFSET;

	if (CONFIG_ENV_RANGE < CONFIG_ENV_SIZE)
		return 1;
	puts ("Erasing Nand...\n");
	if (nand_erase_opts(&nand_info[0], &nand_erase_options))
		return 1;

	puts ("Writing to Nand... ");
	if (writeenv(CONFIG_ENV_OFFSET, (u_char *) env_ptr)) {
		puts("FAILED!\n");
		return 1;
	}

	puts ("done\n");
	return ret;
}
#endif /* CONFIG_ENV_OFFSET_REDUND */
#endif /* CMD_SAVEENV */

int readenv (size_t offset, u_char * buf)
{
	size_t end = offset + CONFIG_ENV_RANGE;
	size_t amount_loaded = 0;
	size_t blocksize, len;

	u_char *char_ptr;

	blocksize = nand_info[0].erasesize;
	if (!blocksize)
		return 1;
	len = min(blocksize, CONFIG_ENV_SIZE);

	while (amount_loaded < CONFIG_ENV_SIZE && offset < end) {
		if (nand_block_isbad(&nand_info[0], offset)) {
			offset += blocksize;
		} else {
			char_ptr = &buf[amount_loaded];
			if (nand_read(&nand_info[0], offset, &len, char_ptr))
				return 1;
			offset += blocksize;
			amount_loaded += len;
		}
	}
	if (amount_loaded != CONFIG_ENV_SIZE)
		return 1;

	return 0;
}

#ifdef CONFIG_ENV_OFFSET_OOB
int get_nand_env_oob(nand_info_t *nand, unsigned long *result)
{
	struct mtd_oob_ops ops;
	uint32_t oob_buf[ENV_OFFSET_SIZE/sizeof(uint32_t)];
	int ret;

	ops.datbuf = NULL;
	ops.mode = MTD_OOB_AUTO;
	ops.ooboffs = 0;
	ops.ooblen = ENV_OFFSET_SIZE;
	ops.oobbuf = (void *) oob_buf;

	ret = nand->read_oob(nand, ENV_OFFSET_SIZE, &ops);
	if (ret) {
		printf("error reading OOB block 0\n");
		return ret;
	}

	if (oob_buf[0] == ENV_OOB_MARKER) {
		*result = oob_buf[1] * nand->erasesize;
	} else if (oob_buf[0] == ENV_OOB_MARKER_OLD) {
		*result = oob_buf[1];
	} else {
		printf("No dynamic environment marker in OOB block 0\n");
		return -ENOENT;
	}

	return 0;
}
#endif

#ifdef CONFIG_ENV_OFFSET_REDUND
void env_relocate_spec (void)
{
#if !defined(ENV_IS_EMBEDDED)
	int crc1_ok = 0, crc2_ok = 0;
	env_t *tmp_env1, *tmp_env2;

	tmp_env1 = (env_t *) malloc(CONFIG_ENV_SIZE);
	tmp_env2 = (env_t *) malloc(CONFIG_ENV_SIZE);

	if ((tmp_env1 == NULL) || (tmp_env2 == NULL)) {
		puts("Can't allocate buffers for environment\n");
		free (tmp_env1);
		free (tmp_env2);
		return use_default();
	}

	if (readenv(CONFIG_ENV_OFFSET, (u_char *) tmp_env1))
		puts("No Valid Environment Area Found\n");
	if (readenv(CONFIG_ENV_OFFSET_REDUND, (u_char *) tmp_env2))
		puts("No Valid Reundant Environment Area Found\n");

	crc1_ok = (crc32(0, tmp_env1->data, ENV_SIZE) == tmp_env1->crc);
	crc2_ok = (crc32(0, tmp_env2->data, ENV_SIZE) == tmp_env2->crc);

	if(!crc1_ok && !crc2_ok) {
		free(tmp_env1);
		free(tmp_env2);
		return use_default();
	} else if(crc1_ok && !crc2_ok)
		gd->env_valid = 1;
	else if(!crc1_ok && crc2_ok)
		gd->env_valid = 2;
	else {
		/* both ok - check serial */
		if(tmp_env1->flags == 255 && tmp_env2->flags == 0)
			gd->env_valid = 2;
		else if(tmp_env2->flags == 255 && tmp_env1->flags == 0)
			gd->env_valid = 1;
		else if(tmp_env1->flags > tmp_env2->flags)
			gd->env_valid = 1;
		else if(tmp_env2->flags > tmp_env1->flags)
			gd->env_valid = 2;
		else /* flags are equal - almost impossible */
			gd->env_valid = 1;

	}

	free(env_ptr);
	if(gd->env_valid == 1) {
		env_ptr = tmp_env1;
		free(tmp_env2);
	} else {
		env_ptr = tmp_env2;
		free(tmp_env1);
	}

#endif /* ! ENV_IS_EMBEDDED */
}
#else /* ! CONFIG_ENV_OFFSET_REDUND */
/*
 * The legacy NAND code saved the environment in the first NAND device i.e.,
 * nand_dev_desc + 0. This is also the behaviour using the new NAND code.
 */
void env_relocate_spec (void)
{
#if !defined(ENV_IS_EMBEDDED)
	int ret;

#if defined(CONFIG_ENV_OFFSET_OOB)
	ret = get_nand_env_oob(&nand_info[0], &nand_env_oob_offset);
	/* If unable to read environment offset from NAND OOB then fall through
	 * to the normal environment reading code below
	 */
	if (!ret)
		printf("Found Environment offset in OOB..\n");
	else
		return use_default();
#endif

	ret = readenv(CONFIG_ENV_OFFSET, (u_char *) env_ptr);
	if (ret)
		return use_default();

	if (crc32(0, env_ptr->data, ENV_SIZE) != env_ptr->crc)
		return use_default();
#endif /* ! ENV_IS_EMBEDDED */
}
#endif /* CONFIG_ENV_OFFSET_REDUND */

#if !defined(ENV_IS_EMBEDDED)
static void use_default()
{
	puts ("*** Warning - bad CRC or NAND, using default environment\n\n");
	set_default_env();
}
#endif
Commit	Line	Data
13a5695b	1	/*
cc49cade SW	2	* (C) Copyright 2008
	3	* Stuart Wood, Lab X Technologies <stuart.wood@labxtechnologies.com>
	4	*
13a5695b WD	5	* (C) Copyright 2004
	6	* Jian Zhang, Texas Instruments, jzhang@ti.com.
	7
d12ae808	8	* (C) Copyright 2000-2006
13a5695b WD	9	* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
	10	*
	11	* (C) Copyright 2001 Sysgo Real-Time Solutions, GmbH <www.elinos.com>
	12	* Andreas Heppel <aheppel@sysgo.de>
	13
	14	* See file CREDITS for list of people who contributed to this
	15	* project.
	16	*
	17	* This program is free software; you can redistribute it and/or
	18	* modify it under the terms of the GNU General Public License as
	19	* published by the Free Software Foundation; either version 2 of
	20	* the License, or (at your option) any later version.
	21	*
	22	* This program is distributed in the hope that it will be useful,
	23	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	24	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	25	* GNU General Public License for more details.
	26	*
	27	* You should have received a copy of the GNU General Public License
	28	* along with this program; if not, write to the Free Software
	29	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	30	* MA 02111-1307 USA
	31	*/
	32
	33	/* #define DEBUG */
	34
	35	#include <common.h>
13a5695b WD	36	#include <command.h>
	37	#include <environment.h>
	38	#include <linux/stddef.h>
e443c944	39	#include <malloc.h>
addb2e16	40	#include <nand.h>
c9f7351b	41	#include <asm/errno.h>
13a5695b	42
bdab39d3	43	#if defined(CONFIG_CMD_SAVEENV) && defined(CONFIG_CMD_NAND)
13a5695b	44	#define CMD_SAVEENV
0e8d1586	45	#elif defined(CONFIG_ENV_OFFSET_REDUND)
bdab39d3	46	#error Cannot use CONFIG_ENV_OFFSET_REDUND without CONFIG_CMD_SAVEENV & CONFIG_CMD_NAND
13a5695b WD	47	#endif
13a5695b WD	48
0e8d1586 JCPV	49	#if defined(CONFIG_ENV_SIZE_REDUND) && (CONFIG_ENV_SIZE_REDUND != CONFIG_ENV_SIZE)
0e8d1586 JCPV	50	#error CONFIG_ENV_SIZE_REDUND should be the same as CONFIG_ENV_SIZE
13a5695b WD	51	#endif
13a5695b WD	52
0e8d1586 JCPV	53	#ifndef CONFIG_ENV_RANGE
0e8d1586 JCPV	54	#define CONFIG_ENV_RANGE CONFIG_ENV_SIZE
cc49cade SW	55	#endif
cc49cade SW	56
13a5695b WD	57	/* references to names in env_common.c */
13a5695b WD	58	extern uchar default_environment[];
13a5695b WD	59
	60	char * env_name_spec = "NAND";
	61
	62
b74ab737	63	#if defined(ENV_IS_EMBEDDED)
13a5695b WD	64	extern uchar environment[];
13a5695b WD	65	env_t env_ptr = (env_t )(&environment[0]);
b74ab737 GL	66	#elif defined(CONFIG_NAND_ENV_DST)
b74ab737 GL	67	env_t env_ptr = (env_t )CONFIG_NAND_ENV_DST;
13a5695b	68	#else /* ! ENV_IS_EMBEDDED */
49822e23	69	env_t *env_ptr = 0;
13a5695b WD	70	#endif /* ENV_IS_EMBEDDED */
	71
	72
	73	/* local functions */
d12ae808	74	#if !defined(ENV_IS_EMBEDDED)
13a5695b	75	static void use_default(void);
d12ae808	76	#endif
13a5695b	77
d87080b7	78	DECLARE_GLOBAL_DATA_PTR;
13a5695b WD	79
	80	uchar env_get_char_spec (int index)
	81	{
13a5695b WD	82	return ( ((uchar )(gd->env_addr + index)) );
	83	}
	84
	85
	86	/* this is called before nand_init()
	87	* so we can't read Nand to validate env data.
	88	* Mark it OK for now. env_relocate() in env_common.c
99c2b434 MZ	89	* will call our relocate function which does the real
99c2b434 MZ	90	* validation.
d12ae808 SR	91	*
	92	* When using a NAND boot image (like sequoia_nand), the environment
	93	* can be embedded or attached to the U-Boot image in NAND flash. This way
	94	* the SPL loads not only the U-Boot image from NAND but also the
	95	* environment.
13a5695b WD	96	*/
	97	int env_init(void)
	98	{
b74ab737	99	#if defined(ENV_IS_EMBEDDED) \|\| defined(CONFIG_NAND_ENV_DST)
d12ae808	100	int crc1_ok = 0, crc2_ok = 0;
b74ab737 GL	101	env_t *tmp_env1;
	102
	103	#ifdef CONFIG_ENV_OFFSET_REDUND
	104	env_t *tmp_env2;
d12ae808	105
0e8d1586	106	tmp_env2 = (env_t *)((ulong)env_ptr + CONFIG_ENV_SIZE);
b74ab737 GL	107	crc2_ok = (crc32(0, tmp_env2->data, ENV_SIZE) == tmp_env2->crc);
	108	#endif
	109
	110	tmp_env1 = env_ptr;
d12ae808 SR	111
d12ae808 SR	112	crc1_ok = (crc32(0, tmp_env1->data, ENV_SIZE) == tmp_env1->crc);
d12ae808	113
b74ab737 GL	114	if (!crc1_ok && !crc2_ok) {
b74ab737 GL	115	gd->env_addr = 0;
d12ae808	116	gd->env_valid = 0;
b74ab737 GL	117
	118	return 0;
	119	} else if (crc1_ok && !crc2_ok) {
d12ae808	120	gd->env_valid = 1;
b74ab737 GL	121	}
	122	#ifdef CONFIG_ENV_OFFSET_REDUND
	123	else if (!crc1_ok && crc2_ok) {
d12ae808	124	gd->env_valid = 2;
b74ab737	125	} else {
d12ae808 SR	126	/* both ok - check serial */
	127	if(tmp_env1->flags == 255 && tmp_env2->flags == 0)
	128	gd->env_valid = 2;
	129	else if(tmp_env2->flags == 255 && tmp_env1->flags == 0)
	130	gd->env_valid = 1;
	131	else if(tmp_env1->flags > tmp_env2->flags)
	132	gd->env_valid = 1;
	133	else if(tmp_env2->flags > tmp_env1->flags)
	134	gd->env_valid = 2;
	135	else /* flags are equal - almost impossible */
	136	gd->env_valid = 1;
	137	}
	138
b74ab737 GL	139	if (gd->env_valid == 2)
	140	env_ptr = tmp_env2;
	141	else
	142	#endif
d12ae808 SR	143	if (gd->env_valid == 1)
d12ae808 SR	144	env_ptr = tmp_env1;
b74ab737 GL	145
	146	gd->env_addr = (ulong)env_ptr->data;
	147
	148	#else /* ENV_IS_EMBEDDED \|\| CONFIG_NAND_ENV_DST */
e443c944	149	gd->env_addr = (ulong)&default_environment[0];
13a5695b	150	gd->env_valid = 1;
b74ab737	151	#endif /* ENV_IS_EMBEDDED \|\| CONFIG_NAND_ENV_DST */
13a5695b WD	152
	153	return (0);
	154	}
	155
	156	#ifdef CMD_SAVEENV
addb2e16 BS	157	/*
	158	* The legacy NAND code saved the environment in the first NAND device i.e.,
	159	* nand_dev_desc + 0. This is also the behaviour using the new NAND code.
	160	*/
cc49cade SW	161	int writeenv(size_t offset, u_char *buf)
cc49cade SW	162	{
0e8d1586	163	size_t end = offset + CONFIG_ENV_RANGE;
cc49cade	164	size_t amount_saved = 0;
c3db8c64	165	size_t blocksize, len;
cc49cade SW	166
	167	u_char *char_ptr;
	168
	169	blocksize = nand_info[0].erasesize;
0e8d1586	170	len = min(blocksize, CONFIG_ENV_SIZE);
cc49cade	171
0e8d1586	172	while (amount_saved < CONFIG_ENV_SIZE && offset < end) {
cc49cade SW	173	if (nand_block_isbad(&nand_info[0], offset)) {
	174	offset += blocksize;
	175	} else {
	176	char_ptr = &buf[amount_saved];
c3db8c64	177	if (nand_write(&nand_info[0], offset, &len,
cc49cade SW	178	char_ptr))
	179	return 1;
	180	offset += blocksize;
c3db8c64	181	amount_saved += len;
cc49cade SW	182	}
cc49cade SW	183	}
0e8d1586	184	if (amount_saved != CONFIG_ENV_SIZE)
cc49cade SW	185	return 1;
	186
	187	return 0;
	188	}
0e8d1586	189	#ifdef CONFIG_ENV_OFFSET_REDUND
13a5695b WD	190	int saveenv(void)
13a5695b WD	191	{
2770bcb2	192	int ret = 0;
cc49cade	193	nand_erase_options_t nand_erase_options;
e443c944	194
e443c944	195	env_ptr->flags++;
e443c944	196
0e8d1586	197	nand_erase_options.length = CONFIG_ENV_RANGE;
cc49cade SW	198	nand_erase_options.quiet = 0;
	199	nand_erase_options.jffs2 = 0;
	200	nand_erase_options.scrub = 0;
	201
0e8d1586	202	if (CONFIG_ENV_RANGE < CONFIG_ENV_SIZE)
cc49cade	203	return 1;
e443c944	204	if(gd->env_valid == 1) {
cc49cade	205	puts ("Erasing redundant Nand...\n");
0e8d1586	206	nand_erase_options.offset = CONFIG_ENV_OFFSET_REDUND;
cc49cade	207	if (nand_erase_opts(&nand_info[0], &nand_erase_options))
e443c944	208	return 1;
cc49cade	209
e443c944	210	puts ("Writing to redundant Nand... ");
0e8d1586	211	ret = writeenv(CONFIG_ENV_OFFSET_REDUND, (u_char *) env_ptr);
e443c944	212	} else {
cc49cade	213	puts ("Erasing Nand...\n");
0e8d1586	214	nand_erase_options.offset = CONFIG_ENV_OFFSET;
cc49cade	215	if (nand_erase_opts(&nand_info[0], &nand_erase_options))
e443c944 MK	216	return 1;
	217
	218	puts ("Writing to Nand... ");
0e8d1586	219	ret = writeenv(CONFIG_ENV_OFFSET, (u_char *) env_ptr);
e443c944	220	}
cc49cade SW	221	if (ret) {
cc49cade SW	222	puts("FAILED!\n");
e443c944	223	return 1;
cc49cade	224	}
e443c944 MK	225
	226	puts ("done\n");
	227	gd->env_valid = (gd->env_valid == 2 ? 1 : 2);
	228	return ret;
	229	}
0e8d1586	230	#else /* ! CONFIG_ENV_OFFSET_REDUND */
e443c944 MK	231	int saveenv(void)
e443c944 MK	232	{
d52fb7e3	233	int ret = 0;
9e4006bc	234	nand_erase_options_t nand_erase_options;
e093a247	235
0e8d1586	236	nand_erase_options.length = CONFIG_ENV_RANGE;
cc49cade SW	237	nand_erase_options.quiet = 0;
	238	nand_erase_options.jffs2 = 0;
	239	nand_erase_options.scrub = 0;
0e8d1586	240	nand_erase_options.offset = CONFIG_ENV_OFFSET;
cc49cade	241
0e8d1586	242	if (CONFIG_ENV_RANGE < CONFIG_ENV_SIZE)
cc49cade SW	243	return 1;
	244	puts ("Erasing Nand...\n");
	245	if (nand_erase_opts(&nand_info[0], &nand_erase_options))
addb2e16	246	return 1;
13a5695b WD	247
13a5695b WD	248	puts ("Writing to Nand... ");
0e8d1586	249	if (writeenv(CONFIG_ENV_OFFSET, (u_char *) env_ptr)) {
cc49cade	250	puts("FAILED!\n");
13a5695b	251	return 1;
cc49cade	252	}
13a5695b	253
addb2e16 BS	254	puts ("done\n");
addb2e16 BS	255	return ret;
13a5695b	256	}
0e8d1586	257	#endif /* CONFIG_ENV_OFFSET_REDUND */
13a5695b WD	258	#endif /* CMD_SAVEENV */
13a5695b WD	259
cc49cade SW	260	int readenv (size_t offset, u_char * buf)
cc49cade SW	261	{
0e8d1586	262	size_t end = offset + CONFIG_ENV_RANGE;
cc49cade	263	size_t amount_loaded = 0;
c3db8c64	264	size_t blocksize, len;
cc49cade SW	265
	266	u_char *char_ptr;
	267
	268	blocksize = nand_info[0].erasesize;
962ad59e MF	269	if (!blocksize)
962ad59e MF	270	return 1;
0e8d1586	271	len = min(blocksize, CONFIG_ENV_SIZE);
cc49cade	272
0e8d1586	273	while (amount_loaded < CONFIG_ENV_SIZE && offset < end) {
cc49cade SW	274	if (nand_block_isbad(&nand_info[0], offset)) {
	275	offset += blocksize;
	276	} else {
	277	char_ptr = &buf[amount_loaded];
c3db8c64	278	if (nand_read(&nand_info[0], offset, &len, char_ptr))
cc49cade SW	279	return 1;
cc49cade SW	280	offset += blocksize;
c3db8c64	281	amount_loaded += len;
cc49cade SW	282	}
cc49cade SW	283	}
0e8d1586	284	if (amount_loaded != CONFIG_ENV_SIZE)
cc49cade SW	285	return 1;
	286
	287	return 0;
	288	}
	289
c9f7351b BG	290	#ifdef CONFIG_ENV_OFFSET_OOB
	291	int get_nand_env_oob(nand_info_t nand, unsigned long result)
	292	{
	293	struct mtd_oob_ops ops;
	294	uint32_t oob_buf[ENV_OFFSET_SIZE/sizeof(uint32_t)];
	295	int ret;
	296
	297	ops.datbuf = NULL;
	298	ops.mode = MTD_OOB_AUTO;
	299	ops.ooboffs = 0;
	300	ops.ooblen = ENV_OFFSET_SIZE;
	301	ops.oobbuf = (void *) oob_buf;
	302
	303	ret = nand->read_oob(nand, ENV_OFFSET_SIZE, &ops);
53504a27 SW	304	if (ret) {
	305	printf("error reading OOB block 0\n");
	306	return ret;
	307	}
c9f7351b	308
53504a27 SW	309	if (oob_buf[0] == ENV_OOB_MARKER) {
	310	result = oob_buf[1] nand->erasesize;
	311	} else if (oob_buf[0] == ENV_OOB_MARKER_OLD) {
	312	*result = oob_buf[1];
c9f7351b	313	} else {
53504a27 SW	314	printf("No dynamic environment marker in OOB block 0\n");
53504a27 SW	315	return -ENOENT;
c9f7351b	316	}
53504a27 SW	317
53504a27 SW	318	return 0;
c9f7351b BG	319	}
	320	#endif
	321
0e8d1586	322	#ifdef CONFIG_ENV_OFFSET_REDUND
e443c944 MK	323	void env_relocate_spec (void)
	324	{
	325	#if !defined(ENV_IS_EMBEDDED)
2770bcb2	326	int crc1_ok = 0, crc2_ok = 0;
e443c944 MK	327	env_t tmp_env1, tmp_env2;
e443c944 MK	328
0e8d1586 JCPV	329	tmp_env1 = (env_t *) malloc(CONFIG_ENV_SIZE);
0e8d1586 JCPV	330	tmp_env2 = (env_t *) malloc(CONFIG_ENV_SIZE);
e443c944	331
15b86c3d WD	332	if ((tmp_env1 == NULL) \|\| (tmp_env2 == NULL)) {
	333	puts("Can't allocate buffers for environment\n");
	334	free (tmp_env1);
	335	free (tmp_env2);
	336	return use_default();
	337	}
	338
0e8d1586	339	if (readenv(CONFIG_ENV_OFFSET, (u_char *) tmp_env1))
cc49cade	340	puts("No Valid Environment Area Found\n");
0e8d1586	341	if (readenv(CONFIG_ENV_OFFSET_REDUND, (u_char *) tmp_env2))
cc49cade	342	puts("No Valid Reundant Environment Area Found\n");
e443c944 MK	343
	344	crc1_ok = (crc32(0, tmp_env1->data, ENV_SIZE) == tmp_env1->crc);
	345	crc2_ok = (crc32(0, tmp_env2->data, ENV_SIZE) == tmp_env2->crc);
	346
5a9427dc	347	if(!crc1_ok && !crc2_ok) {
	348	free(tmp_env1);
	349	free(tmp_env2);
e443c944	350	return use_default();
5a9427dc	351	} else if(crc1_ok && !crc2_ok)
e443c944 MK	352	gd->env_valid = 1;
	353	else if(!crc1_ok && crc2_ok)
	354	gd->env_valid = 2;
	355	else {
	356	/* both ok - check serial */
	357	if(tmp_env1->flags == 255 && tmp_env2->flags == 0)
	358	gd->env_valid = 2;
	359	else if(tmp_env2->flags == 255 && tmp_env1->flags == 0)
	360	gd->env_valid = 1;
	361	else if(tmp_env1->flags > tmp_env2->flags)
	362	gd->env_valid = 1;
	363	else if(tmp_env2->flags > tmp_env1->flags)
	364	gd->env_valid = 2;
	365	else /* flags are equal - almost impossible */
	366	gd->env_valid = 1;
13a5695b	367
e443c944 MK	368	}
	369
	370	free(env_ptr);
	371	if(gd->env_valid == 1) {
	372	env_ptr = tmp_env1;
	373	free(tmp_env2);
	374	} else {
	375	env_ptr = tmp_env2;
	376	free(tmp_env1);
	377	}
	378
	379	#endif /* ! ENV_IS_EMBEDDED */
	380	}
0e8d1586	381	#else /* ! CONFIG_ENV_OFFSET_REDUND */
addb2e16 BS	382	/*
	383	* The legacy NAND code saved the environment in the first NAND device i.e.,
	384	* nand_dev_desc + 0. This is also the behaviour using the new NAND code.
	385	*/
13a5695b WD	386	void env_relocate_spec (void)
	387	{
	388	#if !defined(ENV_IS_EMBEDDED)
d52fb7e3	389	int ret;
13a5695b	390
c9f7351b BG	391	#if defined(CONFIG_ENV_OFFSET_OOB)
	392	ret = get_nand_env_oob(&nand_info[0], &nand_env_oob_offset);
	393	/* If unable to read environment offset from NAND OOB then fall through
	394	* to the normal environment reading code below
	395	*/
	396	if (!ret)
	397	printf("Found Environment offset in OOB..\n");
	398	else
	399	return use_default();
	400	#endif
	401
0e8d1586	402	ret = readenv(CONFIG_ENV_OFFSET, (u_char *) env_ptr);
c3db8c64	403	if (ret)
13a5695b WD	404	return use_default();
	405
	406	if (crc32(0, env_ptr->data, ENV_SIZE) != env_ptr->crc)
	407	return use_default();
	408	#endif /* ! ENV_IS_EMBEDDED */
13a5695b	409	}
0e8d1586	410	#endif /* CONFIG_ENV_OFFSET_REDUND */
13a5695b	411
d12ae808	412	#if !defined(ENV_IS_EMBEDDED)
13a5695b WD	413	static void use_default()
13a5695b WD	414	{
13a5695b	415	puts ("*** Warning - bad CRC or NAND, using default environment\n\n");
5bb12dbd	416	set_default_env();
13a5695b	417	}
d12ae808	418	#endif