]>
Commit | Line | Data |
---|---|---|
13a5695b | 1 | /* |
ea882baf WD |
2 | * (C) Copyright 2000-2010 |
3 | * Wolfgang Denk, DENX Software Engineering, [email protected]. | |
4 | * | |
cc49cade SW |
5 | * (C) Copyright 2008 |
6 | * Stuart Wood, Lab X Technologies <[email protected]> | |
7 | * | |
13a5695b WD |
8 | * (C) Copyright 2004 |
9 | * Jian Zhang, Texas Instruments, [email protected]. | |
13a5695b WD |
10 | * |
11 | * (C) Copyright 2001 Sysgo Real-Time Solutions, GmbH <www.elinos.com> | |
12 | * Andreas Heppel <[email protected]> | |
ea882baf | 13 | * |
3765b3e7 | 14 | * SPDX-License-Identifier: GPL-2.0+ |
13a5695b WD |
15 | */ |
16 | ||
13a5695b | 17 | #include <common.h> |
13a5695b WD |
18 | #include <command.h> |
19 | #include <environment.h> | |
20 | #include <linux/stddef.h> | |
e443c944 | 21 | #include <malloc.h> |
addb2e16 | 22 | #include <nand.h> |
ea882baf WD |
23 | #include <search.h> |
24 | #include <errno.h> | |
13a5695b | 25 | |
bdab39d3 | 26 | #if defined(CONFIG_CMD_SAVEENV) && defined(CONFIG_CMD_NAND) |
13a5695b | 27 | #define CMD_SAVEENV |
0e8d1586 | 28 | #elif defined(CONFIG_ENV_OFFSET_REDUND) |
de152b9b | 29 | #error CONFIG_ENV_OFFSET_REDUND must have CONFIG_CMD_SAVEENV & CONFIG_CMD_NAND |
13a5695b WD |
30 | #endif |
31 | ||
de152b9b IG |
32 | #if defined(CONFIG_ENV_SIZE_REDUND) && \ |
33 | (CONFIG_ENV_SIZE_REDUND != CONFIG_ENV_SIZE) | |
0e8d1586 | 34 | #error CONFIG_ENV_SIZE_REDUND should be the same as CONFIG_ENV_SIZE |
13a5695b WD |
35 | #endif |
36 | ||
0e8d1586 JCPV |
37 | #ifndef CONFIG_ENV_RANGE |
38 | #define CONFIG_ENV_RANGE CONFIG_ENV_SIZE | |
cc49cade SW |
39 | #endif |
40 | ||
ea882baf | 41 | char *env_name_spec = "NAND"; |
13a5695b | 42 | |
b74ab737 | 43 | #if defined(ENV_IS_EMBEDDED) |
994bc671 | 44 | env_t *env_ptr = &environment; |
b74ab737 GL |
45 | #elif defined(CONFIG_NAND_ENV_DST) |
46 | env_t *env_ptr = (env_t *)CONFIG_NAND_ENV_DST; | |
13a5695b | 47 | #else /* ! ENV_IS_EMBEDDED */ |
de152b9b | 48 | env_t *env_ptr; |
13a5695b WD |
49 | #endif /* ENV_IS_EMBEDDED */ |
50 | ||
d87080b7 | 51 | DECLARE_GLOBAL_DATA_PTR; |
13a5695b | 52 | |
ea882baf WD |
53 | /* |
54 | * This is called before nand_init() so we can't read NAND to | |
55 | * validate env data. | |
56 | * | |
57 | * Mark it OK for now. env_relocate() in env_common.c will call our | |
58 | * relocate function which does the real validation. | |
d12ae808 SR |
59 | * |
60 | * When using a NAND boot image (like sequoia_nand), the environment | |
ea882baf WD |
61 | * can be embedded or attached to the U-Boot image in NAND flash. |
62 | * This way the SPL loads not only the U-Boot image from NAND but | |
63 | * also the environment. | |
13a5695b WD |
64 | */ |
65 | int env_init(void) | |
66 | { | |
b74ab737 | 67 | #if defined(ENV_IS_EMBEDDED) || defined(CONFIG_NAND_ENV_DST) |
d12ae808 | 68 | int crc1_ok = 0, crc2_ok = 0; |
b74ab737 GL |
69 | env_t *tmp_env1; |
70 | ||
71 | #ifdef CONFIG_ENV_OFFSET_REDUND | |
72 | env_t *tmp_env2; | |
d12ae808 | 73 | |
0e8d1586 | 74 | tmp_env2 = (env_t *)((ulong)env_ptr + CONFIG_ENV_SIZE); |
de152b9b | 75 | crc2_ok = crc32(0, tmp_env2->data, ENV_SIZE) == tmp_env2->crc; |
b74ab737 | 76 | #endif |
b74ab737 | 77 | tmp_env1 = env_ptr; |
de152b9b | 78 | crc1_ok = crc32(0, tmp_env1->data, ENV_SIZE) == tmp_env1->crc; |
d12ae808 | 79 | |
b74ab737 | 80 | if (!crc1_ok && !crc2_ok) { |
de152b9b IG |
81 | gd->env_addr = 0; |
82 | gd->env_valid = 0; | |
b74ab737 GL |
83 | |
84 | return 0; | |
85 | } else if (crc1_ok && !crc2_ok) { | |
d12ae808 | 86 | gd->env_valid = 1; |
b74ab737 GL |
87 | } |
88 | #ifdef CONFIG_ENV_OFFSET_REDUND | |
89 | else if (!crc1_ok && crc2_ok) { | |
d12ae808 | 90 | gd->env_valid = 2; |
b74ab737 | 91 | } else { |
d12ae808 | 92 | /* both ok - check serial */ |
de152b9b | 93 | if (tmp_env1->flags == 255 && tmp_env2->flags == 0) |
d12ae808 | 94 | gd->env_valid = 2; |
de152b9b | 95 | else if (tmp_env2->flags == 255 && tmp_env1->flags == 0) |
d12ae808 | 96 | gd->env_valid = 1; |
de152b9b | 97 | else if (tmp_env1->flags > tmp_env2->flags) |
d12ae808 | 98 | gd->env_valid = 1; |
de152b9b | 99 | else if (tmp_env2->flags > tmp_env1->flags) |
d12ae808 SR |
100 | gd->env_valid = 2; |
101 | else /* flags are equal - almost impossible */ | |
102 | gd->env_valid = 1; | |
103 | } | |
104 | ||
b74ab737 GL |
105 | if (gd->env_valid == 2) |
106 | env_ptr = tmp_env2; | |
107 | else | |
108 | #endif | |
d12ae808 SR |
109 | if (gd->env_valid == 1) |
110 | env_ptr = tmp_env1; | |
b74ab737 GL |
111 | |
112 | gd->env_addr = (ulong)env_ptr->data; | |
113 | ||
114 | #else /* ENV_IS_EMBEDDED || CONFIG_NAND_ENV_DST */ | |
de152b9b IG |
115 | gd->env_addr = (ulong)&default_environment[0]; |
116 | gd->env_valid = 1; | |
b74ab737 | 117 | #endif /* ENV_IS_EMBEDDED || CONFIG_NAND_ENV_DST */ |
13a5695b | 118 | |
de152b9b | 119 | return 0; |
13a5695b WD |
120 | } |
121 | ||
122 | #ifdef CMD_SAVEENV | |
addb2e16 BS |
123 | /* |
124 | * The legacy NAND code saved the environment in the first NAND device i.e., | |
125 | * nand_dev_desc + 0. This is also the behaviour using the new NAND code. | |
126 | */ | |
cc49cade SW |
127 | int writeenv(size_t offset, u_char *buf) |
128 | { | |
0e8d1586 | 129 | size_t end = offset + CONFIG_ENV_RANGE; |
cc49cade | 130 | size_t amount_saved = 0; |
c3db8c64 | 131 | size_t blocksize, len; |
cc49cade SW |
132 | u_char *char_ptr; |
133 | ||
134 | blocksize = nand_info[0].erasesize; | |
0e8d1586 | 135 | len = min(blocksize, CONFIG_ENV_SIZE); |
cc49cade | 136 | |
0e8d1586 | 137 | while (amount_saved < CONFIG_ENV_SIZE && offset < end) { |
cc49cade SW |
138 | if (nand_block_isbad(&nand_info[0], offset)) { |
139 | offset += blocksize; | |
140 | } else { | |
141 | char_ptr = &buf[amount_saved]; | |
de152b9b | 142 | if (nand_write(&nand_info[0], offset, &len, char_ptr)) |
cc49cade | 143 | return 1; |
de152b9b | 144 | |
cc49cade | 145 | offset += blocksize; |
c3db8c64 | 146 | amount_saved += len; |
cc49cade SW |
147 | } |
148 | } | |
0e8d1586 | 149 | if (amount_saved != CONFIG_ENV_SIZE) |
cc49cade SW |
150 | return 1; |
151 | ||
152 | return 0; | |
153 | } | |
eef1d719 | 154 | |
2b26201a PS |
155 | struct env_location { |
156 | const char *name; | |
157 | const nand_erase_options_t erase_opts; | |
158 | }; | |
eef1d719 | 159 | |
2b26201a PS |
160 | static int erase_and_write_env(const struct env_location *location, |
161 | u_char *env_new) | |
13a5695b | 162 | { |
2b26201a | 163 | int ret = 0; |
cc49cade | 164 | |
2b26201a PS |
165 | printf("Erasing %s...\n", location->name); |
166 | if (nand_erase_opts(&nand_info[0], &location->erase_opts)) | |
cc49cade | 167 | return 1; |
ea882baf | 168 | |
2b26201a PS |
169 | printf("Writing to %s... ", location->name); |
170 | ret = writeenv(location->erase_opts.offset, env_new); | |
171 | puts(ret ? "FAILED!\n" : "OK\n"); | |
ea882baf | 172 | |
e443c944 MK |
173 | return ret; |
174 | } | |
2b26201a PS |
175 | |
176 | #ifdef CONFIG_ENV_OFFSET_REDUND | |
177 | static unsigned char env_flags; | |
178 | #endif | |
179 | ||
e443c944 MK |
180 | int saveenv(void) |
181 | { | |
de152b9b | 182 | int ret = 0; |
cd0f4fa1 | 183 | ALLOC_CACHE_ALIGN_BUFFER(env_t, env_new, 1); |
ea882baf WD |
184 | ssize_t len; |
185 | char *res; | |
2b26201a PS |
186 | int env_idx = 0; |
187 | static const struct env_location location[] = { | |
188 | { | |
189 | .name = "NAND", | |
190 | .erase_opts = { | |
191 | .length = CONFIG_ENV_RANGE, | |
192 | .offset = CONFIG_ENV_OFFSET, | |
193 | }, | |
194 | }, | |
195 | #ifdef CONFIG_ENV_OFFSET_REDUND | |
196 | { | |
197 | .name = "redundant NAND", | |
198 | .erase_opts = { | |
199 | .length = CONFIG_ENV_RANGE, | |
200 | .offset = CONFIG_ENV_OFFSET_REDUND, | |
201 | }, | |
202 | }, | |
203 | #endif | |
204 | }; | |
e093a247 | 205 | |
cc49cade | 206 | |
0e8d1586 | 207 | if (CONFIG_ENV_RANGE < CONFIG_ENV_SIZE) |
cc49cade | 208 | return 1; |
ea882baf | 209 | |
cd0f4fa1 | 210 | res = (char *)&env_new->data; |
be11235a | 211 | len = hexport_r(&env_htab, '\0', 0, &res, ENV_SIZE, 0, NULL); |
ea882baf WD |
212 | if (len < 0) { |
213 | error("Cannot export environment: errno = %d\n", errno); | |
214 | return 1; | |
215 | } | |
2b26201a PS |
216 | env_new->crc = crc32(0, env_new->data, ENV_SIZE); |
217 | #ifdef CONFIG_ENV_OFFSET_REDUND | |
218 | env_new->flags = ++env_flags; /* increase the serial */ | |
219 | env_idx = (gd->env_valid == 1); | |
220 | #endif | |
13a5695b | 221 | |
2b26201a PS |
222 | ret = erase_and_write_env(&location[env_idx], (u_char *)env_new); |
223 | #ifdef CONFIG_ENV_OFFSET_REDUND | |
224 | if (!ret) { | |
225 | /* preset other copy for next write */ | |
226 | gd->env_valid = gd->env_valid == 2 ? 1 : 2; | |
227 | return ret; | |
cc49cade | 228 | } |
13a5695b | 229 | |
2b26201a PS |
230 | env_idx = (env_idx + 1) & 1; |
231 | ret = erase_and_write_env(&location[env_idx], (u_char *)env_new); | |
232 | if (!ret) | |
233 | printf("Warning: primary env write failed," | |
234 | " redundancy is lost!\n"); | |
235 | #endif | |
236 | ||
addb2e16 | 237 | return ret; |
13a5695b WD |
238 | } |
239 | #endif /* CMD_SAVEENV */ | |
240 | ||
de152b9b | 241 | int readenv(size_t offset, u_char *buf) |
cc49cade | 242 | { |
0e8d1586 | 243 | size_t end = offset + CONFIG_ENV_RANGE; |
cc49cade | 244 | size_t amount_loaded = 0; |
c3db8c64 | 245 | size_t blocksize, len; |
cc49cade SW |
246 | u_char *char_ptr; |
247 | ||
248 | blocksize = nand_info[0].erasesize; | |
962ad59e MF |
249 | if (!blocksize) |
250 | return 1; | |
de152b9b | 251 | |
0e8d1586 | 252 | len = min(blocksize, CONFIG_ENV_SIZE); |
cc49cade | 253 | |
0e8d1586 | 254 | while (amount_loaded < CONFIG_ENV_SIZE && offset < end) { |
cc49cade SW |
255 | if (nand_block_isbad(&nand_info[0], offset)) { |
256 | offset += blocksize; | |
257 | } else { | |
258 | char_ptr = &buf[amount_loaded]; | |
de152b9b | 259 | if (nand_read_skip_bad(&nand_info[0], offset, |
c39d6a0e TR |
260 | &len, NULL, |
261 | nand_info[0].size, char_ptr)) | |
cc49cade | 262 | return 1; |
de152b9b | 263 | |
cc49cade | 264 | offset += blocksize; |
c3db8c64 | 265 | amount_loaded += len; |
cc49cade SW |
266 | } |
267 | } | |
de152b9b | 268 | |
0e8d1586 | 269 | if (amount_loaded != CONFIG_ENV_SIZE) |
cc49cade SW |
270 | return 1; |
271 | ||
272 | return 0; | |
273 | } | |
274 | ||
c9f7351b BG |
275 | #ifdef CONFIG_ENV_OFFSET_OOB |
276 | int get_nand_env_oob(nand_info_t *nand, unsigned long *result) | |
277 | { | |
278 | struct mtd_oob_ops ops; | |
de152b9b | 279 | uint32_t oob_buf[ENV_OFFSET_SIZE / sizeof(uint32_t)]; |
c9f7351b BG |
280 | int ret; |
281 | ||
de152b9b IG |
282 | ops.datbuf = NULL; |
283 | ops.mode = MTD_OOB_AUTO; | |
284 | ops.ooboffs = 0; | |
285 | ops.ooblen = ENV_OFFSET_SIZE; | |
286 | ops.oobbuf = (void *)oob_buf; | |
c9f7351b BG |
287 | |
288 | ret = nand->read_oob(nand, ENV_OFFSET_SIZE, &ops); | |
53504a27 SW |
289 | if (ret) { |
290 | printf("error reading OOB block 0\n"); | |
291 | return ret; | |
292 | } | |
c9f7351b | 293 | |
53504a27 SW |
294 | if (oob_buf[0] == ENV_OOB_MARKER) { |
295 | *result = oob_buf[1] * nand->erasesize; | |
296 | } else if (oob_buf[0] == ENV_OOB_MARKER_OLD) { | |
297 | *result = oob_buf[1]; | |
c9f7351b | 298 | } else { |
53504a27 SW |
299 | printf("No dynamic environment marker in OOB block 0\n"); |
300 | return -ENOENT; | |
c9f7351b | 301 | } |
53504a27 SW |
302 | |
303 | return 0; | |
c9f7351b BG |
304 | } |
305 | #endif | |
306 | ||
0e8d1586 | 307 | #ifdef CONFIG_ENV_OFFSET_REDUND |
ea882baf | 308 | void env_relocate_spec(void) |
e443c944 MK |
309 | { |
310 | #if !defined(ENV_IS_EMBEDDED) | |
b76a147b | 311 | int read1_fail = 0, read2_fail = 0; |
2770bcb2 | 312 | int crc1_ok = 0, crc2_ok = 0; |
ea882baf | 313 | env_t *ep, *tmp_env1, *tmp_env2; |
e443c944 | 314 | |
ea882baf WD |
315 | tmp_env1 = (env_t *)malloc(CONFIG_ENV_SIZE); |
316 | tmp_env2 = (env_t *)malloc(CONFIG_ENV_SIZE); | |
de152b9b | 317 | if (tmp_env1 == NULL || tmp_env2 == NULL) { |
15b86c3d | 318 | puts("Can't allocate buffers for environment\n"); |
ea882baf | 319 | set_default_env("!malloc() failed"); |
de152b9b | 320 | goto done; |
15b86c3d WD |
321 | } |
322 | ||
b76a147b PS |
323 | read1_fail = readenv(CONFIG_ENV_OFFSET, (u_char *) tmp_env1); |
324 | read2_fail = readenv(CONFIG_ENV_OFFSET_REDUND, (u_char *) tmp_env2); | |
ea882baf | 325 | |
b76a147b PS |
326 | if (read1_fail && read2_fail) |
327 | puts("*** Error - No Valid Environment Area found\n"); | |
328 | else if (read1_fail || read2_fail) | |
329 | puts("*** Warning - some problems detected " | |
330 | "reading environment; recovered successfully\n"); | |
e443c944 | 331 | |
a1eac57a PS |
332 | crc1_ok = !read1_fail && |
333 | (crc32(0, tmp_env1->data, ENV_SIZE) == tmp_env1->crc); | |
334 | crc2_ok = !read2_fail && | |
335 | (crc32(0, tmp_env2->data, ENV_SIZE) == tmp_env2->crc); | |
e443c944 | 336 | |
ea882baf | 337 | if (!crc1_ok && !crc2_ok) { |
ea882baf | 338 | set_default_env("!bad CRC"); |
de152b9b | 339 | goto done; |
ea882baf | 340 | } else if (crc1_ok && !crc2_ok) { |
e443c944 | 341 | gd->env_valid = 1; |
ea882baf | 342 | } else if (!crc1_ok && crc2_ok) { |
e443c944 | 343 | gd->env_valid = 2; |
ea882baf | 344 | } else { |
e443c944 | 345 | /* both ok - check serial */ |
ea882baf | 346 | if (tmp_env1->flags == 255 && tmp_env2->flags == 0) |
e443c944 | 347 | gd->env_valid = 2; |
ea882baf | 348 | else if (tmp_env2->flags == 255 && tmp_env1->flags == 0) |
e443c944 | 349 | gd->env_valid = 1; |
ea882baf | 350 | else if (tmp_env1->flags > tmp_env2->flags) |
e443c944 | 351 | gd->env_valid = 1; |
ea882baf | 352 | else if (tmp_env2->flags > tmp_env1->flags) |
e443c944 MK |
353 | gd->env_valid = 2; |
354 | else /* flags are equal - almost impossible */ | |
355 | gd->env_valid = 1; | |
e443c944 MK |
356 | } |
357 | ||
358 | free(env_ptr); | |
ea882baf WD |
359 | |
360 | if (gd->env_valid == 1) | |
361 | ep = tmp_env1; | |
362 | else | |
363 | ep = tmp_env2; | |
364 | ||
eef1d719 | 365 | env_flags = ep->flags; |
ea882baf WD |
366 | env_import((char *)ep, 0); |
367 | ||
de152b9b | 368 | done: |
ea882baf WD |
369 | free(tmp_env1); |
370 | free(tmp_env2); | |
e443c944 MK |
371 | |
372 | #endif /* ! ENV_IS_EMBEDDED */ | |
373 | } | |
0e8d1586 | 374 | #else /* ! CONFIG_ENV_OFFSET_REDUND */ |
addb2e16 | 375 | /* |
ea882baf WD |
376 | * The legacy NAND code saved the environment in the first NAND |
377 | * device i.e., nand_dev_desc + 0. This is also the behaviour using | |
378 | * the new NAND code. | |
addb2e16 | 379 | */ |
de152b9b | 380 | void env_relocate_spec(void) |
13a5695b WD |
381 | { |
382 | #if !defined(ENV_IS_EMBEDDED) | |
d52fb7e3 | 383 | int ret; |
cd0f4fa1 | 384 | ALLOC_CACHE_ALIGN_BUFFER(char, buf, CONFIG_ENV_SIZE); |
13a5695b | 385 | |
c9f7351b BG |
386 | #if defined(CONFIG_ENV_OFFSET_OOB) |
387 | ret = get_nand_env_oob(&nand_info[0], &nand_env_oob_offset); | |
ea882baf WD |
388 | /* |
389 | * If unable to read environment offset from NAND OOB then fall through | |
c9f7351b BG |
390 | * to the normal environment reading code below |
391 | */ | |
ea882baf | 392 | if (!ret) { |
c9f7351b | 393 | printf("Found Environment offset in OOB..\n"); |
ea882baf WD |
394 | } else { |
395 | set_default_env("!no env offset in OOB"); | |
396 | return; | |
397 | } | |
c9f7351b BG |
398 | #endif |
399 | ||
cd0f4fa1 | 400 | ret = readenv(CONFIG_ENV_OFFSET, (u_char *)buf); |
ea882baf WD |
401 | if (ret) { |
402 | set_default_env("!readenv() failed"); | |
403 | return; | |
404 | } | |
13a5695b | 405 | |
cd0f4fa1 | 406 | env_import(buf, 1); |
13a5695b | 407 | #endif /* ! ENV_IS_EMBEDDED */ |
13a5695b | 408 | } |
0e8d1586 | 409 | #endif /* CONFIG_ENV_OFFSET_REDUND */ |