env_dataflash.c 2.77 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21
/* LowLevel function for DataFlash environment support
 * Author : Gilles Gastaldi (Atmel)
 *
 * 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
 *
 */
#include <common.h>

22
#if defined(CONFIG_ENV_IS_IN_DATAFLASH) /* Environment is in DataFlash */
23 24 25 26 27 28

#include <command.h>
#include <environment.h>
#include <linux/stddef.h>
#include <dataflash.h>

29 30
DECLARE_GLOBAL_DATA_PTR;

31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46
env_t *env_ptr = NULL;

char * env_name_spec = "dataflash";

extern int read_dataflash (unsigned long addr, unsigned long size, char
*result);
extern int write_dataflash (unsigned long addr_dest, unsigned long addr_src,
		     unsigned long size);
extern int AT91F_DataflashInit (void);
extern uchar default_environment[];
/* extern int default_environment_size; */


uchar env_get_char_spec (int index)
{
	uchar c;
Stelian Pop's avatar
Stelian Pop committed
47 48
	read_dataflash(CFG_ENV_ADDR + index + offsetof(env_t,data),
	1, (char *)&c);
49 50 51 52 53
	return (c);
}

void env_relocate_spec (void)
{
Stelian Pop's avatar
Stelian Pop committed
54
	read_dataflash(CFG_ENV_ADDR, CFG_ENV_SIZE, (char *)env_ptr);
55 56 57 58
}

int saveenv(void)
{
Stelian Pop's avatar
Stelian Pop committed
59 60
	/* env must be copied to do not alter env structure in memory*/
	unsigned char temp[CFG_ENV_SIZE];
61
	memcpy(temp, env_ptr, CFG_ENV_SIZE);
Stelian Pop's avatar
Stelian Pop committed
62
	return write_dataflash(CFG_ENV_ADDR, (unsigned long)temp, CFG_ENV_SIZE);
63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79
}

/************************************************************************
 * Initialize Environment use
 *
 * We are still running from ROM, so data use is limited
 * Use a (moderately small) buffer on the stack
 */
int env_init(void)
{
	ulong crc, len, new;
	unsigned off;
	uchar buf[64];
	if (gd->env_valid == 0){
		AT91F_DataflashInit();	/* prepare for DATAFLASH read/write */

		/* read old CRC */
Stelian Pop's avatar
Stelian Pop committed
80 81
		read_dataflash(CFG_ENV_ADDR + offsetof(env_t, crc),
			sizeof(ulong), (char *)&crc);
82 83 84 85 86
		new = 0;
		len = ENV_SIZE;
		off = offsetof(env_t,data);
		while (len > 0) {
			int n = (len > sizeof(buf)) ? sizeof(buf) : len;
Stelian Pop's avatar
Stelian Pop committed
87
			read_dataflash(CFG_ENV_ADDR + off, n, (char *)buf);
88 89 90 91 92 93 94 95 96 97 98 99 100
			new = crc32 (new, buf, n);
			len -= n;
			off += n;
		}
		if (crc == new) {
			gd->env_addr  = offsetof(env_t,data);
			gd->env_valid = 1;
		} else {
			gd->env_addr  = (ulong)&default_environment[0];
			gd->env_valid = 0;
		}
	}

Wolfgang Denk's avatar
Wolfgang Denk committed
101
	return (0);
102 103
}

104
#endif /* CONFIG_ENV_IS_IN_DATAFLASH */