blob: 93fff29b05a4a6dda262fddbee115467495eae0a [file] [log] [blame]
wdenk5779d8d2003-12-06 23:55:10 +00001/* LowLevel function for DataFlash environment support
2 * Author : Gilles Gastaldi (Atmel)
3 *
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License as
6 * published by the Free Software Foundation; either version 2 of
7 * the License, or (at your option) any later version.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software
16 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
17 * MA 02111-1307 USA
18 *
19 */
20#include <common.h>
21
22#if defined(CFG_ENV_IS_IN_DATAFLASH) /* Environment is in DataFlash */
23
24#include <command.h>
25#include <environment.h>
26#include <linux/stddef.h>
wdenk5779d8d2003-12-06 23:55:10 +000027#include <dataflash.h>
28
Wolfgang Denkd87080b2006-03-31 18:32:53 +020029DECLARE_GLOBAL_DATA_PTR;
30
wdenk5779d8d2003-12-06 23:55:10 +000031env_t *env_ptr = NULL;
32
33char * env_name_spec = "dataflash";
34
35extern int read_dataflash (unsigned long addr, unsigned long size, char
36*result);
37extern int write_dataflash (unsigned long addr_dest, unsigned long addr_src,
38 unsigned long size);
39extern int AT91F_DataflashInit (void);
40extern uchar default_environment[];
41/* extern int default_environment_size; */
42
43
44uchar env_get_char_spec (int index)
45{
46 uchar c;
47 read_dataflash (CFG_ENV_ADDR+index+offsetof(env_t,data),1,&c);
48 return (c);
49}
50
51void env_relocate_spec (void)
52{
53 read_dataflash (CFG_ENV_ADDR,CFG_ENV_SIZE,(uchar *)env_ptr);
54}
55
56int saveenv(void)
57{
58/* env must be copied to do not alter env structure in memory*/
59unsigned char temp[CFG_ENV_SIZE];
60int i;
61 memcpy(temp, env_ptr, CFG_ENV_SIZE);
62 return write_dataflash (CFG_ENV_ADDR, (unsigned long)temp, CFG_ENV_SIZE);
63}
64
65/************************************************************************
66 * Initialize Environment use
67 *
68 * We are still running from ROM, so data use is limited
69 * Use a (moderately small) buffer on the stack
70 */
71int env_init(void)
72{
wdenk5779d8d2003-12-06 23:55:10 +000073 ulong crc, len, new;
74 unsigned off;
75 uchar buf[64];
76 if (gd->env_valid == 0){
77 AT91F_DataflashInit(); /* prepare for DATAFLASH read/write */
78
79 /* read old CRC */
80 read_dataflash (CFG_ENV_ADDR+offsetof(env_t,crc),sizeof(ulong),&crc);
81 new = 0;
82 len = ENV_SIZE;
83 off = offsetof(env_t,data);
84 while (len > 0) {
85 int n = (len > sizeof(buf)) ? sizeof(buf) : len;
86 read_dataflash (CFG_ENV_ADDR+off,n , buf);
87 new = crc32 (new, buf, n);
88 len -= n;
89 off += n;
90 }
91 if (crc == new) {
92 gd->env_addr = offsetof(env_t,data);
93 gd->env_valid = 1;
94 } else {
95 gd->env_addr = (ulong)&default_environment[0];
96 gd->env_valid = 0;
97 }
98 }
99
100 return (0);
101}
102
103#endif /* CFG_ENV_IS_IN_DATAFLASH */