2 * (C) Copyright 2000-2010
3 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
5 * (C) Copyright 2001 Sysgo Real-Time Solutions, GmbH <www.elinos.com>
6 * Andreas Heppel <aheppel@sysgo.de>
8 * SPDX-License-Identifier: GPL-2.0+
15 #include <environment.h>
16 #include <linux/stddef.h>
21 DECLARE_GLOBAL_DATA_PTR;
23 #if defined(CONFIG_CMD_SAVEENV) && defined(CONFIG_CMD_FLASH)
25 #elif defined(CONFIG_ENV_ADDR_REDUND)
26 #error CONFIG_ENV_ADDR_REDUND must have CONFIG_CMD_SAVEENV & CONFIG_CMD_FLASH
29 #if defined(CONFIG_ENV_SIZE_REDUND) && \
30 (CONFIG_ENV_SIZE_REDUND < CONFIG_ENV_SIZE)
31 #error CONFIG_ENV_SIZE_REDUND should not be less then CONFIG_ENV_SIZE
34 char *env_name_spec = "Flash";
36 #ifdef ENV_IS_EMBEDDED
37 env_t *env_ptr = &environment;
39 static env_t *flash_addr = (env_t *)CONFIG_ENV_ADDR;
41 #else /* ! ENV_IS_EMBEDDED */
43 env_t *env_ptr = (env_t *)CONFIG_ENV_ADDR;
44 static env_t *flash_addr = (env_t *)CONFIG_ENV_ADDR;
45 #endif /* ENV_IS_EMBEDDED */
47 #if defined(CMD_SAVEENV) || defined(CONFIG_ENV_ADDR_REDUND)
48 /* CONFIG_ENV_ADDR is supposed to be on sector boundary */
49 static ulong end_addr = CONFIG_ENV_ADDR + CONFIG_ENV_SECT_SIZE - 1;
52 #ifdef CONFIG_ENV_ADDR_REDUND
53 static env_t *flash_addr_new = (env_t *)CONFIG_ENV_ADDR_REDUND;
55 /* CONFIG_ENV_ADDR_REDUND is supposed to be on sector boundary */
56 static ulong end_addr_new = CONFIG_ENV_ADDR_REDUND + CONFIG_ENV_SECT_SIZE - 1;
57 #endif /* CONFIG_ENV_ADDR_REDUND */
60 #ifdef CONFIG_ENV_ADDR_REDUND
63 int crc1_ok = 0, crc2_ok = 0;
65 uchar flag1 = flash_addr->flags;
66 uchar flag2 = flash_addr_new->flags;
68 ulong addr_default = (ulong)&default_environment[0];
69 ulong addr1 = (ulong)&(flash_addr->data);
70 ulong addr2 = (ulong)&(flash_addr_new->data);
72 crc1_ok = crc32(0, flash_addr->data, ENV_SIZE) == flash_addr->crc;
74 crc32(0, flash_addr_new->data, ENV_SIZE) == flash_addr_new->crc;
76 if (crc1_ok && !crc2_ok) {
79 } else if (!crc1_ok && crc2_ok) {
82 } else if (!crc1_ok && !crc2_ok) {
83 gd->env_addr = addr_default;
85 } else if (flag1 == ACTIVE_FLAG && flag2 == OBSOLETE_FLAG) {
88 } else if (flag1 == OBSOLETE_FLAG && flag2 == ACTIVE_FLAG) {
91 } else if (flag1 == flag2) {
94 } else if (flag1 == 0xFF) {
97 } else if (flag2 == 0xFF) {
109 char *saved_data = NULL;
110 char flag = OBSOLETE_FLAG, new_flag = ACTIVE_FLAG;
112 #if CONFIG_ENV_SECT_SIZE > CONFIG_ENV_SIZE
116 debug("Protect off %08lX ... %08lX\n", (ulong)flash_addr, end_addr);
118 if (flash_sect_protect(0, (ulong)flash_addr, end_addr))
121 debug("Protect off %08lX ... %08lX\n",
122 (ulong)flash_addr_new, end_addr_new);
124 if (flash_sect_protect(0, (ulong)flash_addr_new, end_addr_new))
127 rc = env_export(&env_new);
130 env_new.flags = new_flag;
132 #if CONFIG_ENV_SECT_SIZE > CONFIG_ENV_SIZE
133 up_data = end_addr_new + 1 - ((long)flash_addr_new + CONFIG_ENV_SIZE);
134 debug("Data to save 0x%lX\n", up_data);
136 saved_data = malloc(up_data);
137 if (saved_data == NULL) {
138 printf("Unable to save the rest of sector (%ld)\n",
143 (void *)((long)flash_addr_new + CONFIG_ENV_SIZE),
145 debug("Data (start 0x%lX, len 0x%lX) saved at 0x%p\n",
146 (long)flash_addr_new + CONFIG_ENV_SIZE,
147 up_data, saved_data);
150 puts("Erasing Flash...");
151 debug(" %08lX ... %08lX ...", (ulong)flash_addr_new, end_addr_new);
153 if (flash_sect_erase((ulong)flash_addr_new, end_addr_new))
156 puts("Writing to Flash... ");
157 debug(" %08lX ... %08lX ...",
158 (ulong)&(flash_addr_new->data),
159 sizeof(env_ptr->data) + (ulong)&(flash_addr_new->data));
160 rc = flash_write((char *)&env_new, (ulong)flash_addr_new,
165 rc = flash_write(&flag, (ulong)&(flash_addr->flags),
166 sizeof(flash_addr->flags));
170 #if CONFIG_ENV_SECT_SIZE > CONFIG_ENV_SIZE
171 if (up_data) { /* restore the rest of sector */
172 debug("Restoring the rest of data to 0x%lX len 0x%lX\n",
173 (long)flash_addr_new + CONFIG_ENV_SIZE, up_data);
174 if (flash_write(saved_data,
175 (long)flash_addr_new + CONFIG_ENV_SIZE,
183 env_t *etmp = flash_addr;
184 ulong ltmp = end_addr;
186 flash_addr = flash_addr_new;
187 flash_addr_new = etmp;
189 end_addr = end_addr_new;
200 /* try to re-protect */
201 flash_sect_protect(1, (ulong)flash_addr, end_addr);
202 flash_sect_protect(1, (ulong)flash_addr_new, end_addr_new);
206 #endif /* CMD_SAVEENV */
208 #else /* ! CONFIG_ENV_ADDR_REDUND */
212 if (crc32(0, env_ptr->data, ENV_SIZE) == env_ptr->crc) {
213 gd->env_addr = (ulong)&(env_ptr->data);
218 gd->env_addr = (ulong)&default_environment[0];
228 char *saved_data = NULL;
229 #if CONFIG_ENV_SECT_SIZE > CONFIG_ENV_SIZE
232 up_data = end_addr + 1 - ((long)flash_addr + CONFIG_ENV_SIZE);
233 debug("Data to save 0x%lx\n", up_data);
235 saved_data = malloc(up_data);
236 if (saved_data == NULL) {
237 printf("Unable to save the rest of sector (%ld)\n",
242 (void *)((long)flash_addr + CONFIG_ENV_SIZE), up_data);
243 debug("Data (start 0x%lx, len 0x%lx) saved at 0x%lx\n",
244 (ulong)flash_addr + CONFIG_ENV_SIZE,
248 #endif /* CONFIG_ENV_SECT_SIZE */
250 debug("Protect off %08lX ... %08lX\n", (ulong)flash_addr, end_addr);
252 if (flash_sect_protect(0, (long)flash_addr, end_addr))
255 rc = env_export(&env_new);
259 puts("Erasing Flash...");
260 if (flash_sect_erase((long)flash_addr, end_addr))
263 puts("Writing to Flash... ");
264 rc = flash_write((char *)&env_new, (long)flash_addr, CONFIG_ENV_SIZE);
268 #if CONFIG_ENV_SECT_SIZE > CONFIG_ENV_SIZE
269 if (up_data) { /* restore the rest of sector */
270 debug("Restoring the rest of data to 0x%lx len 0x%lx\n",
271 (ulong)flash_addr + CONFIG_ENV_SIZE, up_data);
272 if (flash_write(saved_data,
273 (long)flash_addr + CONFIG_ENV_SIZE,
286 /* try to re-protect */
287 flash_sect_protect(1, (long)flash_addr, end_addr);
290 #endif /* CMD_SAVEENV */
292 #endif /* CONFIG_ENV_ADDR_REDUND */
294 void env_relocate_spec(void)
296 #ifdef CONFIG_ENV_ADDR_REDUND
297 if (gd->env_addr != (ulong)&(flash_addr->data)) {
298 env_t *etmp = flash_addr;
299 ulong ltmp = end_addr;
301 flash_addr = flash_addr_new;
302 flash_addr_new = etmp;
304 end_addr = end_addr_new;
308 if (flash_addr_new->flags != OBSOLETE_FLAG &&
309 crc32(0, flash_addr_new->data, ENV_SIZE) == flash_addr_new->crc) {
310 char flag = OBSOLETE_FLAG;
313 flash_sect_protect(0, (ulong)flash_addr_new, end_addr_new);
315 (ulong)&(flash_addr_new->flags),
316 sizeof(flash_addr_new->flags));
317 flash_sect_protect(1, (ulong)flash_addr_new, end_addr_new);
320 if (flash_addr->flags != ACTIVE_FLAG &&
321 (flash_addr->flags & ACTIVE_FLAG) == ACTIVE_FLAG) {
322 char flag = ACTIVE_FLAG;
325 flash_sect_protect(0, (ulong)flash_addr, end_addr);
327 (ulong)&(flash_addr->flags),
328 sizeof(flash_addr->flags));
329 flash_sect_protect(1, (ulong)flash_addr, end_addr);
332 if (gd->env_valid == 2)
333 puts("*** Warning - some problems detected "
334 "reading environment; recovered successfully\n\n");
335 #endif /* CONFIG_ENV_ADDR_REDUND */
337 env_import((char *)flash_addr, 1);