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