]>
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 | ||
b9c8ccab | 85 | #ifdef CONFIG_SYS_MMC_ENV_PART |
6e7b7df4 DL |
86 | __weak uint mmc_get_env_part(struct mmc *mmc) |
87 | { | |
88 | return CONFIG_SYS_MMC_ENV_PART; | |
89 | } | |
90 | ||
873cc1d7 SW |
91 | static unsigned char env_mmc_orig_hwpart; |
92 | ||
6e7b7df4 DL |
93 | static int mmc_set_env_part(struct mmc *mmc) |
94 | { | |
95 | uint part = mmc_get_env_part(mmc); | |
e92029c0 | 96 | int dev = mmc_get_env_dev(); |
6e7b7df4 | 97 | int ret = 0; |
b9c8ccab | 98 | |
69f45cd5 SG |
99 | env_mmc_orig_hwpart = mmc_get_blk_desc(mmc)->hwpart; |
100 | ret = blk_select_hwpart_devnum(IF_TYPE_MMC, dev, part); | |
873cc1d7 SW |
101 | if (ret) |
102 | puts("MMC partition switch failed\n"); | |
6e7b7df4 DL |
103 | |
104 | return ret; | |
105 | } | |
106 | #else | |
107 | static inline int mmc_set_env_part(struct mmc *mmc) {return 0; }; | |
b9c8ccab TR |
108 | #endif |
109 | ||
c75648d7 | 110 | static const char *init_mmc_for_env(struct mmc *mmc) |
6e7b7df4 | 111 | { |
c75648d7 | 112 | if (!mmc) |
a85da21f | 113 | return "!No MMC card found"; |
a8060359 | 114 | |
01b73fe6 SG |
115 | #ifdef CONFIG_BLK |
116 | struct udevice *dev; | |
117 | ||
118 | if (blk_get_from_parent(mmc->dev, &dev)) | |
119 | return "!No block device"; | |
120 | #else | |
c75648d7 | 121 | if (mmc_init(mmc)) |
a85da21f | 122 | return "!MMC init failed"; |
e7017a3c | 123 | #endif |
c75648d7 | 124 | if (mmc_set_env_part(mmc)) |
a85da21f | 125 | return "!MMC partition switch failed"; |
a8060359 | 126 | |
c75648d7 | 127 | return NULL; |
a8060359 TL |
128 | } |
129 | ||
9404a5fc SW |
130 | static void fini_mmc_for_env(struct mmc *mmc) |
131 | { | |
132 | #ifdef CONFIG_SYS_MMC_ENV_PART | |
e92029c0 | 133 | int dev = mmc_get_env_dev(); |
b9c8ccab | 134 | |
69f45cd5 | 135 | blk_select_hwpart_devnum(IF_TYPE_MMC, dev, env_mmc_orig_hwpart); |
9404a5fc SW |
136 | #endif |
137 | } | |
138 | ||
e5bce247 | 139 | #if defined(CONFIG_CMD_SAVEENV) && !defined(CONFIG_SPL_BUILD) |
e8db8f71 IG |
140 | static inline int write_env(struct mmc *mmc, unsigned long size, |
141 | unsigned long offset, const void *buffer) | |
a8060359 TL |
142 | { |
143 | uint blk_start, blk_cnt, n; | |
5461acba | 144 | struct blk_desc *desc = mmc_get_blk_desc(mmc); |
a8060359 | 145 | |
e8db8f71 IG |
146 | blk_start = ALIGN(offset, mmc->write_bl_len) / mmc->write_bl_len; |
147 | blk_cnt = ALIGN(size, mmc->write_bl_len) / mmc->write_bl_len; | |
a8060359 | 148 | |
5461acba | 149 | n = blk_dwrite(desc, blk_start, blk_cnt, (u_char *)buffer); |
a8060359 TL |
150 | |
151 | return (n == blk_cnt) ? 0 : -1; | |
152 | } | |
153 | ||
e5bce247 | 154 | static int env_mmc_save(void) |
a8060359 | 155 | { |
cd0f4fa1 | 156 | ALLOC_CACHE_ALIGN_BUFFER(env_t, env_new, 1); |
e92029c0 CG |
157 | int dev = mmc_get_env_dev(); |
158 | struct mmc *mmc = find_mmc_device(dev); | |
e8db8f71 | 159 | u32 offset; |
d196bd88 | 160 | int ret, copy = 0; |
c75648d7 | 161 | const char *errmsg; |
a8060359 | 162 | |
c75648d7 TH |
163 | errmsg = init_mmc_for_env(mmc); |
164 | if (errmsg) { | |
165 | printf("%s\n", errmsg); | |
97039ab9 | 166 | return 1; |
c75648d7 | 167 | } |
97039ab9 | 168 | |
7ce1526e MV |
169 | ret = env_export(env_new); |
170 | if (ret) | |
9404a5fc | 171 | goto fini; |
d196bd88 MH |
172 | |
173 | #ifdef CONFIG_ENV_OFFSET_REDUND | |
203e94f6 | 174 | if (gd->env_valid == ENV_VALID) |
d196bd88 MH |
175 | copy = 1; |
176 | #endif | |
177 | ||
178 | if (mmc_get_env_addr(mmc, copy, &offset)) { | |
179 | ret = 1; | |
180 | goto fini; | |
181 | } | |
182 | ||
e92029c0 | 183 | printf("Writing to %sMMC(%d)... ", copy ? "redundant " : "", dev); |
4036b630 | 184 | if (write_env(mmc, CONFIG_ENV_SIZE, offset, (u_char *)env_new)) { |
a8060359 | 185 | puts("failed\n"); |
9404a5fc SW |
186 | ret = 1; |
187 | goto fini; | |
a8060359 TL |
188 | } |
189 | ||
190 | puts("done\n"); | |
9404a5fc SW |
191 | ret = 0; |
192 | ||
d196bd88 | 193 | #ifdef CONFIG_ENV_OFFSET_REDUND |
203e94f6 | 194 | gd->env_valid = gd->env_valid == ENV_REDUND ? ENV_VALID : ENV_REDUND; |
d196bd88 MH |
195 | #endif |
196 | ||
9404a5fc SW |
197 | fini: |
198 | fini_mmc_for_env(mmc); | |
199 | return ret; | |
a8060359 | 200 | } |
e5bce247 | 201 | #endif /* CONFIG_CMD_SAVEENV && !CONFIG_SPL_BUILD */ |
a8060359 | 202 | |
e8db8f71 IG |
203 | static inline int read_env(struct mmc *mmc, unsigned long size, |
204 | unsigned long offset, const void *buffer) | |
a8060359 TL |
205 | { |
206 | uint blk_start, blk_cnt, n; | |
5461acba | 207 | struct blk_desc *desc = mmc_get_blk_desc(mmc); |
a8060359 | 208 | |
e8db8f71 IG |
209 | blk_start = ALIGN(offset, mmc->read_bl_len) / mmc->read_bl_len; |
210 | blk_cnt = ALIGN(size, mmc->read_bl_len) / mmc->read_bl_len; | |
a8060359 | 211 | |
5461acba | 212 | n = blk_dread(desc, blk_start, blk_cnt, (uchar *)buffer); |
a8060359 TL |
213 | |
214 | return (n == blk_cnt) ? 0 : -1; | |
215 | } | |
216 | ||
d196bd88 | 217 | #ifdef CONFIG_ENV_OFFSET_REDUND |
e5bce247 | 218 | static void env_mmc_load(void) |
d196bd88 MH |
219 | { |
220 | #if !defined(ENV_IS_EMBEDDED) | |
b9c8ccab | 221 | struct mmc *mmc; |
d196bd88 MH |
222 | u32 offset1, offset2; |
223 | int read1_fail = 0, read2_fail = 0; | |
d196bd88 | 224 | int ret; |
e92029c0 | 225 | int dev = mmc_get_env_dev(); |
c75648d7 | 226 | const char *errmsg = NULL; |
d196bd88 | 227 | |
452a2722 MN |
228 | ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env1, 1); |
229 | ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env2, 1); | |
230 | ||
b9c8ccab TR |
231 | mmc = find_mmc_device(dev); |
232 | ||
c75648d7 TH |
233 | errmsg = init_mmc_for_env(mmc); |
234 | if (errmsg) { | |
d196bd88 MH |
235 | ret = 1; |
236 | goto err; | |
237 | } | |
238 | ||
239 | if (mmc_get_env_addr(mmc, 0, &offset1) || | |
240 | mmc_get_env_addr(mmc, 1, &offset2)) { | |
241 | ret = 1; | |
242 | goto fini; | |
243 | } | |
244 | ||
245 | read1_fail = read_env(mmc, CONFIG_ENV_SIZE, offset1, tmp_env1); | |
246 | read2_fail = read_env(mmc, CONFIG_ENV_SIZE, offset2, tmp_env2); | |
247 | ||
248 | if (read1_fail && read2_fail) | |
249 | puts("*** Error - No Valid Environment Area found\n"); | |
250 | else if (read1_fail || read2_fail) | |
251 | puts("*** Warning - some problems detected " | |
252 | "reading environment; recovered successfully\n"); | |
253 | ||
9d364af2 | 254 | if (read1_fail && read2_fail) { |
c75648d7 | 255 | errmsg = "!bad CRC"; |
d196bd88 MH |
256 | ret = 1; |
257 | goto fini; | |
9d364af2 | 258 | } else if (!read1_fail && read2_fail) { |
203e94f6 | 259 | gd->env_valid = ENV_VALID; |
9d364af2 FA |
260 | env_import((char *)tmp_env1, 1); |
261 | } else if (read1_fail && !read2_fail) { | |
203e94f6 | 262 | gd->env_valid = ENV_REDUND; |
9d364af2 | 263 | env_import((char *)tmp_env2, 1); |
d196bd88 | 264 | } else { |
9d364af2 | 265 | env_import_redund((char *)tmp_env1, (char *)tmp_env2); |
d196bd88 MH |
266 | } |
267 | ||
d196bd88 MH |
268 | ret = 0; |
269 | ||
270 | fini: | |
271 | fini_mmc_for_env(mmc); | |
272 | err: | |
273 | if (ret) | |
c75648d7 | 274 | set_default_env(errmsg); |
d196bd88 MH |
275 | #endif |
276 | } | |
277 | #else /* ! CONFIG_ENV_OFFSET_REDUND */ | |
e5bce247 | 278 | static void env_mmc_load(void) |
a8060359 TL |
279 | { |
280 | #if !defined(ENV_IS_EMBEDDED) | |
cd0f4fa1 | 281 | ALLOC_CACHE_ALIGN_BUFFER(char, buf, CONFIG_ENV_SIZE); |
b9c8ccab | 282 | struct mmc *mmc; |
97039ab9 | 283 | u32 offset; |
9404a5fc | 284 | int ret; |
e92029c0 | 285 | int dev = mmc_get_env_dev(); |
c75648d7 | 286 | const char *errmsg; |
b9c8ccab | 287 | |
b9c8ccab | 288 | mmc = find_mmc_device(dev); |
a8060359 | 289 | |
c75648d7 TH |
290 | errmsg = init_mmc_for_env(mmc); |
291 | if (errmsg) { | |
9404a5fc SW |
292 | ret = 1; |
293 | goto err; | |
294 | } | |
a8060359 | 295 | |
d196bd88 | 296 | if (mmc_get_env_addr(mmc, 0, &offset)) { |
9404a5fc SW |
297 | ret = 1; |
298 | goto fini; | |
299 | } | |
300 | ||
cd0f4fa1 | 301 | if (read_env(mmc, CONFIG_ENV_SIZE, offset, buf)) { |
c75648d7 | 302 | errmsg = "!read failed"; |
9404a5fc SW |
303 | ret = 1; |
304 | goto fini; | |
305 | } | |
a8060359 | 306 | |
cd0f4fa1 | 307 | env_import(buf, 1); |
9404a5fc SW |
308 | ret = 0; |
309 | ||
310 | fini: | |
311 | fini_mmc_for_env(mmc); | |
312 | err: | |
313 | if (ret) | |
c75648d7 | 314 | set_default_env(errmsg); |
a8060359 TL |
315 | #endif |
316 | } | |
d196bd88 | 317 | #endif /* CONFIG_ENV_OFFSET_REDUND */ |
4415f1d1 SG |
318 | |
319 | U_BOOT_ENV_LOCATION(mmc) = { | |
320 | .location = ENVL_MMC, | |
e5bce247 | 321 | .load = env_mmc_load, |
4415f1d1 | 322 | #ifndef CONFIG_SPL_BUILD |
e5bce247 | 323 | .save = env_save_ptr(env_mmc_save), |
4415f1d1 | 324 | #endif |
4415f1d1 | 325 | }; |