]> git.ipfire.org Git - thirdparty/u-boot.git/blame - env/mmc.c
Merge git://git.denx.de/u-boot-mpc83xx
[thirdparty/u-boot.git] / env / mmc.c
CommitLineData
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
29DECLARE_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
36static 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
64static 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
101static 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
136static unsigned char env_mmc_orig_hwpart;
137
6e7b7df4
DL
138static 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
152static inline int mmc_set_env_part(struct mmc *mmc) {return 0; };
b9c8ccab
TR
153#endif
154
c75648d7 155static 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
175static 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
185static 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 199static 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
241fini:
242 fini_mmc_for_env(mmc);
243 return ret;
a8060359 244}
e5bce247 245#endif /* CONFIG_CMD_SAVEENV && !CONFIG_SPL_BUILD */
a8060359 246
e8db8f71
IG
247static 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 262static 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
297fini:
298 fini_mmc_for_env(mmc);
299err:
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 307static 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
338fini:
339 fini_mmc_for_env(mmc);
340err:
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
348U_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};