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