]>
Commit | Line | Data |
---|---|---|
a8060359 | 1 | /* |
97039ab9 | 2 | * (C) Copyright 2008-2011 Freescale Semiconductor, Inc. |
a8060359 | 3 | * |
3765b3e7 | 4 | * SPDX-License-Identifier: GPL-2.0+ |
a8060359 TL |
5 | */ |
6 | ||
7 | /* #define DEBUG */ | |
8 | ||
9 | #include <common.h> | |
10 | ||
11 | #include <command.h> | |
12 | #include <environment.h> | |
f8b8a554 | 13 | #include <fdtdec.h> |
a8060359 TL |
14 | #include <linux/stddef.h> |
15 | #include <malloc.h> | |
cf92e05c | 16 | #include <memalign.h> |
a8060359 | 17 | #include <mmc.h> |
6d1d51b3 | 18 | #include <search.h> |
e79f4839 | 19 | #include <errno.h> |
a8060359 | 20 | |
d196bd88 MH |
21 | #if defined(CONFIG_ENV_SIZE_REDUND) && \ |
22 | (CONFIG_ENV_SIZE_REDUND != CONFIG_ENV_SIZE) | |
23 | #error CONFIG_ENV_SIZE_REDUND should be the same as CONFIG_ENV_SIZE | |
24 | #endif | |
25 | ||
a8060359 TL |
26 | char *env_name_spec = "MMC"; |
27 | ||
28 | #ifdef ENV_IS_EMBEDDED | |
994bc671 | 29 | env_t *env_ptr = &environment; |
a8060359 | 30 | #else /* ! ENV_IS_EMBEDDED */ |
e8db8f71 | 31 | env_t *env_ptr; |
a8060359 TL |
32 | #endif /* ENV_IS_EMBEDDED */ |
33 | ||
a8060359 TL |
34 | DECLARE_GLOBAL_DATA_PTR; |
35 | ||
97039ab9 MH |
36 | #if !defined(CONFIG_ENV_OFFSET) |
37 | #define CONFIG_ENV_OFFSET 0 | |
38 | #endif | |
39 | ||
f8b8a554 PT |
40 | #if CONFIG_IS_ENABLED(OF_CONTROL) |
41 | static inline s64 mmc_offset(int copy) | |
42 | { | |
43 | const char *propname = "u-boot,mmc-env-offset"; | |
44 | s64 defvalue = CONFIG_ENV_OFFSET; | |
45 | ||
46 | #if defined(CONFIG_ENV_OFFSET_REDUND) | |
47 | if (copy) { | |
48 | propname = "u-boot,mmc-env-offset-redundant"; | |
49 | defvalue = CONFIG_ENV_OFFSET_REDUND; | |
50 | } | |
51 | #endif | |
52 | ||
53 | return fdtdec_get_config_int(gd->fdt_blob, propname, defvalue); | |
54 | } | |
55 | #else | |
56 | static inline s64 mmc_offset(int copy) | |
97039ab9 | 57 | { |
f8b8a554 | 58 | s64 offset = CONFIG_ENV_OFFSET; |
5c088ee8 | 59 | |
f8b8a554 | 60 | #if defined(CONFIG_ENV_OFFSET_REDUND) |
d196bd88 | 61 | if (copy) |
5c088ee8 | 62 | offset = CONFIG_ENV_OFFSET_REDUND; |
d196bd88 | 63 | #endif |
f8b8a554 PT |
64 | return offset; |
65 | } | |
66 | #endif | |
67 | ||
68 | __weak int mmc_get_env_addr(struct mmc *mmc, int copy, u32 *env_addr) | |
69 | { | |
70 | s64 offset = mmc_offset(copy); | |
5c088ee8 SW |
71 | |
72 | if (offset < 0) | |
73 | offset += mmc->capacity; | |
74 | ||
75 | *env_addr = offset; | |
76 | ||
97039ab9 MH |
77 | return 0; |
78 | } | |
97039ab9 | 79 | |
e92029c0 CG |
80 | __weak int mmc_get_env_dev(void) |
81 | { | |
82 | return CONFIG_SYS_MMC_ENV_DEV; | |
83 | } | |
84 | ||
a8060359 TL |
85 | int env_init(void) |
86 | { | |
87 | /* use default */ | |
e8db8f71 IG |
88 | gd->env_addr = (ulong)&default_environment[0]; |
89 | gd->env_valid = 1; | |
a8060359 TL |
90 | |
91 | return 0; | |
92 | } | |
93 | ||
b9c8ccab | 94 | #ifdef CONFIG_SYS_MMC_ENV_PART |
6e7b7df4 DL |
95 | __weak uint mmc_get_env_part(struct mmc *mmc) |
96 | { | |
97 | return CONFIG_SYS_MMC_ENV_PART; | |
98 | } | |
99 | ||
873cc1d7 SW |
100 | static unsigned char env_mmc_orig_hwpart; |
101 | ||
6e7b7df4 DL |
102 | static int mmc_set_env_part(struct mmc *mmc) |
103 | { | |
104 | uint part = mmc_get_env_part(mmc); | |
e92029c0 | 105 | int dev = mmc_get_env_dev(); |
6e7b7df4 | 106 | int ret = 0; |
b9c8ccab | 107 | |
69f45cd5 SG |
108 | env_mmc_orig_hwpart = mmc_get_blk_desc(mmc)->hwpart; |
109 | ret = blk_select_hwpart_devnum(IF_TYPE_MMC, dev, part); | |
873cc1d7 SW |
110 | if (ret) |
111 | puts("MMC partition switch failed\n"); | |
6e7b7df4 DL |
112 | |
113 | return ret; | |
114 | } | |
115 | #else | |
116 | static inline int mmc_set_env_part(struct mmc *mmc) {return 0; }; | |
b9c8ccab TR |
117 | #endif |
118 | ||
c75648d7 | 119 | static const char *init_mmc_for_env(struct mmc *mmc) |
6e7b7df4 | 120 | { |
c75648d7 | 121 | if (!mmc) |
a85da21f | 122 | return "!No MMC card found"; |
a8060359 | 123 | |
e7017a3c | 124 | #ifndef CONFIG_BLK |
c75648d7 | 125 | if (mmc_init(mmc)) |
a85da21f | 126 | return "!MMC init failed"; |
e7017a3c | 127 | #endif |
c75648d7 | 128 | if (mmc_set_env_part(mmc)) |
a85da21f | 129 | return "!MMC partition switch failed"; |
a8060359 | 130 | |
c75648d7 | 131 | return NULL; |
a8060359 TL |
132 | } |
133 | ||
9404a5fc SW |
134 | static void fini_mmc_for_env(struct mmc *mmc) |
135 | { | |
136 | #ifdef CONFIG_SYS_MMC_ENV_PART | |
e92029c0 | 137 | int dev = mmc_get_env_dev(); |
b9c8ccab | 138 | |
69f45cd5 | 139 | blk_select_hwpart_devnum(IF_TYPE_MMC, dev, env_mmc_orig_hwpart); |
9404a5fc SW |
140 | #endif |
141 | } | |
142 | ||
a8060359 | 143 | #ifdef CONFIG_CMD_SAVEENV |
e8db8f71 IG |
144 | static inline int write_env(struct mmc *mmc, unsigned long size, |
145 | unsigned long offset, const void *buffer) | |
a8060359 TL |
146 | { |
147 | uint blk_start, blk_cnt, n; | |
5461acba | 148 | struct blk_desc *desc = mmc_get_blk_desc(mmc); |
a8060359 | 149 | |
e8db8f71 IG |
150 | blk_start = ALIGN(offset, mmc->write_bl_len) / mmc->write_bl_len; |
151 | blk_cnt = ALIGN(size, mmc->write_bl_len) / mmc->write_bl_len; | |
a8060359 | 152 | |
5461acba | 153 | n = blk_dwrite(desc, blk_start, blk_cnt, (u_char *)buffer); |
a8060359 TL |
154 | |
155 | return (n == blk_cnt) ? 0 : -1; | |
156 | } | |
157 | ||
d196bd88 MH |
158 | #ifdef CONFIG_ENV_OFFSET_REDUND |
159 | static unsigned char env_flags; | |
160 | #endif | |
161 | ||
a8060359 TL |
162 | int saveenv(void) |
163 | { | |
cd0f4fa1 | 164 | ALLOC_CACHE_ALIGN_BUFFER(env_t, env_new, 1); |
e92029c0 CG |
165 | int dev = mmc_get_env_dev(); |
166 | struct mmc *mmc = find_mmc_device(dev); | |
e8db8f71 | 167 | u32 offset; |
d196bd88 | 168 | int ret, copy = 0; |
c75648d7 | 169 | const char *errmsg; |
a8060359 | 170 | |
c75648d7 TH |
171 | errmsg = init_mmc_for_env(mmc); |
172 | if (errmsg) { | |
173 | printf("%s\n", errmsg); | |
97039ab9 | 174 | return 1; |
c75648d7 | 175 | } |
97039ab9 | 176 | |
7ce1526e MV |
177 | ret = env_export(env_new); |
178 | if (ret) | |
9404a5fc | 179 | goto fini; |
d196bd88 MH |
180 | |
181 | #ifdef CONFIG_ENV_OFFSET_REDUND | |
182 | env_new->flags = ++env_flags; /* increase the serial */ | |
183 | ||
184 | if (gd->env_valid == 1) | |
185 | copy = 1; | |
186 | #endif | |
187 | ||
188 | if (mmc_get_env_addr(mmc, copy, &offset)) { | |
189 | ret = 1; | |
190 | goto fini; | |
191 | } | |
192 | ||
e92029c0 | 193 | printf("Writing to %sMMC(%d)... ", copy ? "redundant " : "", dev); |
4036b630 | 194 | if (write_env(mmc, CONFIG_ENV_SIZE, offset, (u_char *)env_new)) { |
a8060359 | 195 | puts("failed\n"); |
9404a5fc SW |
196 | ret = 1; |
197 | goto fini; | |
a8060359 TL |
198 | } |
199 | ||
200 | puts("done\n"); | |
9404a5fc SW |
201 | ret = 0; |
202 | ||
d196bd88 MH |
203 | #ifdef CONFIG_ENV_OFFSET_REDUND |
204 | gd->env_valid = gd->env_valid == 2 ? 1 : 2; | |
205 | #endif | |
206 | ||
9404a5fc SW |
207 | fini: |
208 | fini_mmc_for_env(mmc); | |
209 | return ret; | |
a8060359 TL |
210 | } |
211 | #endif /* CONFIG_CMD_SAVEENV */ | |
212 | ||
e8db8f71 IG |
213 | static inline int read_env(struct mmc *mmc, unsigned long size, |
214 | unsigned long offset, const void *buffer) | |
a8060359 TL |
215 | { |
216 | uint blk_start, blk_cnt, n; | |
5461acba | 217 | struct blk_desc *desc = mmc_get_blk_desc(mmc); |
a8060359 | 218 | |
e8db8f71 IG |
219 | blk_start = ALIGN(offset, mmc->read_bl_len) / mmc->read_bl_len; |
220 | blk_cnt = ALIGN(size, mmc->read_bl_len) / mmc->read_bl_len; | |
a8060359 | 221 | |
5461acba | 222 | n = blk_dread(desc, blk_start, blk_cnt, (uchar *)buffer); |
a8060359 TL |
223 | |
224 | return (n == blk_cnt) ? 0 : -1; | |
225 | } | |
226 | ||
d196bd88 MH |
227 | #ifdef CONFIG_ENV_OFFSET_REDUND |
228 | void env_relocate_spec(void) | |
229 | { | |
230 | #if !defined(ENV_IS_EMBEDDED) | |
b9c8ccab | 231 | struct mmc *mmc; |
d196bd88 MH |
232 | u32 offset1, offset2; |
233 | int read1_fail = 0, read2_fail = 0; | |
234 | int crc1_ok = 0, crc2_ok = 0; | |
452a2722 | 235 | env_t *ep; |
d196bd88 | 236 | int ret; |
e92029c0 | 237 | int dev = mmc_get_env_dev(); |
c75648d7 | 238 | const char *errmsg = NULL; |
d196bd88 | 239 | |
452a2722 MN |
240 | ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env1, 1); |
241 | ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env2, 1); | |
242 | ||
b9c8ccab TR |
243 | mmc = find_mmc_device(dev); |
244 | ||
c75648d7 TH |
245 | errmsg = init_mmc_for_env(mmc); |
246 | if (errmsg) { | |
d196bd88 MH |
247 | ret = 1; |
248 | goto err; | |
249 | } | |
250 | ||
251 | if (mmc_get_env_addr(mmc, 0, &offset1) || | |
252 | mmc_get_env_addr(mmc, 1, &offset2)) { | |
253 | ret = 1; | |
254 | goto fini; | |
255 | } | |
256 | ||
257 | read1_fail = read_env(mmc, CONFIG_ENV_SIZE, offset1, tmp_env1); | |
258 | read2_fail = read_env(mmc, CONFIG_ENV_SIZE, offset2, tmp_env2); | |
259 | ||
260 | if (read1_fail && read2_fail) | |
261 | puts("*** Error - No Valid Environment Area found\n"); | |
262 | else if (read1_fail || read2_fail) | |
263 | puts("*** Warning - some problems detected " | |
264 | "reading environment; recovered successfully\n"); | |
265 | ||
266 | crc1_ok = !read1_fail && | |
267 | (crc32(0, tmp_env1->data, ENV_SIZE) == tmp_env1->crc); | |
268 | crc2_ok = !read2_fail && | |
269 | (crc32(0, tmp_env2->data, ENV_SIZE) == tmp_env2->crc); | |
270 | ||
271 | if (!crc1_ok && !crc2_ok) { | |
c75648d7 | 272 | errmsg = "!bad CRC"; |
d196bd88 MH |
273 | ret = 1; |
274 | goto fini; | |
275 | } else if (crc1_ok && !crc2_ok) { | |
276 | gd->env_valid = 1; | |
277 | } else if (!crc1_ok && crc2_ok) { | |
278 | gd->env_valid = 2; | |
279 | } else { | |
280 | /* both ok - check serial */ | |
281 | if (tmp_env1->flags == 255 && tmp_env2->flags == 0) | |
282 | gd->env_valid = 2; | |
283 | else if (tmp_env2->flags == 255 && tmp_env1->flags == 0) | |
284 | gd->env_valid = 1; | |
285 | else if (tmp_env1->flags > tmp_env2->flags) | |
286 | gd->env_valid = 1; | |
287 | else if (tmp_env2->flags > tmp_env1->flags) | |
288 | gd->env_valid = 2; | |
289 | else /* flags are equal - almost impossible */ | |
290 | gd->env_valid = 1; | |
291 | } | |
292 | ||
293 | free(env_ptr); | |
294 | ||
295 | if (gd->env_valid == 1) | |
296 | ep = tmp_env1; | |
297 | else | |
298 | ep = tmp_env2; | |
299 | ||
300 | env_flags = ep->flags; | |
301 | env_import((char *)ep, 0); | |
302 | ret = 0; | |
303 | ||
304 | fini: | |
305 | fini_mmc_for_env(mmc); | |
306 | err: | |
307 | if (ret) | |
c75648d7 | 308 | set_default_env(errmsg); |
d196bd88 MH |
309 | #endif |
310 | } | |
311 | #else /* ! CONFIG_ENV_OFFSET_REDUND */ | |
a8060359 TL |
312 | void env_relocate_spec(void) |
313 | { | |
314 | #if !defined(ENV_IS_EMBEDDED) | |
cd0f4fa1 | 315 | ALLOC_CACHE_ALIGN_BUFFER(char, buf, CONFIG_ENV_SIZE); |
b9c8ccab | 316 | struct mmc *mmc; |
97039ab9 | 317 | u32 offset; |
9404a5fc | 318 | int ret; |
e92029c0 | 319 | int dev = mmc_get_env_dev(); |
c75648d7 | 320 | const char *errmsg; |
b9c8ccab | 321 | |
b9c8ccab | 322 | mmc = find_mmc_device(dev); |
a8060359 | 323 | |
c75648d7 TH |
324 | errmsg = init_mmc_for_env(mmc); |
325 | if (errmsg) { | |
9404a5fc SW |
326 | ret = 1; |
327 | goto err; | |
328 | } | |
a8060359 | 329 | |
d196bd88 | 330 | if (mmc_get_env_addr(mmc, 0, &offset)) { |
9404a5fc SW |
331 | ret = 1; |
332 | goto fini; | |
333 | } | |
334 | ||
cd0f4fa1 | 335 | if (read_env(mmc, CONFIG_ENV_SIZE, offset, buf)) { |
c75648d7 | 336 | errmsg = "!read failed"; |
9404a5fc SW |
337 | ret = 1; |
338 | goto fini; | |
339 | } | |
a8060359 | 340 | |
cd0f4fa1 | 341 | env_import(buf, 1); |
9404a5fc SW |
342 | ret = 0; |
343 | ||
344 | fini: | |
345 | fini_mmc_for_env(mmc); | |
346 | err: | |
347 | if (ret) | |
c75648d7 | 348 | set_default_env(errmsg); |
a8060359 TL |
349 | #endif |
350 | } | |
d196bd88 | 351 | #endif /* CONFIG_ENV_OFFSET_REDUND */ |