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 #ifndef CONFIG_SPL_BUILD
24 # if defined(CONFIG_CMD_SAVEENV) && defined(CONFIG_CMD_FLASH)
26 # elif defined(CONFIG_ENV_ADDR_REDUND)
27 # error CONFIG_ENV_ADDR_REDUND must have CONFIG_CMD_SAVEENV & CONFIG_CMD_FLASH
31 #if defined(CONFIG_ENV_SIZE_REDUND) && \
32 (CONFIG_ENV_SIZE_REDUND < CONFIG_ENV_SIZE)
33 #error CONFIG_ENV_SIZE_REDUND should not be less then CONFIG_ENV_SIZE
36 /* TODO(sjg@chromium.org): Figure out all these special cases */
37 #if (!defined(CONFIG_MICROBLAZE) && !defined(CONFIG_ARCH_ZYNQ) && \
38 !defined(CONFIG_TARGET_MCCMON6) && !defined(CONFIG_TARGET_X600) && \
39 !defined(CONFIG_TARGET_EDMINIV2)) || \
40 !defined(CONFIG_SPL_BUILD)
44 #if !defined(CONFIG_TARGET_X600) || !defined(CONFIG_SPL_BUILD)
48 #ifdef ENV_IS_EMBEDDED
49 env_t
*env_ptr
= &environment
;
51 static __maybe_unused env_t
*flash_addr
= (env_t
*)CONFIG_ENV_ADDR
;
53 #else /* ! ENV_IS_EMBEDDED */
55 env_t
*env_ptr
= (env_t
*)CONFIG_ENV_ADDR
;
56 static __maybe_unused env_t
*flash_addr
= (env_t
*)CONFIG_ENV_ADDR
;
57 #endif /* ENV_IS_EMBEDDED */
59 /* CONFIG_ENV_ADDR is supposed to be on sector boundary */
60 static ulong __maybe_unused end_addr
=
61 CONFIG_ENV_ADDR
+ CONFIG_ENV_SECT_SIZE
- 1;
63 #ifdef CONFIG_ENV_ADDR_REDUND
65 static env_t __maybe_unused
*flash_addr_new
= (env_t
*)CONFIG_ENV_ADDR_REDUND
;
67 /* CONFIG_ENV_ADDR_REDUND is supposed to be on sector boundary */
68 static ulong __maybe_unused end_addr_new
=
69 CONFIG_ENV_ADDR_REDUND
+ CONFIG_ENV_SECT_SIZE
- 1;
70 #endif /* CONFIG_ENV_ADDR_REDUND */
72 #ifdef CONFIG_ENV_ADDR_REDUND
74 static int env_flash_init(void)
76 int crc1_ok
= 0, crc2_ok
= 0;
78 uchar flag1
= flash_addr
->flags
;
79 uchar flag2
= flash_addr_new
->flags
;
81 ulong addr_default
= (ulong
)&default_environment
[0];
82 ulong addr1
= (ulong
)&(flash_addr
->data
);
83 ulong addr2
= (ulong
)&(flash_addr_new
->data
);
85 crc1_ok
= crc32(0, flash_addr
->data
, ENV_SIZE
) == flash_addr
->crc
;
87 crc32(0, flash_addr_new
->data
, ENV_SIZE
) == flash_addr_new
->crc
;
89 if (crc1_ok
&& !crc2_ok
) {
91 gd
->env_valid
= ENV_VALID
;
92 } else if (!crc1_ok
&& crc2_ok
) {
94 gd
->env_valid
= ENV_VALID
;
95 } else if (!crc1_ok
&& !crc2_ok
) {
96 gd
->env_addr
= addr_default
;
97 gd
->env_valid
= ENV_INVALID
;
98 } else if (flag1
== ACTIVE_FLAG
&& flag2
== OBSOLETE_FLAG
) {
100 gd
->env_valid
= ENV_VALID
;
101 } else if (flag1
== OBSOLETE_FLAG
&& flag2
== ACTIVE_FLAG
) {
102 gd
->env_addr
= addr2
;
103 gd
->env_valid
= ENV_VALID
;
104 } else if (flag1
== flag2
) {
105 gd
->env_addr
= addr1
;
106 gd
->env_valid
= ENV_REDUND
;
107 } else if (flag1
== 0xFF) {
108 gd
->env_addr
= addr1
;
109 gd
->env_valid
= ENV_REDUND
;
110 } else if (flag2
== 0xFF) {
111 gd
->env_addr
= addr2
;
112 gd
->env_valid
= ENV_REDUND
;
120 static int env_flash_save(void)
123 char *saved_data
= NULL
;
124 char flag
= OBSOLETE_FLAG
, new_flag
= ACTIVE_FLAG
;
126 #if CONFIG_ENV_SECT_SIZE > CONFIG_ENV_SIZE
130 debug("Protect off %08lX ... %08lX\n", (ulong
)flash_addr
, end_addr
);
132 if (flash_sect_protect(0, (ulong
)flash_addr
, end_addr
))
135 debug("Protect off %08lX ... %08lX\n",
136 (ulong
)flash_addr_new
, end_addr_new
);
138 if (flash_sect_protect(0, (ulong
)flash_addr_new
, end_addr_new
))
141 rc
= env_export(&env_new
);
144 env_new
.flags
= new_flag
;
146 #if CONFIG_ENV_SECT_SIZE > CONFIG_ENV_SIZE
147 up_data
= end_addr_new
+ 1 - ((long)flash_addr_new
+ CONFIG_ENV_SIZE
);
148 debug("Data to save 0x%lX\n", up_data
);
150 saved_data
= malloc(up_data
);
151 if (saved_data
== NULL
) {
152 printf("Unable to save the rest of sector (%ld)\n",
157 (void *)((long)flash_addr_new
+ CONFIG_ENV_SIZE
),
159 debug("Data (start 0x%lX, len 0x%lX) saved at 0x%p\n",
160 (long)flash_addr_new
+ CONFIG_ENV_SIZE
,
161 up_data
, saved_data
);
164 puts("Erasing Flash...");
165 debug(" %08lX ... %08lX ...", (ulong
)flash_addr_new
, end_addr_new
);
167 if (flash_sect_erase((ulong
)flash_addr_new
, end_addr_new
))
170 puts("Writing to Flash... ");
171 debug(" %08lX ... %08lX ...",
172 (ulong
)&(flash_addr_new
->data
),
173 sizeof(env_ptr
->data
) + (ulong
)&(flash_addr_new
->data
));
174 rc
= flash_write((char *)&env_new
, (ulong
)flash_addr_new
,
179 rc
= flash_write(&flag
, (ulong
)&(flash_addr
->flags
),
180 sizeof(flash_addr
->flags
));
184 #if CONFIG_ENV_SECT_SIZE > CONFIG_ENV_SIZE
185 if (up_data
) { /* restore the rest of sector */
186 debug("Restoring the rest of data to 0x%lX len 0x%lX\n",
187 (long)flash_addr_new
+ CONFIG_ENV_SIZE
, up_data
);
188 if (flash_write(saved_data
,
189 (long)flash_addr_new
+ CONFIG_ENV_SIZE
,
197 env_t
*etmp
= flash_addr
;
198 ulong ltmp
= end_addr
;
200 flash_addr
= flash_addr_new
;
201 flash_addr_new
= etmp
;
203 end_addr
= end_addr_new
;
214 /* try to re-protect */
215 flash_sect_protect(1, (ulong
)flash_addr
, end_addr
);
216 flash_sect_protect(1, (ulong
)flash_addr_new
, end_addr_new
);
220 #endif /* CMD_SAVEENV */
222 #else /* ! CONFIG_ENV_ADDR_REDUND */
225 static int env_flash_init(void)
227 if (crc32(0, env_ptr
->data
, ENV_SIZE
) == env_ptr
->crc
) {
228 gd
->env_addr
= (ulong
)&(env_ptr
->data
);
229 gd
->env_valid
= ENV_VALID
;
233 gd
->env_addr
= (ulong
)&default_environment
[0];
234 gd
->env_valid
= ENV_INVALID
;
240 static int env_flash_save(void)
244 char *saved_data
= NULL
;
245 #if CONFIG_ENV_SECT_SIZE > CONFIG_ENV_SIZE
248 up_data
= end_addr
+ 1 - ((long)flash_addr
+ CONFIG_ENV_SIZE
);
249 debug("Data to save 0x%lx\n", up_data
);
251 saved_data
= malloc(up_data
);
252 if (saved_data
== NULL
) {
253 printf("Unable to save the rest of sector (%ld)\n",
258 (void *)((long)flash_addr
+ CONFIG_ENV_SIZE
), up_data
);
259 debug("Data (start 0x%lx, len 0x%lx) saved at 0x%lx\n",
260 (ulong
)flash_addr
+ CONFIG_ENV_SIZE
,
264 #endif /* CONFIG_ENV_SECT_SIZE */
266 debug("Protect off %08lX ... %08lX\n", (ulong
)flash_addr
, end_addr
);
268 if (flash_sect_protect(0, (long)flash_addr
, end_addr
))
271 rc
= env_export(&env_new
);
275 puts("Erasing Flash...");
276 if (flash_sect_erase((long)flash_addr
, end_addr
))
279 puts("Writing to Flash... ");
280 rc
= flash_write((char *)&env_new
, (long)flash_addr
, CONFIG_ENV_SIZE
);
284 #if CONFIG_ENV_SECT_SIZE > CONFIG_ENV_SIZE
285 if (up_data
) { /* restore the rest of sector */
286 debug("Restoring the rest of data to 0x%lx len 0x%lx\n",
287 (ulong
)flash_addr
+ CONFIG_ENV_SIZE
, up_data
);
288 if (flash_write(saved_data
,
289 (long)flash_addr
+ CONFIG_ENV_SIZE
,
302 /* try to re-protect */
303 flash_sect_protect(1, (long)flash_addr
, end_addr
);
306 #endif /* CMD_SAVEENV */
308 #endif /* CONFIG_ENV_ADDR_REDUND */
311 static int env_flash_load(void)
313 #ifdef CONFIG_ENV_ADDR_REDUND
314 if (gd
->env_addr
!= (ulong
)&(flash_addr
->data
)) {
315 env_t
*etmp
= flash_addr
;
316 ulong ltmp
= end_addr
;
318 flash_addr
= flash_addr_new
;
319 flash_addr_new
= etmp
;
321 end_addr
= end_addr_new
;
325 if (flash_addr_new
->flags
!= OBSOLETE_FLAG
&&
326 crc32(0, flash_addr_new
->data
, ENV_SIZE
) == flash_addr_new
->crc
) {
327 char flag
= OBSOLETE_FLAG
;
329 gd
->env_valid
= ENV_REDUND
;
330 flash_sect_protect(0, (ulong
)flash_addr_new
, end_addr_new
);
332 (ulong
)&(flash_addr_new
->flags
),
333 sizeof(flash_addr_new
->flags
));
334 flash_sect_protect(1, (ulong
)flash_addr_new
, end_addr_new
);
337 if (flash_addr
->flags
!= ACTIVE_FLAG
&&
338 (flash_addr
->flags
& ACTIVE_FLAG
) == ACTIVE_FLAG
) {
339 char flag
= ACTIVE_FLAG
;
341 gd
->env_valid
= ENV_REDUND
;
342 flash_sect_protect(0, (ulong
)flash_addr
, end_addr
);
344 (ulong
)&(flash_addr
->flags
),
345 sizeof(flash_addr
->flags
));
346 flash_sect_protect(1, (ulong
)flash_addr
, end_addr
);
349 if (gd
->env_valid
== ENV_REDUND
)
350 puts("*** Warning - some problems detected "
351 "reading environment; recovered successfully\n\n");
352 #endif /* CONFIG_ENV_ADDR_REDUND */
354 return env_import((char *)flash_addr
, 1);
358 U_BOOT_ENV_LOCATION(flash
) = {
359 .location
= ENVL_FLASH
,
362 .load
= env_flash_load
,
365 .save
= env_save_ptr(env_flash_save
),
368 .init
= env_flash_init
,