[J-u-boot.git] / common / env_flash.c

/*
 * (C) Copyright 2000-2002
 * Wolfgang Denk, DENX Software Engineering, [email protected].
 *
 * (C) Copyright 2001 Sysgo Real-Time Solutions, GmbH <www.elinos.com>
 * Andreas Heppel <[email protected]>

 * 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>

#if defined(CFG_ENV_IS_IN_FLASH) /* Environment is in Flash */

#include <command.h>
#include <environment.h>
#include <cmd_nvedit.h>
#include <linux/stddef.h>
#include <malloc.h>

#if ((CONFIG_COMMANDS&(CFG_CMD_ENV|CFG_CMD_FLASH)) == (CFG_CMD_ENV|CFG_CMD_FLASH))
#define CMD_SAVEENV
#elif defined(CFG_ENV_ADDR_REDUND)
#error Cannot use CFG_ENV_ADDR_REDUND without CFG_CMD_ENV & CFG_CMD_FLASH
#endif

#if defined(CFG_ENV_SIZE_REDUND) && (CFG_ENV_SIZE_REDUND < CFG_ENV_SIZE)
#error CFG_ENV_SIZE_REDUND should not be less then CFG_ENV_SIZE
#endif

#ifdef CONFIG_INFERNO
# ifdef CFG_ENV_ADDR_REDUND
#error CFG_ENV_ADDR_REDUND is not implemented for CONFIG_INFERNO
# endif
#endif

char * env_name_spec = "Flash";

#ifdef ENV_IS_EMBEDDED

extern uchar environment[];
env_t *env_ptr = (env_t *)(&environment[0]);

#ifdef CMD_SAVEENV
/* static env_t *flash_addr = (env_t *)(&environment[0]);-broken on ARM-wd-*/
static env_t *flash_addr = (env_t *)CFG_ENV_ADDR;
#endif

#else /* ! ENV_IS_EMBEDDED */

env_t *env_ptr = (env_t *)CFG_ENV_ADDR;
#ifdef CMD_SAVEENV
static env_t *flash_addr = (env_t *)CFG_ENV_ADDR;
#endif

#endif /* ENV_IS_EMBEDDED */

#ifdef CFG_ENV_ADDR_REDUND
static env_t *flash_addr_new = (env_t *)CFG_ENV_ADDR_REDUND;

/* CFG_ENV_ADDR is supposed to be on sector boundary */
static ulong end_addr = CFG_ENV_ADDR + CFG_ENV_SECT_SIZE - 1;
static ulong end_addr_new = CFG_ENV_ADDR_REDUND + CFG_ENV_SECT_SIZE - 1;

static uchar active_flag = 1;
static uchar obsolete_flag = 0;
#endif

extern uchar default_environment[];
extern int default_environment_size;


uchar env_get_char_spec (int index)
{
	DECLARE_GLOBAL_DATA_PTR;

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

#ifdef CFG_ENV_ADDR_REDUND

int  env_init(void)
{
	DECLARE_GLOBAL_DATA_PTR;

	int crc1_ok =
		(crc32(0, flash_addr->data, ENV_SIZE) == flash_addr->crc);
	int crc2_ok =
		(crc32(0, flash_addr_new->data, ENV_SIZE) == flash_addr_new->crc);

	uchar flag1 = flash_addr->flags;
	uchar flag2 = flash_addr_new->flags;

	ulong addr_default = (ulong)&default_environment[0];
	ulong addr1 = (ulong)&(flash_addr->data);
	ulong addr2 = (ulong)&(flash_addr_new->data);

	if (crc1_ok && ! crc2_ok)
	{
		gd->env_addr  = addr1;
		gd->env_valid = 1;
	}
	else if (! crc1_ok && crc2_ok)
	{
		gd->env_addr  = addr2;
		gd->env_valid = 1;
	}
	else if (! crc1_ok && ! crc2_ok)
	{
		gd->env_addr  = addr_default;
		gd->env_valid = 0;
	}
	else if (flag1 == active_flag && flag2 == obsolete_flag)
	{
		gd->env_addr  = addr1;
		gd->env_valid = 1;
	}
	else if (flag1 == obsolete_flag && flag2 == active_flag)
	{
		gd->env_addr  = addr2;
		gd->env_valid = 1;
	}
	else if (flag1 == flag2)
	{
		gd->env_addr  = addr1;
		gd->env_valid = 2;
	}
	else if (flag1 == 0xFF)
	{
		gd->env_addr  = addr1;
		gd->env_valid = 2;
	}
	else if (flag2 == 0xFF)
	{
		gd->env_addr  = addr2;
		gd->env_valid = 2;
	}

	return (0);
}

#ifdef CMD_SAVEENV
int saveenv(void)
{
	int rc = 1;
	ulong up_data = 0;
	char *saved_data = NULL;

	debug ("Protect off %08lX ... %08lX\n",
		(ulong)flash_addr, end_addr);

	if (flash_sect_protect (0, (ulong)flash_addr, end_addr)) {
		goto Done;
	}

	debug ("Protect off %08lX ... %08lX\n",
		(ulong)flash_addr_new, end_addr_new);

	if (flash_sect_protect (0, (ulong)flash_addr_new, end_addr_new)) {
		goto Done;
	}

#if CFG_ENV_SECT_SIZE > CFG_ENV_SIZE
	up_data = (end_addr_new + 1 - ((long)flash_addr_new + CFG_ENV_SIZE));
	debug ("Data to save 0x%x\n", up_data);
	if (up_data) {
		if ((saved_data = malloc(up_data)) == NULL) {
			printf("Unable to save the rest of sector (%ld)\n", 
				up_data);
			goto Done;
		}
		memcpy(saved_data, 
			(void *)((long)flash_addr_new + CFG_ENV_SIZE), up_data);
		debug ("Data (start 0x%x, len 0x%x) saved at 0x%x\n", 
			   (long)flash_addr_new + CFG_ENV_SIZE, 
				up_data, saved_data);
	}
#endif
	puts ("Erasing Flash...");
	debug (" %08lX ... %08lX ...",
		(ulong)flash_addr_new, end_addr_new);

	if (flash_sect_erase ((ulong)flash_addr_new, end_addr_new)) {
		goto Done;
	}

	puts ("Writing to Flash... ");
	debug (" %08lX ... %08lX ...",
		(ulong)&(flash_addr_new->data),
		sizeof(env_ptr->data)+(ulong)&(flash_addr_new->data));
	if (flash_write(env_ptr->data,
	                (ulong)&(flash_addr_new->data),
			sizeof(env_ptr->data)) ||

	    flash_write((char *)&(env_ptr->crc),
	                (ulong)&(flash_addr_new->crc),
			sizeof(env_ptr->crc)) ||

	    flash_write((char *)&obsolete_flag,
	                (ulong)&(flash_addr->flags),
			sizeof(flash_addr->flags)) ||

	    flash_write((char *)&active_flag,
	                (ulong)&(flash_addr_new->flags),
			sizeof(flash_addr_new->flags)))
	{
		flash_perror (rc);
		goto Done;
	}
	puts ("done\n");

#if CFG_ENV_SECT_SIZE > CFG_ENV_SIZE
	if (up_data) { /* restore the rest of sector */
		debug ("Restoring the rest of data to 0x%x len 0x%x\n",
			   (long)flash_addr_new + CFG_ENV_SIZE, up_data);
		if (flash_write(saved_data, 
				(long)flash_addr_new + CFG_ENV_SIZE, 
				up_data)) {
			flash_perror(rc);
			goto Done;
		}
	}
#endif
	{
		env_t * etmp = flash_addr;
		ulong ltmp = end_addr;

		flash_addr = flash_addr_new;
		flash_addr_new = etmp;

		end_addr = end_addr_new;
		end_addr_new = ltmp;
	}

	rc = 0;
Done:

	if (saved_data)
		free (saved_data);
	/* try to re-protect */
	(void) flash_sect_protect (1, (ulong)flash_addr, end_addr);
	(void) flash_sect_protect (1, (ulong)flash_addr_new, end_addr_new);

	return rc;
}
#endif /* CMD_SAVEENV */

#else /* ! CFG_ENV_ADDR_REDUND */

int  env_init(void)
{
	DECLARE_GLOBAL_DATA_PTR;

	if (crc32(0, env_ptr->data, ENV_SIZE) == env_ptr->crc) {
		gd->env_addr  = (ulong)&(env_ptr->data);
		gd->env_valid = 1;
	} else {
		gd->env_addr  = (ulong)&default_environment[0];
		gd->env_valid = 0;
	}

	return (0);
}

#ifdef CMD_SAVEENV

int saveenv(void)
{
	int	len, rc;
	ulong	end_addr;
	ulong	flash_sect_addr;
#if defined(CFG_ENV_SECT_SIZE) && (CFG_ENV_SECT_SIZE > CFG_ENV_SIZE)
	ulong	flash_offset;
	uchar	env_buffer[CFG_ENV_SECT_SIZE];
#else
	uchar *env_buffer = (char *)env_ptr;
#endif	/* CFG_ENV_SECT_SIZE */
	int rcode = 0;

#if defined(CFG_ENV_SECT_SIZE) && (CFG_ENV_SECT_SIZE > CFG_ENV_SIZE)

	flash_offset    = ((ulong)flash_addr) & (CFG_ENV_SECT_SIZE-1);
	flash_sect_addr = ((ulong)flash_addr) & ~(CFG_ENV_SECT_SIZE-1);

	debug ( "copy old content: "
		"sect_addr: %08lX  env_addr: %08lX  offset: %08lX\n",
		flash_sect_addr, (ulong)flash_addr, flash_offset);

	/* copy old contents to temporary buffer */
	memcpy (env_buffer, (void *)flash_sect_addr, CFG_ENV_SECT_SIZE);

	/* copy current environment to temporary buffer */
	memcpy ((uchar *)((unsigned long)env_buffer + flash_offset),
		env_ptr,
		CFG_ENV_SIZE);

	len	 = CFG_ENV_SECT_SIZE;
#else
	flash_sect_addr = (ulong)flash_addr;
	len	 = CFG_ENV_SIZE;
#endif	/* CFG_ENV_SECT_SIZE */

#ifndef CONFIG_INFERNO
	end_addr = flash_sect_addr + len - 1;
#else
	/* this is the last sector, and the size is hardcoded here */
	/* otherwise we will get stack problems on loading 128 KB environment */
	end_addr = flash_sect_addr + 0x20000 - 1;
#endif

	debug ("Protect off %08lX ... %08lX\n",
		(ulong)flash_sect_addr, end_addr);

	if (flash_sect_protect (0, flash_sect_addr, end_addr))
		return 1;

	puts ("Erasing Flash...");
	if (flash_sect_erase (flash_sect_addr, end_addr))
		return 1;

	puts ("Writing to Flash... ");
	rc = flash_write(env_buffer, flash_sect_addr, len);
	if (rc != 0) {
		flash_perror (rc);
		rcode = 1;
	} else {
		puts ("done\n");
	}

	/* try to re-protect */
	(void) flash_sect_protect (1, flash_sect_addr, end_addr);
	return rcode;
}

#endif /* CMD_SAVEENV */

#endif /* CFG_ENV_ADDR_REDUND */

void env_relocate_spec (void)
{
#if !defined(ENV_IS_EMBEDDED) || defined(CFG_ENV_ADDR_REDUND)
#ifdef CFG_ENV_ADDR_REDUND
	DECLARE_GLOBAL_DATA_PTR;

	if (gd->env_addr != (ulong)&(flash_addr->data))
	{
		env_t * etmp = flash_addr;
		ulong ltmp = end_addr;

		flash_addr = flash_addr_new;
		flash_addr_new = etmp;

		end_addr = end_addr_new;
		end_addr_new = ltmp;
	}

	if (flash_addr_new->flags != obsolete_flag &&
	    crc32(0, flash_addr_new->data, ENV_SIZE) ==
	    flash_addr_new->crc)
	{
		gd->env_valid = 2;
		flash_sect_protect (0, (ulong)flash_addr_new, end_addr_new);
		flash_write((char *)&obsolete_flag,
                    	    (ulong)&(flash_addr_new->flags),
	        	    sizeof(flash_addr_new->flags));
		flash_sect_protect (1, (ulong)flash_addr_new, end_addr_new);
	}

	if (flash_addr->flags != active_flag &&
	    (flash_addr->flags & active_flag) == active_flag)
	{
		gd->env_valid = 2;
		flash_sect_protect (0, (ulong)flash_addr, end_addr);
		flash_write((char *)&active_flag,
                    	    (ulong)&(flash_addr->flags),
	        	    sizeof(flash_addr->flags));
		flash_sect_protect (1, (ulong)flash_addr, end_addr);
	}

	if (gd->env_valid == 2)
		puts ("*** Warning - some problems detected "
		      "reading environment; recovered successfully\n\n");
#endif /* CFG_ENV_ADDR_REDUND */
	memcpy (env_ptr, (void*)flash_addr, CFG_ENV_SIZE);
#endif /* ! ENV_IS_EMBEDDED || CFG_ENV_ADDR_REDUND */
}

#endif /* CFG_ENV_IS_IN_FLASH */
Commit	Line	Data
c609719b WD	1	/*
	2	* (C) Copyright 2000-2002
	3	* Wolfgang Denk, DENX Software Engineering, [email protected].
	4	*
	5	* (C) Copyright 2001 Sysgo Real-Time Solutions, GmbH <www.elinos.com>
	6	* Andreas Heppel <[email protected]>
	7
	8	* See file CREDITS for list of people who contributed to this
	9	* project.
	10	*
	11	* This program is free software; you can redistribute it and/or
	12	* modify it under the terms of the GNU General Public License as
	13	* published by the Free Software Foundation; either version 2 of
	14	* the License, or (at your option) any later version.
	15	*
	16	* This program is distributed in the hope that it will be useful,
	17	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	18	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	19	* GNU General Public License for more details.
	20	*
	21	* You should have received a copy of the GNU General Public License
	22	* along with this program; if not, write to the Free Software
	23	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	24	* MA 02111-1307 USA
	25	*/
	26
	27	/* #define DEBUG */
	28
	29	#include <common.h>
	30
	31	#if defined(CFG_ENV_IS_IN_FLASH) /* Environment is in Flash */
	32
	33	#include <command.h>
	34	#include <environment.h>
	35	#include <cmd_nvedit.h>
	36	#include <linux/stddef.h>
47cd00fa	37	#include <malloc.h>
c609719b WD	38
	39	#if ((CONFIG_COMMANDS&(CFG_CMD_ENV\|CFG_CMD_FLASH)) == (CFG_CMD_ENV\|CFG_CMD_FLASH))
	40	#define CMD_SAVEENV
	41	#elif defined(CFG_ENV_ADDR_REDUND)
	42	#error Cannot use CFG_ENV_ADDR_REDUND without CFG_CMD_ENV & CFG_CMD_FLASH
	43	#endif
	44
c609719b WD	45	#if defined(CFG_ENV_SIZE_REDUND) && (CFG_ENV_SIZE_REDUND < CFG_ENV_SIZE)
	46	#error CFG_ENV_SIZE_REDUND should not be less then CFG_ENV_SIZE
	47	#endif
	48
	49	#ifdef CONFIG_INFERNO
	50	# ifdef CFG_ENV_ADDR_REDUND
	51	#error CFG_ENV_ADDR_REDUND is not implemented for CONFIG_INFERNO
	52	# endif
	53	#endif
	54
	55	char * env_name_spec = "Flash";
	56
	57	#ifdef ENV_IS_EMBEDDED
	58
	59	extern uchar environment[];
	60	env_t env_ptr = (env_t )(&environment[0]);
	61
	62	#ifdef CMD_SAVEENV
	63	/* static env_t flash_addr = (env_t )(&environment[0]);-broken on ARM-wd-*/
	64	static env_t flash_addr = (env_t )CFG_ENV_ADDR;
	65	#endif
	66
	67	#else /* ! ENV_IS_EMBEDDED */
	68
	69	env_t env_ptr = (env_t )CFG_ENV_ADDR;
	70	#ifdef CMD_SAVEENV
	71	static env_t flash_addr = (env_t )CFG_ENV_ADDR;
	72	#endif
	73
	74	#endif /* ENV_IS_EMBEDDED */
	75
	76	#ifdef CFG_ENV_ADDR_REDUND
	77	static env_t flash_addr_new = (env_t )CFG_ENV_ADDR_REDUND;
	78
47cd00fa WD	79	/* CFG_ENV_ADDR is supposed to be on sector boundary */
	80	static ulong end_addr = CFG_ENV_ADDR + CFG_ENV_SECT_SIZE - 1;
	81	static ulong end_addr_new = CFG_ENV_ADDR_REDUND + CFG_ENV_SECT_SIZE - 1;
c609719b WD	82
	83	static uchar active_flag = 1;
	84	static uchar obsolete_flag = 0;
	85	#endif
	86
	87	extern uchar default_environment[];
	88	extern int default_environment_size;
	89
	90
	91	uchar env_get_char_spec (int index)
	92	{
	93	DECLARE_GLOBAL_DATA_PTR;
	94
	95	return ( ((uchar )(gd->env_addr + index)) );
	96	}
	97
	98	#ifdef CFG_ENV_ADDR_REDUND
	99
	100	int env_init(void)
	101	{
	102	DECLARE_GLOBAL_DATA_PTR;
	103
	104	int crc1_ok =
	105	(crc32(0, flash_addr->data, ENV_SIZE) == flash_addr->crc);
	106	int crc2_ok =
	107	(crc32(0, flash_addr_new->data, ENV_SIZE) == flash_addr_new->crc);
	108
	109	uchar flag1 = flash_addr->flags;
	110	uchar flag2 = flash_addr_new->flags;
	111
	112	ulong addr_default = (ulong)&default_environment[0];
	113	ulong addr1 = (ulong)&(flash_addr->data);
	114	ulong addr2 = (ulong)&(flash_addr_new->data);
	115
	116	if (crc1_ok && ! crc2_ok)
	117	{
	118	gd->env_addr = addr1;
	119	gd->env_valid = 1;
	120	}
	121	else if (! crc1_ok && crc2_ok)
	122	{
	123	gd->env_addr = addr2;
	124	gd->env_valid = 1;
	125	}
	126	else if (! crc1_ok && ! crc2_ok)
	127	{
	128	gd->env_addr = addr_default;
	129	gd->env_valid = 0;
	130	}
	131	else if (flag1 == active_flag && flag2 == obsolete_flag)
	132	{
	133	gd->env_addr = addr1;
	134	gd->env_valid = 1;
	135	}
	136	else if (flag1 == obsolete_flag && flag2 == active_flag)
	137	{
	138	gd->env_addr = addr2;
	139	gd->env_valid = 1;
	140	}
	141	else if (flag1 == flag2)
	142	{
	143	gd->env_addr = addr1;
	144	gd->env_valid = 2;
	145	}
146	else if (flag1 == 0xFF)
147	{
148	gd->env_addr = addr1;
149	gd->env_valid = 2;
150	}
151	else if (flag2 == 0xFF)
152	{
153	gd->env_addr = addr2;
154	gd->env_valid = 2;
155	}
156
157	return (0);
158	}
159
160	#ifdef CMD_SAVEENV
161	int saveenv(void)
162	{
163	int rc = 1;
47cd00fa WD	164	ulong up_data = 0;
47cd00fa WD	165	char *saved_data = NULL;
c609719b WD	166
	167	debug ("Protect off %08lX ... %08lX\n",
	168	(ulong)flash_addr, end_addr);
	169
	170	if (flash_sect_protect (0, (ulong)flash_addr, end_addr)) {
	171	goto Done;
	172	}
	173
	174	debug ("Protect off %08lX ... %08lX\n",
	175	(ulong)flash_addr_new, end_addr_new);
	176
	177	if (flash_sect_protect (0, (ulong)flash_addr_new, end_addr_new)) {
	178	goto Done;
	179	}
	180
47cd00fa WD	181	#if CFG_ENV_SECT_SIZE > CFG_ENV_SIZE
	182	up_data = (end_addr_new + 1 - ((long)flash_addr_new + CFG_ENV_SIZE));
	183	debug ("Data to save 0x%x\n", up_data);
	184	if (up_data) {
	185	if ((saved_data = malloc(up_data)) == NULL) {
	186	printf("Unable to save the rest of sector (%ld)\n",
	187	up_data);
	188	goto Done;
	189	}
	190	memcpy(saved_data,
	191	(void *)((long)flash_addr_new + CFG_ENV_SIZE), up_data);
	192	debug ("Data (start 0x%x, len 0x%x) saved at 0x%x\n",
	193	(long)flash_addr_new + CFG_ENV_SIZE,
	194	up_data, saved_data);
	195	}
	196	#endif
c609719b WD	197	puts ("Erasing Flash...");
	198	debug (" %08lX ... %08lX ...",
	199	(ulong)flash_addr_new, end_addr_new);
	200
	201	if (flash_sect_erase ((ulong)flash_addr_new, end_addr_new)) {
	202	goto Done;
	203	}
	204
	205	puts ("Writing to Flash... ");
	206	debug (" %08lX ... %08lX ...",
	207	(ulong)&(flash_addr_new->data),
	208	sizeof(env_ptr->data)+(ulong)&(flash_addr_new->data));
	209	if (flash_write(env_ptr->data,
	210	(ulong)&(flash_addr_new->data),
	211	sizeof(env_ptr->data)) \|\|
	212
	213	flash_write((char *)&(env_ptr->crc),
	214	(ulong)&(flash_addr_new->crc),
	215	sizeof(env_ptr->crc)) \|\|
	216
	217	flash_write((char *)&obsolete_flag,
	218	(ulong)&(flash_addr->flags),
	219	sizeof(flash_addr->flags)) \|\|
	220
	221	flash_write((char *)&active_flag,
	222	(ulong)&(flash_addr_new->flags),
	223	sizeof(flash_addr_new->flags)))
	224	{
	225	flash_perror (rc);
	226	goto Done;
	227	}
	228	puts ("done\n");
	229
47cd00fa WD	230	#if CFG_ENV_SECT_SIZE > CFG_ENV_SIZE
	231	if (up_data) { /* restore the rest of sector */
	232	debug ("Restoring the rest of data to 0x%x len 0x%x\n",
	233	(long)flash_addr_new + CFG_ENV_SIZE, up_data);
	234	if (flash_write(saved_data,
	235	(long)flash_addr_new + CFG_ENV_SIZE,
	236	up_data)) {
	237	flash_perror(rc);
	238	goto Done;
	239	}
	240	}
	241	#endif
c609719b WD	242	{
	243	env_t * etmp = flash_addr;
	244	ulong ltmp = end_addr;
	245
	246	flash_addr = flash_addr_new;
	247	flash_addr_new = etmp;
	248
	249	end_addr = end_addr_new;
	250	end_addr_new = ltmp;
	251	}
	252
	253	rc = 0;
	254	Done:
	255
47cd00fa WD	256	if (saved_data)
47cd00fa WD	257	free (saved_data);
c609719b WD	258	/* try to re-protect */
	259	(void) flash_sect_protect (1, (ulong)flash_addr, end_addr);
	260	(void) flash_sect_protect (1, (ulong)flash_addr_new, end_addr_new);
	261
	262	return rc;
	263	}
	264	#endif /* CMD_SAVEENV */
	265
	266	#else /* ! CFG_ENV_ADDR_REDUND */
	267
	268	int env_init(void)
	269	{
	270	DECLARE_GLOBAL_DATA_PTR;
	271
	272	if (crc32(0, env_ptr->data, ENV_SIZE) == env_ptr->crc) {
	273	gd->env_addr = (ulong)&(env_ptr->data);
	274	gd->env_valid = 1;
	275	} else {
	276	gd->env_addr = (ulong)&default_environment[0];
	277	gd->env_valid = 0;
	278	}
	279
	280	return (0);
	281	}
	282
	283	#ifdef CMD_SAVEENV
	284
	285	int saveenv(void)
	286	{
	287	int len, rc;
	288	ulong end_addr;
	289	ulong flash_sect_addr;
	290	#if defined(CFG_ENV_SECT_SIZE) && (CFG_ENV_SECT_SIZE > CFG_ENV_SIZE)
	291	ulong flash_offset;
	292	uchar env_buffer[CFG_ENV_SECT_SIZE];
	293	#else
	294	uchar env_buffer = (char )env_ptr;
	295	#endif /* CFG_ENV_SECT_SIZE */
	296	int rcode = 0;
	297
	298	#if defined(CFG_ENV_SECT_SIZE) && (CFG_ENV_SECT_SIZE > CFG_ENV_SIZE)
	299
	300	flash_offset = ((ulong)flash_addr) & (CFG_ENV_SECT_SIZE-1);
	301	flash_sect_addr = ((ulong)flash_addr) & ~(CFG_ENV_SECT_SIZE-1);
	302
	303	debug ( "copy old content: "
	304	"sect_addr: %08lX env_addr: %08lX offset: %08lX\n",
	305	flash_sect_addr, (ulong)flash_addr, flash_offset);
	306
	307	/* copy old contents to temporary buffer */
	308	memcpy (env_buffer, (void *)flash_sect_addr, CFG_ENV_SECT_SIZE);
	309
	310	/* copy current environment to temporary buffer */
	311	memcpy ((uchar *)((unsigned long)env_buffer + flash_offset),
	312	env_ptr,
	313	CFG_ENV_SIZE);
	314
	315	len = CFG_ENV_SECT_SIZE;
	316	#else
	317	flash_sect_addr = (ulong)flash_addr;
	318	len = CFG_ENV_SIZE;
	319	#endif /* CFG_ENV_SECT_SIZE */
	320
	321	#ifndef CONFIG_INFERNO
322	end_addr = flash_sect_addr + len - 1;
323	#else
324	/* this is the last sector, and the size is hardcoded here */
325	/* otherwise we will get stack problems on loading 128 KB environment */
326	end_addr = flash_sect_addr + 0x20000 - 1;
327	#endif
328
329	debug ("Protect off %08lX ... %08lX\n",
330	(ulong)flash_sect_addr, end_addr);
331
332	if (flash_sect_protect (0, flash_sect_addr, end_addr))
333	return 1;
334
335	puts ("Erasing Flash...");
336	if (flash_sect_erase (flash_sect_addr, end_addr))
337	return 1;
338
339	puts ("Writing to Flash... ");
340	rc = flash_write(env_buffer, flash_sect_addr, len);
341	if (rc != 0) {
342	flash_perror (rc);
343	rcode = 1;
344	} else {
345	puts ("done\n");
346	}
347
348	/* try to re-protect */
349	(void) flash_sect_protect (1, flash_sect_addr, end_addr);
350	return rcode;
351	}
352
353	#endif /* CMD_SAVEENV */
354
355	#endif /* CFG_ENV_ADDR_REDUND */
356
357	void env_relocate_spec (void)
358	{
359	#if !defined(ENV_IS_EMBEDDED) \|\| defined(CFG_ENV_ADDR_REDUND)
360	#ifdef CFG_ENV_ADDR_REDUND
361	DECLARE_GLOBAL_DATA_PTR;
362
363	if (gd->env_addr != (ulong)&(flash_addr->data))
364	{
365	env_t * etmp = flash_addr;
366	ulong ltmp = end_addr;
367
368	flash_addr = flash_addr_new;
369	flash_addr_new = etmp;
370
371	end_addr = end_addr_new;
372	end_addr_new = ltmp;
373	}
374
375	if (flash_addr_new->flags != obsolete_flag &&
376	crc32(0, flash_addr_new->data, ENV_SIZE) ==
377	flash_addr_new->crc)
378	{
379	gd->env_valid = 2;
380	flash_sect_protect (0, (ulong)flash_addr_new, end_addr_new);
381	flash_write((char *)&obsolete_flag,
382	(ulong)&(flash_addr_new->flags),
383	sizeof(flash_addr_new->flags));
384	flash_sect_protect (1, (ulong)flash_addr_new, end_addr_new);
385	}
386
387	if (flash_addr->flags != active_flag &&
388	(flash_addr->flags & active_flag) == active_flag)
389	{
390	gd->env_valid = 2;
391	flash_sect_protect (0, (ulong)flash_addr, end_addr);
392	flash_write((char *)&active_flag,
393	(ulong)&(flash_addr->flags),
394	sizeof(flash_addr->flags));
395	flash_sect_protect (1, (ulong)flash_addr, end_addr);
396	}
397
398	if (gd->env_valid == 2)
399	puts ("*** Warning - some problems detected "
400	"reading environment; recovered successfully\n\n");
401	#endif /* CFG_ENV_ADDR_REDUND */
402	memcpy (env_ptr, (void*)flash_addr, CFG_ENV_SIZE);
403	#endif /* ! ENV_IS_EMBEDDED \|\| CFG_ENV_ADDR_REDUND */
404	}
405
43d9616c	406	#endif /* CFG_ENV_IS_IN_FLASH */