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);