blob: c7fef188cd21b9a6b816ab7b8c997de788b2d822 [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
Clemens Grubere92029c2016-01-20 15:43:37 +010057__weak int mmc_get_env_dev(void)
58{
59 return CONFIG_SYS_MMC_ENV_DEV;
60}
61
Terry Lva8060352010-05-17 10:57:01 +080062int env_init(void)
63{
64 /* use default */
Igor Grinberge8db8f72011-11-07 01:14:05 +000065 gd->env_addr = (ulong)&default_environment[0];
66 gd->env_valid = 1;
Terry Lva8060352010-05-17 10:57:01 +080067
68 return 0;
69}
70
Tom Rinib9c8cca2014-03-28 12:03:34 -040071#ifdef CONFIG_SYS_MMC_ENV_PART
Dmitry Lifshitz6e7b7df2014-07-30 13:19:06 +030072__weak uint mmc_get_env_part(struct mmc *mmc)
73{
74 return CONFIG_SYS_MMC_ENV_PART;
75}
76
Stephen Warren873cc1d2015-12-07 11:38:49 -070077static unsigned char env_mmc_orig_hwpart;
78
Dmitry Lifshitz6e7b7df2014-07-30 13:19:06 +030079static int mmc_set_env_part(struct mmc *mmc)
80{
81 uint part = mmc_get_env_part(mmc);
Clemens Grubere92029c2016-01-20 15:43:37 +010082 int dev = mmc_get_env_dev();
Dmitry Lifshitz6e7b7df2014-07-30 13:19:06 +030083 int ret = 0;
Tom Rinib9c8cca2014-03-28 12:03:34 -040084
85#ifdef CONFIG_SPL_BUILD
86 dev = 0;
87#endif
Dmitry Lifshitz6e7b7df2014-07-30 13:19:06 +030088
Simon Glass69f45cd2016-05-01 13:52:29 -060089 env_mmc_orig_hwpart = mmc_get_blk_desc(mmc)->hwpart;
90 ret = blk_select_hwpart_devnum(IF_TYPE_MMC, dev, part);
Stephen Warren873cc1d2015-12-07 11:38:49 -070091 if (ret)
92 puts("MMC partition switch failed\n");
Dmitry Lifshitz6e7b7df2014-07-30 13:19:06 +030093
94 return ret;
95}
96#else
97static inline int mmc_set_env_part(struct mmc *mmc) {return 0; };
Tom Rinib9c8cca2014-03-28 12:03:34 -040098#endif
99
Tim Harveyc75648d2015-05-08 14:52:09 -0700100static const char *init_mmc_for_env(struct mmc *mmc)
Dmitry Lifshitz6e7b7df2014-07-30 13:19:06 +0300101{
Tim Harveyc75648d2015-05-08 14:52:09 -0700102 if (!mmc)
Hans de Goedea85da212015-08-15 20:05:01 +0200103 return "!No MMC card found";
Terry Lva8060352010-05-17 10:57:01 +0800104
Tim Harveyc75648d2015-05-08 14:52:09 -0700105 if (mmc_init(mmc))
Hans de Goedea85da212015-08-15 20:05:01 +0200106 return "!MMC init failed";
Terry Lva8060352010-05-17 10:57:01 +0800107
Tim Harveyc75648d2015-05-08 14:52:09 -0700108 if (mmc_set_env_part(mmc))
Hans de Goedea85da212015-08-15 20:05:01 +0200109 return "!MMC partition switch failed";
Tim Harveyc75648d2015-05-08 14:52:09 -0700110
111 return NULL;
Terry Lva8060352010-05-17 10:57:01 +0800112}
113
Stephen Warren9404a5f2012-07-30 10:55:44 +0000114static void fini_mmc_for_env(struct mmc *mmc)
115{
116#ifdef CONFIG_SYS_MMC_ENV_PART
Clemens Grubere92029c2016-01-20 15:43:37 +0100117 int dev = mmc_get_env_dev();
Tom Rinib9c8cca2014-03-28 12:03:34 -0400118
119#ifdef CONFIG_SPL_BUILD
120 dev = 0;
121#endif
Simon Glass69f45cd2016-05-01 13:52:29 -0600122 blk_select_hwpart_devnum(IF_TYPE_MMC, dev, env_mmc_orig_hwpart);
Stephen Warren9404a5f2012-07-30 10:55:44 +0000123#endif
124}
125
Terry Lva8060352010-05-17 10:57:01 +0800126#ifdef CONFIG_CMD_SAVEENV
Igor Grinberge8db8f72011-11-07 01:14:05 +0000127static inline int write_env(struct mmc *mmc, unsigned long size,
128 unsigned long offset, const void *buffer)
Terry Lva8060352010-05-17 10:57:01 +0800129{
130 uint blk_start, blk_cnt, n;
131
Igor Grinberge8db8f72011-11-07 01:14:05 +0000132 blk_start = ALIGN(offset, mmc->write_bl_len) / mmc->write_bl_len;
133 blk_cnt = ALIGN(size, mmc->write_bl_len) / mmc->write_bl_len;
Terry Lva8060352010-05-17 10:57:01 +0800134
Stephen Warren7c4213f2015-12-07 11:38:48 -0700135 n = mmc->block_dev.block_write(&mmc->block_dev, blk_start,
Terry Lva8060352010-05-17 10:57:01 +0800136 blk_cnt, (u_char *)buffer);
137
138 return (n == blk_cnt) ? 0 : -1;
139}
140
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000141#ifdef CONFIG_ENV_OFFSET_REDUND
142static unsigned char env_flags;
143#endif
144
Terry Lva8060352010-05-17 10:57:01 +0800145int saveenv(void)
146{
Tom Rinicd0f4fa2013-04-05 14:55:21 -0400147 ALLOC_CACHE_ALIGN_BUFFER(env_t, env_new, 1);
Clemens Grubere92029c2016-01-20 15:43:37 +0100148 int dev = mmc_get_env_dev();
149 struct mmc *mmc = find_mmc_device(dev);
Igor Grinberge8db8f72011-11-07 01:14:05 +0000150 u32 offset;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000151 int ret, copy = 0;
Tim Harveyc75648d2015-05-08 14:52:09 -0700152 const char *errmsg;
Terry Lva8060352010-05-17 10:57:01 +0800153
Tim Harveyc75648d2015-05-08 14:52:09 -0700154 errmsg = init_mmc_for_env(mmc);
155 if (errmsg) {
156 printf("%s\n", errmsg);
Mingkai Hu97039ab2011-01-24 17:09:55 +0000157 return 1;
Tim Harveyc75648d2015-05-08 14:52:09 -0700158 }
Mingkai Hu97039ab2011-01-24 17:09:55 +0000159
Marek Vasut7ce15262014-03-05 19:59:50 +0100160 ret = env_export(env_new);
161 if (ret)
Stephen Warren9404a5f2012-07-30 10:55:44 +0000162 goto fini;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000163
164#ifdef CONFIG_ENV_OFFSET_REDUND
165 env_new->flags = ++env_flags; /* increase the serial */
166
167 if (gd->env_valid == 1)
168 copy = 1;
169#endif
170
171 if (mmc_get_env_addr(mmc, copy, &offset)) {
172 ret = 1;
173 goto fini;
174 }
175
Clemens Grubere92029c2016-01-20 15:43:37 +0100176 printf("Writing to %sMMC(%d)... ", copy ? "redundant " : "", dev);
Stephen Warren4036b632012-05-24 11:38:33 +0000177 if (write_env(mmc, CONFIG_ENV_SIZE, offset, (u_char *)env_new)) {
Terry Lva8060352010-05-17 10:57:01 +0800178 puts("failed\n");
Stephen Warren9404a5f2012-07-30 10:55:44 +0000179 ret = 1;
180 goto fini;
Terry Lva8060352010-05-17 10:57:01 +0800181 }
182
183 puts("done\n");
Stephen Warren9404a5f2012-07-30 10:55:44 +0000184 ret = 0;
185
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000186#ifdef CONFIG_ENV_OFFSET_REDUND
187 gd->env_valid = gd->env_valid == 2 ? 1 : 2;
188#endif
189
Stephen Warren9404a5f2012-07-30 10:55:44 +0000190fini:
191 fini_mmc_for_env(mmc);
192 return ret;
Terry Lva8060352010-05-17 10:57:01 +0800193}
194#endif /* CONFIG_CMD_SAVEENV */
195
Igor Grinberge8db8f72011-11-07 01:14:05 +0000196static inline int read_env(struct mmc *mmc, unsigned long size,
197 unsigned long offset, const void *buffer)
Terry Lva8060352010-05-17 10:57:01 +0800198{
199 uint blk_start, blk_cnt, n;
200
Igor Grinberge8db8f72011-11-07 01:14:05 +0000201 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;
Terry Lva8060352010-05-17 10:57:01 +0800203
Stephen Warren7c4213f2015-12-07 11:38:48 -0700204 n = mmc->block_dev.block_read(&mmc->block_dev, blk_start, blk_cnt,
205 (uchar *)buffer);
Terry Lva8060352010-05-17 10:57:01 +0800206
207 return (n == blk_cnt) ? 0 : -1;
208}
209
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000210#ifdef CONFIG_ENV_OFFSET_REDUND
211void env_relocate_spec(void)
212{
213#if !defined(ENV_IS_EMBEDDED)
Tom Rinib9c8cca2014-03-28 12:03:34 -0400214 struct mmc *mmc;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000215 u32 offset1, offset2;
216 int read1_fail = 0, read2_fail = 0;
217 int crc1_ok = 0, crc2_ok = 0;
Markus Niebel452a2722013-10-04 15:48:03 +0200218 env_t *ep;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000219 int ret;
Clemens Grubere92029c2016-01-20 15:43:37 +0100220 int dev = mmc_get_env_dev();
Tim Harveyc75648d2015-05-08 14:52:09 -0700221 const char *errmsg = NULL;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000222
Markus Niebel452a2722013-10-04 15:48:03 +0200223 ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env1, 1);
224 ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env2, 1);
225
Tom Rinib9c8cca2014-03-28 12:03:34 -0400226#ifdef CONFIG_SPL_BUILD
227 dev = 0;
228#endif
229
230 mmc = find_mmc_device(dev);
231
Tim Harveyc75648d2015-05-08 14:52:09 -0700232 errmsg = init_mmc_for_env(mmc);
233 if (errmsg) {
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000234 ret = 1;
235 goto err;
236 }
237
238 if (mmc_get_env_addr(mmc, 0, &offset1) ||
239 mmc_get_env_addr(mmc, 1, &offset2)) {
240 ret = 1;
241 goto fini;
242 }
243
244 read1_fail = read_env(mmc, CONFIG_ENV_SIZE, offset1, tmp_env1);
245 read2_fail = read_env(mmc, CONFIG_ENV_SIZE, offset2, tmp_env2);
246
247 if (read1_fail && read2_fail)
248 puts("*** Error - No Valid Environment Area found\n");
249 else if (read1_fail || read2_fail)
250 puts("*** Warning - some problems detected "
251 "reading environment; recovered successfully\n");
252
253 crc1_ok = !read1_fail &&
254 (crc32(0, tmp_env1->data, ENV_SIZE) == tmp_env1->crc);
255 crc2_ok = !read2_fail &&
256 (crc32(0, tmp_env2->data, ENV_SIZE) == tmp_env2->crc);
257
258 if (!crc1_ok && !crc2_ok) {
Tim Harveyc75648d2015-05-08 14:52:09 -0700259 errmsg = "!bad CRC";
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000260 ret = 1;
261 goto fini;
262 } else if (crc1_ok && !crc2_ok) {
263 gd->env_valid = 1;
264 } else if (!crc1_ok && crc2_ok) {
265 gd->env_valid = 2;
266 } else {
267 /* both ok - check serial */
268 if (tmp_env1->flags == 255 && tmp_env2->flags == 0)
269 gd->env_valid = 2;
270 else if (tmp_env2->flags == 255 && tmp_env1->flags == 0)
271 gd->env_valid = 1;
272 else if (tmp_env1->flags > tmp_env2->flags)
273 gd->env_valid = 1;
274 else if (tmp_env2->flags > tmp_env1->flags)
275 gd->env_valid = 2;
276 else /* flags are equal - almost impossible */
277 gd->env_valid = 1;
278 }
279
280 free(env_ptr);
281
282 if (gd->env_valid == 1)
283 ep = tmp_env1;
284 else
285 ep = tmp_env2;
286
287 env_flags = ep->flags;
288 env_import((char *)ep, 0);
289 ret = 0;
290
291fini:
292 fini_mmc_for_env(mmc);
293err:
294 if (ret)
Tim Harveyc75648d2015-05-08 14:52:09 -0700295 set_default_env(errmsg);
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000296#endif
297}
298#else /* ! CONFIG_ENV_OFFSET_REDUND */
Terry Lva8060352010-05-17 10:57:01 +0800299void env_relocate_spec(void)
300{
301#if !defined(ENV_IS_EMBEDDED)
Tom Rinicd0f4fa2013-04-05 14:55:21 -0400302 ALLOC_CACHE_ALIGN_BUFFER(char, buf, CONFIG_ENV_SIZE);
Tom Rinib9c8cca2014-03-28 12:03:34 -0400303 struct mmc *mmc;
Mingkai Hu97039ab2011-01-24 17:09:55 +0000304 u32 offset;
Stephen Warren9404a5f2012-07-30 10:55:44 +0000305 int ret;
Clemens Grubere92029c2016-01-20 15:43:37 +0100306 int dev = mmc_get_env_dev();
Tim Harveyc75648d2015-05-08 14:52:09 -0700307 const char *errmsg;
Tom Rinib9c8cca2014-03-28 12:03:34 -0400308
309#ifdef CONFIG_SPL_BUILD
310 dev = 0;
311#endif
312
313 mmc = find_mmc_device(dev);
Terry Lva8060352010-05-17 10:57:01 +0800314
Tim Harveyc75648d2015-05-08 14:52:09 -0700315 errmsg = init_mmc_for_env(mmc);
316 if (errmsg) {
Stephen Warren9404a5f2012-07-30 10:55:44 +0000317 ret = 1;
318 goto err;
319 }
Terry Lva8060352010-05-17 10:57:01 +0800320
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000321 if (mmc_get_env_addr(mmc, 0, &offset)) {
Stephen Warren9404a5f2012-07-30 10:55:44 +0000322 ret = 1;
323 goto fini;
324 }
325
Tom Rinicd0f4fa2013-04-05 14:55:21 -0400326 if (read_env(mmc, CONFIG_ENV_SIZE, offset, buf)) {
Tim Harveyc75648d2015-05-08 14:52:09 -0700327 errmsg = "!read failed";
Stephen Warren9404a5f2012-07-30 10:55:44 +0000328 ret = 1;
329 goto fini;
330 }
Terry Lva8060352010-05-17 10:57:01 +0800331
Tom Rinicd0f4fa2013-04-05 14:55:21 -0400332 env_import(buf, 1);
Stephen Warren9404a5f2012-07-30 10:55:44 +0000333 ret = 0;
334
335fini:
336 fini_mmc_for_env(mmc);
337err:
338 if (ret)
Tim Harveyc75648d2015-05-08 14:52:09 -0700339 set_default_env(errmsg);
Terry Lva8060352010-05-17 10:57:01 +0800340#endif
341}
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000342#endif /* CONFIG_ENV_OFFSET_REDUND */