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