blob: 15aa43d5e1628bcc0ab8508c0b36922565bc06f3 [file] [log] [blame]
Terry Lva8060352010-05-17 10:57:01 +08001/*
Mingkai Hu97039ab2011-01-24 17:09:55 +00002 * (C) Copyright 2008-2011 Freescale Semiconductor, Inc.
Terry Lva8060352010-05-17 10:57:01 +08003 *
Wolfgang Denk3765b3e2013-10-07 13:07:26 +02004 * SPDX-License-Identifier: GPL-2.0+
Terry Lva8060352010-05-17 10:57:01 +08005 */
6
7/* #define DEBUG */
8
9#include <common.h>
10
11#include <command.h>
12#include <environment.h>
13#include <linux/stddef.h>
14#include <malloc.h>
Simon Glasscf92e052015-09-02 17:24:58 -060015#include <memalign.h>
Terry Lva8060352010-05-17 10:57:01 +080016#include <mmc.h>
Lei Wen6d1d51b2010-11-10 07:39:23 +080017#include <search.h>
Lei Wene79f4832010-10-13 11:07:21 +080018#include <errno.h>
Terry Lva8060352010-05-17 10:57:01 +080019
Michael Heimpoldd196bd82013-04-10 10:36:19 +000020#if defined(CONFIG_ENV_SIZE_REDUND) && \
21 (CONFIG_ENV_SIZE_REDUND != CONFIG_ENV_SIZE)
22#error CONFIG_ENV_SIZE_REDUND should be the same as CONFIG_ENV_SIZE
23#endif
24
Terry Lva8060352010-05-17 10:57:01 +080025char *env_name_spec = "MMC";
26
27#ifdef ENV_IS_EMBEDDED
Igor Grinberg994bc672011-11-17 06:07:23 +000028env_t *env_ptr = &environment;
Terry Lva8060352010-05-17 10:57:01 +080029#else /* ! ENV_IS_EMBEDDED */
Igor Grinberge8db8f72011-11-07 01:14:05 +000030env_t *env_ptr;
Terry Lva8060352010-05-17 10:57:01 +080031#endif /* ENV_IS_EMBEDDED */
32
Terry Lva8060352010-05-17 10:57:01 +080033DECLARE_GLOBAL_DATA_PTR;
34
Mingkai Hu97039ab2011-01-24 17:09:55 +000035#if !defined(CONFIG_ENV_OFFSET)
36#define CONFIG_ENV_OFFSET 0
37#endif
38
Michael Heimpoldd196bd82013-04-10 10:36:19 +000039__weak int mmc_get_env_addr(struct mmc *mmc, int copy, u32 *env_addr)
Mingkai Hu97039ab2011-01-24 17:09:55 +000040{
Stephen Warren5c088ee2013-06-11 15:14:02 -060041 s64 offset;
42
43 offset = CONFIG_ENV_OFFSET;
Michael Heimpoldd196bd82013-04-10 10:36:19 +000044#ifdef CONFIG_ENV_OFFSET_REDUND
45 if (copy)
Stephen Warren5c088ee2013-06-11 15:14:02 -060046 offset = CONFIG_ENV_OFFSET_REDUND;
Michael Heimpoldd196bd82013-04-10 10:36:19 +000047#endif
Stephen Warren5c088ee2013-06-11 15:14:02 -060048
49 if (offset < 0)
50 offset += mmc->capacity;
51
52 *env_addr = offset;
53
Mingkai Hu97039ab2011-01-24 17:09:55 +000054 return 0;
55}
Mingkai Hu97039ab2011-01-24 17:09:55 +000056
Terry Lva8060352010-05-17 10:57:01 +080057int env_init(void)
58{
59 /* use default */
Igor Grinberge8db8f72011-11-07 01:14:05 +000060 gd->env_addr = (ulong)&default_environment[0];
61 gd->env_valid = 1;
Terry Lva8060352010-05-17 10:57:01 +080062
63 return 0;
64}
65
Tom Rinib9c8cca2014-03-28 12:03:34 -040066#ifdef CONFIG_SYS_MMC_ENV_PART
Dmitry Lifshitz6e7b7df2014-07-30 13:19:06 +030067__weak uint mmc_get_env_part(struct mmc *mmc)
68{
69 return CONFIG_SYS_MMC_ENV_PART;
70}
71
Stephen Warren873cc1d2015-12-07 11:38:49 -070072static unsigned char env_mmc_orig_hwpart;
73
Dmitry Lifshitz6e7b7df2014-07-30 13:19:06 +030074static int mmc_set_env_part(struct mmc *mmc)
75{
76 uint part = mmc_get_env_part(mmc);
Tom Rinib9c8cca2014-03-28 12:03:34 -040077 int dev = CONFIG_SYS_MMC_ENV_DEV;
Dmitry Lifshitz6e7b7df2014-07-30 13:19:06 +030078 int ret = 0;
Tom Rinib9c8cca2014-03-28 12:03:34 -040079
80#ifdef CONFIG_SPL_BUILD
81 dev = 0;
82#endif
Dmitry Lifshitz6e7b7df2014-07-30 13:19:06 +030083
Stephen Warren873cc1d2015-12-07 11:38:49 -070084 env_mmc_orig_hwpart = mmc->block_dev.hwpart;
85 ret = mmc_select_hwpart(dev, part);
86 if (ret)
87 puts("MMC partition switch failed\n");
Dmitry Lifshitz6e7b7df2014-07-30 13:19:06 +030088
89 return ret;
90}
91#else
92static inline int mmc_set_env_part(struct mmc *mmc) {return 0; };
Tom Rinib9c8cca2014-03-28 12:03:34 -040093#endif
94
Tim Harveyc75648d2015-05-08 14:52:09 -070095static const char *init_mmc_for_env(struct mmc *mmc)
Dmitry Lifshitz6e7b7df2014-07-30 13:19:06 +030096{
Tim Harveyc75648d2015-05-08 14:52:09 -070097 if (!mmc)
Hans de Goedea85da212015-08-15 20:05:01 +020098 return "!No MMC card found";
Terry Lva8060352010-05-17 10:57:01 +080099
Tim Harveyc75648d2015-05-08 14:52:09 -0700100 if (mmc_init(mmc))
Hans de Goedea85da212015-08-15 20:05:01 +0200101 return "!MMC init failed";
Terry Lva8060352010-05-17 10:57:01 +0800102
Tim Harveyc75648d2015-05-08 14:52:09 -0700103 if (mmc_set_env_part(mmc))
Hans de Goedea85da212015-08-15 20:05:01 +0200104 return "!MMC partition switch failed";
Tim Harveyc75648d2015-05-08 14:52:09 -0700105
106 return NULL;
Terry Lva8060352010-05-17 10:57:01 +0800107}
108
Stephen Warren9404a5f2012-07-30 10:55:44 +0000109static void fini_mmc_for_env(struct mmc *mmc)
110{
111#ifdef CONFIG_SYS_MMC_ENV_PART
Tom Rinib9c8cca2014-03-28 12:03:34 -0400112 int dev = CONFIG_SYS_MMC_ENV_DEV;
113
114#ifdef CONFIG_SPL_BUILD
115 dev = 0;
116#endif
Stephen Warren873cc1d2015-12-07 11:38:49 -0700117 mmc_select_hwpart(dev, env_mmc_orig_hwpart);
Stephen Warren9404a5f2012-07-30 10:55:44 +0000118#endif
119}
120
Terry Lva8060352010-05-17 10:57:01 +0800121#ifdef CONFIG_CMD_SAVEENV
Igor Grinberge8db8f72011-11-07 01:14:05 +0000122static inline int write_env(struct mmc *mmc, unsigned long size,
123 unsigned long offset, const void *buffer)
Terry Lva8060352010-05-17 10:57:01 +0800124{
125 uint blk_start, blk_cnt, n;
126
Igor Grinberge8db8f72011-11-07 01:14:05 +0000127 blk_start = ALIGN(offset, mmc->write_bl_len) / mmc->write_bl_len;
128 blk_cnt = ALIGN(size, mmc->write_bl_len) / mmc->write_bl_len;
Terry Lva8060352010-05-17 10:57:01 +0800129
Stephen Warren7c4213f2015-12-07 11:38:48 -0700130 n = mmc->block_dev.block_write(&mmc->block_dev, blk_start,
Terry Lva8060352010-05-17 10:57:01 +0800131 blk_cnt, (u_char *)buffer);
132
133 return (n == blk_cnt) ? 0 : -1;
134}
135
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000136#ifdef CONFIG_ENV_OFFSET_REDUND
137static unsigned char env_flags;
138#endif
139
Terry Lva8060352010-05-17 10:57:01 +0800140int saveenv(void)
141{
Tom Rinicd0f4fa2013-04-05 14:55:21 -0400142 ALLOC_CACHE_ALIGN_BUFFER(env_t, env_new, 1);
Terry Lva8060352010-05-17 10:57:01 +0800143 struct mmc *mmc = find_mmc_device(CONFIG_SYS_MMC_ENV_DEV);
Igor Grinberge8db8f72011-11-07 01:14:05 +0000144 u32 offset;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000145 int ret, copy = 0;
Tim Harveyc75648d2015-05-08 14:52:09 -0700146 const char *errmsg;
Terry Lva8060352010-05-17 10:57:01 +0800147
Tim Harveyc75648d2015-05-08 14:52:09 -0700148 errmsg = init_mmc_for_env(mmc);
149 if (errmsg) {
150 printf("%s\n", errmsg);
Mingkai Hu97039ab2011-01-24 17:09:55 +0000151 return 1;
Tim Harveyc75648d2015-05-08 14:52:09 -0700152 }
Mingkai Hu97039ab2011-01-24 17:09:55 +0000153
Marek Vasut7ce15262014-03-05 19:59:50 +0100154 ret = env_export(env_new);
155 if (ret)
Stephen Warren9404a5f2012-07-30 10:55:44 +0000156 goto fini;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000157
158#ifdef CONFIG_ENV_OFFSET_REDUND
159 env_new->flags = ++env_flags; /* increase the serial */
160
161 if (gd->env_valid == 1)
162 copy = 1;
163#endif
164
165 if (mmc_get_env_addr(mmc, copy, &offset)) {
166 ret = 1;
167 goto fini;
168 }
169
170 printf("Writing to %sMMC(%d)... ", copy ? "redundant " : "",
171 CONFIG_SYS_MMC_ENV_DEV);
Stephen Warren4036b632012-05-24 11:38:33 +0000172 if (write_env(mmc, CONFIG_ENV_SIZE, offset, (u_char *)env_new)) {
Terry Lva8060352010-05-17 10:57:01 +0800173 puts("failed\n");
Stephen Warren9404a5f2012-07-30 10:55:44 +0000174 ret = 1;
175 goto fini;
Terry Lva8060352010-05-17 10:57:01 +0800176 }
177
178 puts("done\n");
Stephen Warren9404a5f2012-07-30 10:55:44 +0000179 ret = 0;
180
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000181#ifdef CONFIG_ENV_OFFSET_REDUND
182 gd->env_valid = gd->env_valid == 2 ? 1 : 2;
183#endif
184
Stephen Warren9404a5f2012-07-30 10:55:44 +0000185fini:
186 fini_mmc_for_env(mmc);
187 return ret;
Terry Lva8060352010-05-17 10:57:01 +0800188}
189#endif /* CONFIG_CMD_SAVEENV */
190
Igor Grinberge8db8f72011-11-07 01:14:05 +0000191static inline int read_env(struct mmc *mmc, unsigned long size,
192 unsigned long offset, const void *buffer)
Terry Lva8060352010-05-17 10:57:01 +0800193{
194 uint blk_start, blk_cnt, n;
195
Igor Grinberge8db8f72011-11-07 01:14:05 +0000196 blk_start = ALIGN(offset, mmc->read_bl_len) / mmc->read_bl_len;
197 blk_cnt = ALIGN(size, mmc->read_bl_len) / mmc->read_bl_len;
Terry Lva8060352010-05-17 10:57:01 +0800198
Stephen Warren7c4213f2015-12-07 11:38:48 -0700199 n = mmc->block_dev.block_read(&mmc->block_dev, blk_start, blk_cnt,
200 (uchar *)buffer);
Terry Lva8060352010-05-17 10:57:01 +0800201
202 return (n == blk_cnt) ? 0 : -1;
203}
204
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000205#ifdef CONFIG_ENV_OFFSET_REDUND
206void env_relocate_spec(void)
207{
208#if !defined(ENV_IS_EMBEDDED)
Tom Rinib9c8cca2014-03-28 12:03:34 -0400209 struct mmc *mmc;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000210 u32 offset1, offset2;
211 int read1_fail = 0, read2_fail = 0;
212 int crc1_ok = 0, crc2_ok = 0;
Markus Niebel452a2722013-10-04 15:48:03 +0200213 env_t *ep;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000214 int ret;
Tom Rinib9c8cca2014-03-28 12:03:34 -0400215 int dev = CONFIG_SYS_MMC_ENV_DEV;
Tim Harveyc75648d2015-05-08 14:52:09 -0700216 const char *errmsg = NULL;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000217
Markus Niebel452a2722013-10-04 15:48:03 +0200218 ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env1, 1);
219 ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env2, 1);
220
Tom Rinib9c8cca2014-03-28 12:03:34 -0400221#ifdef CONFIG_SPL_BUILD
222 dev = 0;
223#endif
224
225 mmc = find_mmc_device(dev);
226
Tim Harveyc75648d2015-05-08 14:52:09 -0700227 errmsg = init_mmc_for_env(mmc);
228 if (errmsg) {
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000229 ret = 1;
230 goto err;
231 }
232
233 if (mmc_get_env_addr(mmc, 0, &offset1) ||
234 mmc_get_env_addr(mmc, 1, &offset2)) {
235 ret = 1;
236 goto fini;
237 }
238
239 read1_fail = read_env(mmc, CONFIG_ENV_SIZE, offset1, tmp_env1);
240 read2_fail = read_env(mmc, CONFIG_ENV_SIZE, offset2, tmp_env2);
241
242 if (read1_fail && read2_fail)
243 puts("*** Error - No Valid Environment Area found\n");
244 else if (read1_fail || read2_fail)
245 puts("*** Warning - some problems detected "
246 "reading environment; recovered successfully\n");
247
248 crc1_ok = !read1_fail &&
249 (crc32(0, tmp_env1->data, ENV_SIZE) == tmp_env1->crc);
250 crc2_ok = !read2_fail &&
251 (crc32(0, tmp_env2->data, ENV_SIZE) == tmp_env2->crc);
252
253 if (!crc1_ok && !crc2_ok) {
Tim Harveyc75648d2015-05-08 14:52:09 -0700254 errmsg = "!bad CRC";
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000255 ret = 1;
256 goto fini;
257 } else if (crc1_ok && !crc2_ok) {
258 gd->env_valid = 1;
259 } else if (!crc1_ok && crc2_ok) {
260 gd->env_valid = 2;
261 } else {
262 /* both ok - check serial */
263 if (tmp_env1->flags == 255 && tmp_env2->flags == 0)
264 gd->env_valid = 2;
265 else if (tmp_env2->flags == 255 && tmp_env1->flags == 0)
266 gd->env_valid = 1;
267 else if (tmp_env1->flags > tmp_env2->flags)
268 gd->env_valid = 1;
269 else if (tmp_env2->flags > tmp_env1->flags)
270 gd->env_valid = 2;
271 else /* flags are equal - almost impossible */
272 gd->env_valid = 1;
273 }
274
275 free(env_ptr);
276
277 if (gd->env_valid == 1)
278 ep = tmp_env1;
279 else
280 ep = tmp_env2;
281
282 env_flags = ep->flags;
283 env_import((char *)ep, 0);
284 ret = 0;
285
286fini:
287 fini_mmc_for_env(mmc);
288err:
289 if (ret)
Tim Harveyc75648d2015-05-08 14:52:09 -0700290 set_default_env(errmsg);
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000291#endif
292}
293#else /* ! CONFIG_ENV_OFFSET_REDUND */
Terry Lva8060352010-05-17 10:57:01 +0800294void env_relocate_spec(void)
295{
296#if !defined(ENV_IS_EMBEDDED)
Tom Rinicd0f4fa2013-04-05 14:55:21 -0400297 ALLOC_CACHE_ALIGN_BUFFER(char, buf, CONFIG_ENV_SIZE);
Tom Rinib9c8cca2014-03-28 12:03:34 -0400298 struct mmc *mmc;
Mingkai Hu97039ab2011-01-24 17:09:55 +0000299 u32 offset;
Stephen Warren9404a5f2012-07-30 10:55:44 +0000300 int ret;
Tom Rinib9c8cca2014-03-28 12:03:34 -0400301 int dev = CONFIG_SYS_MMC_ENV_DEV;
Tim Harveyc75648d2015-05-08 14:52:09 -0700302 const char *errmsg;
Tom Rinib9c8cca2014-03-28 12:03:34 -0400303
304#ifdef CONFIG_SPL_BUILD
305 dev = 0;
306#endif
307
308 mmc = find_mmc_device(dev);
Terry Lva8060352010-05-17 10:57:01 +0800309
Tim Harveyc75648d2015-05-08 14:52:09 -0700310 errmsg = init_mmc_for_env(mmc);
311 if (errmsg) {
Stephen Warren9404a5f2012-07-30 10:55:44 +0000312 ret = 1;
313 goto err;
314 }
Terry Lva8060352010-05-17 10:57:01 +0800315
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000316 if (mmc_get_env_addr(mmc, 0, &offset)) {
Stephen Warren9404a5f2012-07-30 10:55:44 +0000317 ret = 1;
318 goto fini;
319 }
320
Tom Rinicd0f4fa2013-04-05 14:55:21 -0400321 if (read_env(mmc, CONFIG_ENV_SIZE, offset, buf)) {
Tim Harveyc75648d2015-05-08 14:52:09 -0700322 errmsg = "!read failed";
Stephen Warren9404a5f2012-07-30 10:55:44 +0000323 ret = 1;
324 goto fini;
325 }
Terry Lva8060352010-05-17 10:57:01 +0800326
Tom Rinicd0f4fa2013-04-05 14:55:21 -0400327 env_import(buf, 1);
Stephen Warren9404a5f2012-07-30 10:55:44 +0000328 ret = 0;
329
330fini:
331 fini_mmc_for_env(mmc);
332err:
333 if (ret)
Tim Harveyc75648d2015-05-08 14:52:09 -0700334 set_default_env(errmsg);
Terry Lva8060352010-05-17 10:57:01 +0800335#endif
336}
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000337#endif /* CONFIG_ENV_OFFSET_REDUND */