blob: ed7bcf16ae0ea075a5169fc3f7036b584dfa174f [file] [log] [blame]
Terry Lvb4eceac2010-05-17 10:57:01 +08001/*
Mingkai Hua55fce32011-01-24 17:09:55 +00002 * (C) Copyright 2008-2011 Freescale Semiconductor, Inc.
Terry Lvb4eceac2010-05-17 10:57:01 +08003 *
Wolfgang Denkbd8ec7e2013-10-07 13:07:26 +02004 * SPDX-License-Identifier: GPL-2.0+
Terry Lvb4eceac2010-05-17 10:57:01 +08005 */
6
7/* #define DEBUG */
8
9#include <common.h>
10
11#include <command.h>
12#include <environment.h>
Philipp Tomsich8ab507b2017-05-16 00:16:31 +020013#include <fdtdec.h>
Terry Lvb4eceac2010-05-17 10:57:01 +080014#include <linux/stddef.h>
15#include <malloc.h>
Simon Glass2dd337a2015-09-02 17:24:58 -060016#include <memalign.h>
Terry Lvb4eceac2010-05-17 10:57:01 +080017#include <mmc.h>
Jorge Ramirez-Ortiz03ab46c2017-11-06 14:16:37 +010018#include <part.h>
Lei Wen9f84f212010-11-10 07:39:23 +080019#include <search.h>
Lei Wenff833ed2010-10-13 11:07:21 +080020#include <errno.h>
Terry Lvb4eceac2010-05-17 10:57:01 +080021
Jorge Ramirez-Ortiz03ab46c2017-11-06 14:16:37 +010022#define __STR(X) #X
23#define STR(X) __STR(X)
24
Michael Heimpolda1d25a32013-04-10 10:36:19 +000025#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
Terry Lvb4eceac2010-05-17 10:57:01 +080030DECLARE_GLOBAL_DATA_PTR;
31
Mingkai Hua55fce32011-01-24 17:09:55 +000032#if !defined(CONFIG_ENV_OFFSET)
33#define CONFIG_ENV_OFFSET 0
34#endif
35
Philipp Tomsich8ab507b2017-05-16 00:16:31 +020036#if CONFIG_IS_ENABLED(OF_CONTROL)
Jorge Ramirez-Ortiz03ab46c2017-11-06 14:16:37 +010037static 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
Philipp Tomsich8ab507b2017-05-16 00:16:31 +020065static inline s64 mmc_offset(int copy)
66{
Jorge Ramirez-Ortiz03ab46c2017-11-06 14:16:37 +010067 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 };
Philipp Tomsich745d8de2017-11-21 23:29:40 +010076 s64 val = 0, defvalue;
Jorge Ramirez-Ortiz03ab46c2017-11-06 14:16:37 +010077 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;
Philipp Tomsich8ab507b2017-05-16 00:16:31 +020092
93#if defined(CONFIG_ENV_OFFSET_REDUND)
94 if (copy) {
Philipp Tomsich8ab507b2017-05-16 00:16:31 +020095 defvalue = CONFIG_ENV_OFFSET_REDUND;
Jorge Ramirez-Ortiz03ab46c2017-11-06 14:16:37 +010096 propname = dt_prop.offset_redund;
Philipp Tomsich8ab507b2017-05-16 00:16:31 +020097 }
98#endif
Philipp Tomsich8ab507b2017-05-16 00:16:31 +020099 return fdtdec_get_config_int(gd->fdt_blob, propname, defvalue);
100}
101#else
102static inline s64 mmc_offset(int copy)
Mingkai Hua55fce32011-01-24 17:09:55 +0000103{
Philipp Tomsich8ab507b2017-05-16 00:16:31 +0200104 s64 offset = CONFIG_ENV_OFFSET;
Stephen Warren24dc2032013-06-11 15:14:02 -0600105
Philipp Tomsich8ab507b2017-05-16 00:16:31 +0200106#if defined(CONFIG_ENV_OFFSET_REDUND)
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000107 if (copy)
Stephen Warren24dc2032013-06-11 15:14:02 -0600108 offset = CONFIG_ENV_OFFSET_REDUND;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000109#endif
Philipp Tomsich8ab507b2017-05-16 00:16:31 +0200110 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);
Stephen Warren24dc2032013-06-11 15:14:02 -0600117
118 if (offset < 0)
119 offset += mmc->capacity;
120
121 *env_addr = offset;
122
Mingkai Hua55fce32011-01-24 17:09:55 +0000123 return 0;
124}
Mingkai Hua55fce32011-01-24 17:09:55 +0000125
Clemens Gruberf7b61442016-01-20 15:43:37 +0100126__weak int mmc_get_env_dev(void)
127{
128 return CONFIG_SYS_MMC_ENV_DEV;
129}
130
Tom Rinic929f822014-03-28 12:03:34 -0400131#ifdef CONFIG_SYS_MMC_ENV_PART
Dmitry Lifshitz97d2fb92014-07-30 13:19:06 +0300132__weak uint mmc_get_env_part(struct mmc *mmc)
133{
134 return CONFIG_SYS_MMC_ENV_PART;
135}
136
Stephen Warren1e0f92a2015-12-07 11:38:49 -0700137static unsigned char env_mmc_orig_hwpart;
138
Dmitry Lifshitz97d2fb92014-07-30 13:19:06 +0300139static int mmc_set_env_part(struct mmc *mmc)
140{
141 uint part = mmc_get_env_part(mmc);
Clemens Gruberf7b61442016-01-20 15:43:37 +0100142 int dev = mmc_get_env_dev();
Dmitry Lifshitz97d2fb92014-07-30 13:19:06 +0300143 int ret = 0;
Tom Rinic929f822014-03-28 12:03:34 -0400144
Simon Glass11f2bb62016-05-01 13:52:29 -0600145 env_mmc_orig_hwpart = mmc_get_blk_desc(mmc)->hwpart;
146 ret = blk_select_hwpart_devnum(IF_TYPE_MMC, dev, part);
Stephen Warren1e0f92a2015-12-07 11:38:49 -0700147 if (ret)
148 puts("MMC partition switch failed\n");
Dmitry Lifshitz97d2fb92014-07-30 13:19:06 +0300149
150 return ret;
151}
152#else
153static inline int mmc_set_env_part(struct mmc *mmc) {return 0; };
Tom Rinic929f822014-03-28 12:03:34 -0400154#endif
155
Tim Harveyeda75c32015-05-08 14:52:09 -0700156static const char *init_mmc_for_env(struct mmc *mmc)
Dmitry Lifshitz97d2fb92014-07-30 13:19:06 +0300157{
Tim Harveyeda75c32015-05-08 14:52:09 -0700158 if (!mmc)
Hans de Goede8764fd62015-08-15 20:05:01 +0200159 return "!No MMC card found";
Terry Lvb4eceac2010-05-17 10:57:01 +0800160
Simon Glass1d9907c2017-05-27 11:37:18 -0600161#ifdef CONFIG_BLK
162 struct udevice *dev;
163
164 if (blk_get_from_parent(mmc->dev, &dev))
165 return "!No block device";
166#else
Tim Harveyeda75c32015-05-08 14:52:09 -0700167 if (mmc_init(mmc))
Hans de Goede8764fd62015-08-15 20:05:01 +0200168 return "!MMC init failed";
Simon Glass86d78c72017-04-23 20:02:04 -0600169#endif
Tim Harveyeda75c32015-05-08 14:52:09 -0700170 if (mmc_set_env_part(mmc))
Hans de Goede8764fd62015-08-15 20:05:01 +0200171 return "!MMC partition switch failed";
Tim Harveyeda75c32015-05-08 14:52:09 -0700172
173 return NULL;
Terry Lvb4eceac2010-05-17 10:57:01 +0800174}
175
Stephen Warren27ee0f32012-07-30 10:55:44 +0000176static void fini_mmc_for_env(struct mmc *mmc)
177{
178#ifdef CONFIG_SYS_MMC_ENV_PART
Clemens Gruberf7b61442016-01-20 15:43:37 +0100179 int dev = mmc_get_env_dev();
Tom Rinic929f822014-03-28 12:03:34 -0400180
Simon Glass11f2bb62016-05-01 13:52:29 -0600181 blk_select_hwpart_devnum(IF_TYPE_MMC, dev, env_mmc_orig_hwpart);
Stephen Warren27ee0f32012-07-30 10:55:44 +0000182#endif
183}
184
Simon Glass082af922017-08-03 12:22:01 -0600185#if defined(CONFIG_CMD_SAVEENV) && !defined(CONFIG_SPL_BUILD)
Igor Grinbergecbfb622011-11-07 01:14:05 +0000186static inline int write_env(struct mmc *mmc, unsigned long size,
187 unsigned long offset, const void *buffer)
Terry Lvb4eceac2010-05-17 10:57:01 +0800188{
189 uint blk_start, blk_cnt, n;
Simon Glassda898922016-05-14 14:03:03 -0600190 struct blk_desc *desc = mmc_get_blk_desc(mmc);
Terry Lvb4eceac2010-05-17 10:57:01 +0800191
Igor Grinbergecbfb622011-11-07 01:14:05 +0000192 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;
Terry Lvb4eceac2010-05-17 10:57:01 +0800194
Simon Glassda898922016-05-14 14:03:03 -0600195 n = blk_dwrite(desc, blk_start, blk_cnt, (u_char *)buffer);
Terry Lvb4eceac2010-05-17 10:57:01 +0800196
197 return (n == blk_cnt) ? 0 : -1;
198}
199
Simon Glass082af922017-08-03 12:22:01 -0600200static int env_mmc_save(void)
Terry Lvb4eceac2010-05-17 10:57:01 +0800201{
Tom Rinia840b8e2013-04-05 14:55:21 -0400202 ALLOC_CACHE_ALIGN_BUFFER(env_t, env_new, 1);
Clemens Gruberf7b61442016-01-20 15:43:37 +0100203 int dev = mmc_get_env_dev();
204 struct mmc *mmc = find_mmc_device(dev);
Igor Grinbergecbfb622011-11-07 01:14:05 +0000205 u32 offset;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000206 int ret, copy = 0;
Tim Harveyeda75c32015-05-08 14:52:09 -0700207 const char *errmsg;
Terry Lvb4eceac2010-05-17 10:57:01 +0800208
Tim Harveyeda75c32015-05-08 14:52:09 -0700209 errmsg = init_mmc_for_env(mmc);
210 if (errmsg) {
211 printf("%s\n", errmsg);
Terry Lvb4eceac2010-05-17 10:57:01 +0800212 return 1;
Tim Harveyeda75c32015-05-08 14:52:09 -0700213 }
Terry Lvb4eceac2010-05-17 10:57:01 +0800214
Marek Vasutd73c1292014-03-05 19:59:50 +0100215 ret = env_export(env_new);
216 if (ret)
Stephen Warren27ee0f32012-07-30 10:55:44 +0000217 goto fini;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000218
219#ifdef CONFIG_ENV_OFFSET_REDUND
Simon Glass4bc2ad22017-08-03 12:21:56 -0600220 if (gd->env_valid == ENV_VALID)
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000221 copy = 1;
222#endif
223
224 if (mmc_get_env_addr(mmc, copy, &offset)) {
225 ret = 1;
226 goto fini;
227 }
228
Clemens Gruberf7b61442016-01-20 15:43:37 +0100229 printf("Writing to %sMMC(%d)... ", copy ? "redundant " : "", dev);
Stephen Warren42a3c442012-05-24 11:38:33 +0000230 if (write_env(mmc, CONFIG_ENV_SIZE, offset, (u_char *)env_new)) {
Terry Lvb4eceac2010-05-17 10:57:01 +0800231 puts("failed\n");
Stephen Warren27ee0f32012-07-30 10:55:44 +0000232 ret = 1;
233 goto fini;
Terry Lvb4eceac2010-05-17 10:57:01 +0800234 }
235
236 puts("done\n");
Stephen Warren27ee0f32012-07-30 10:55:44 +0000237 ret = 0;
238
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000239#ifdef CONFIG_ENV_OFFSET_REDUND
Simon Glass4bc2ad22017-08-03 12:21:56 -0600240 gd->env_valid = gd->env_valid == ENV_REDUND ? ENV_VALID : ENV_REDUND;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000241#endif
242
Stephen Warren27ee0f32012-07-30 10:55:44 +0000243fini:
244 fini_mmc_for_env(mmc);
245 return ret;
Terry Lvb4eceac2010-05-17 10:57:01 +0800246}
Simon Glass082af922017-08-03 12:22:01 -0600247#endif /* CONFIG_CMD_SAVEENV && !CONFIG_SPL_BUILD */
Terry Lvb4eceac2010-05-17 10:57:01 +0800248
Igor Grinbergecbfb622011-11-07 01:14:05 +0000249static inline int read_env(struct mmc *mmc, unsigned long size,
250 unsigned long offset, const void *buffer)
Terry Lvb4eceac2010-05-17 10:57:01 +0800251{
252 uint blk_start, blk_cnt, n;
Simon Glassda898922016-05-14 14:03:03 -0600253 struct blk_desc *desc = mmc_get_blk_desc(mmc);
Terry Lvb4eceac2010-05-17 10:57:01 +0800254
Igor Grinbergecbfb622011-11-07 01:14:05 +0000255 blk_start = ALIGN(offset, mmc->read_bl_len) / mmc->read_bl_len;
256 blk_cnt = ALIGN(size, mmc->read_bl_len) / mmc->read_bl_len;
Terry Lvb4eceac2010-05-17 10:57:01 +0800257
Simon Glassda898922016-05-14 14:03:03 -0600258 n = blk_dread(desc, blk_start, blk_cnt, (uchar *)buffer);
Terry Lvb4eceac2010-05-17 10:57:01 +0800259
260 return (n == blk_cnt) ? 0 : -1;
261}
262
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000263#ifdef CONFIG_ENV_OFFSET_REDUND
Simon Glass99778492017-08-03 12:22:17 -0600264static int env_mmc_load(void)
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000265{
266#if !defined(ENV_IS_EMBEDDED)
Tom Rinic929f822014-03-28 12:03:34 -0400267 struct mmc *mmc;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000268 u32 offset1, offset2;
269 int read1_fail = 0, read2_fail = 0;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000270 int ret;
Clemens Gruberf7b61442016-01-20 15:43:37 +0100271 int dev = mmc_get_env_dev();
Tim Harveyeda75c32015-05-08 14:52:09 -0700272 const char *errmsg = NULL;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000273
Markus Niebel6ef41fd2013-10-04 15:48:03 +0200274 ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env1, 1);
275 ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env2, 1);
276
Tom Rinic929f822014-03-28 12:03:34 -0400277 mmc = find_mmc_device(dev);
278
Tim Harveyeda75c32015-05-08 14:52:09 -0700279 errmsg = init_mmc_for_env(mmc);
280 if (errmsg) {
Simon Glass99778492017-08-03 12:22:17 -0600281 ret = -EIO;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000282 goto err;
283 }
284
285 if (mmc_get_env_addr(mmc, 0, &offset1) ||
286 mmc_get_env_addr(mmc, 1, &offset2)) {
Simon Glass99778492017-08-03 12:22:17 -0600287 ret = -EIO;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000288 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
294 if (read1_fail && read2_fail)
295 puts("*** Error - No Valid Environment Area found\n");
296 else if (read1_fail || read2_fail)
297 puts("*** Warning - some problems detected "
298 "reading environment; recovered successfully\n");
299
Fiach Antaw0a2e1762017-01-25 18:53:12 +1000300 if (read1_fail && read2_fail) {
Tim Harveyeda75c32015-05-08 14:52:09 -0700301 errmsg = "!bad CRC";
Simon Glass99778492017-08-03 12:22:17 -0600302 ret = -EIO;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000303 goto fini;
Fiach Antaw0a2e1762017-01-25 18:53:12 +1000304 } else if (!read1_fail && read2_fail) {
Simon Glass4bc2ad22017-08-03 12:21:56 -0600305 gd->env_valid = ENV_VALID;
Fiach Antaw0a2e1762017-01-25 18:53:12 +1000306 env_import((char *)tmp_env1, 1);
307 } else if (read1_fail && !read2_fail) {
Simon Glass4bc2ad22017-08-03 12:21:56 -0600308 gd->env_valid = ENV_REDUND;
Fiach Antaw0a2e1762017-01-25 18:53:12 +1000309 env_import((char *)tmp_env2, 1);
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000310 } else {
Fiach Antaw0a2e1762017-01-25 18:53:12 +1000311 env_import_redund((char *)tmp_env1, (char *)tmp_env2);
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000312 }
313
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000314 ret = 0;
315
316fini:
317 fini_mmc_for_env(mmc);
318err:
319 if (ret)
Tim Harveyeda75c32015-05-08 14:52:09 -0700320 set_default_env(errmsg);
Simon Glass99778492017-08-03 12:22:17 -0600321
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000322#endif
Simon Glass99778492017-08-03 12:22:17 -0600323 return ret;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000324}
325#else /* ! CONFIG_ENV_OFFSET_REDUND */
Simon Glass99778492017-08-03 12:22:17 -0600326static int env_mmc_load(void)
Terry Lvb4eceac2010-05-17 10:57:01 +0800327{
328#if !defined(ENV_IS_EMBEDDED)
Tom Rinia840b8e2013-04-05 14:55:21 -0400329 ALLOC_CACHE_ALIGN_BUFFER(char, buf, CONFIG_ENV_SIZE);
Tom Rinic929f822014-03-28 12:03:34 -0400330 struct mmc *mmc;
Mingkai Hua55fce32011-01-24 17:09:55 +0000331 u32 offset;
Stephen Warren27ee0f32012-07-30 10:55:44 +0000332 int ret;
Clemens Gruberf7b61442016-01-20 15:43:37 +0100333 int dev = mmc_get_env_dev();
Tim Harveyeda75c32015-05-08 14:52:09 -0700334 const char *errmsg;
Tom Rinic929f822014-03-28 12:03:34 -0400335
Tom Rinic929f822014-03-28 12:03:34 -0400336 mmc = find_mmc_device(dev);
Stephen Warren27ee0f32012-07-30 10:55:44 +0000337
Tim Harveyeda75c32015-05-08 14:52:09 -0700338 errmsg = init_mmc_for_env(mmc);
339 if (errmsg) {
Simon Glass99778492017-08-03 12:22:17 -0600340 ret = -EIO;
Stephen Warren27ee0f32012-07-30 10:55:44 +0000341 goto err;
342 }
Terry Lvb4eceac2010-05-17 10:57:01 +0800343
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000344 if (mmc_get_env_addr(mmc, 0, &offset)) {
Simon Glass99778492017-08-03 12:22:17 -0600345 ret = -EIO;
Stephen Warren27ee0f32012-07-30 10:55:44 +0000346 goto fini;
347 }
Terry Lvb4eceac2010-05-17 10:57:01 +0800348
Tom Rinia840b8e2013-04-05 14:55:21 -0400349 if (read_env(mmc, CONFIG_ENV_SIZE, offset, buf)) {
Tim Harveyeda75c32015-05-08 14:52:09 -0700350 errmsg = "!read failed";
Simon Glass99778492017-08-03 12:22:17 -0600351 ret = -EIO;
Stephen Warren27ee0f32012-07-30 10:55:44 +0000352 goto fini;
353 }
Terry Lvb4eceac2010-05-17 10:57:01 +0800354
Tom Rinia840b8e2013-04-05 14:55:21 -0400355 env_import(buf, 1);
Stephen Warren27ee0f32012-07-30 10:55:44 +0000356 ret = 0;
357
358fini:
359 fini_mmc_for_env(mmc);
360err:
361 if (ret)
Tim Harveyeda75c32015-05-08 14:52:09 -0700362 set_default_env(errmsg);
Terry Lvb4eceac2010-05-17 10:57:01 +0800363#endif
Simon Glass99778492017-08-03 12:22:17 -0600364 return ret;
Terry Lvb4eceac2010-05-17 10:57:01 +0800365}
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000366#endif /* CONFIG_ENV_OFFSET_REDUND */
Simon Glassc10a88e2017-08-03 12:21:58 -0600367
368U_BOOT_ENV_LOCATION(mmc) = {
369 .location = ENVL_MMC,
Simon Glassd8273ed2017-08-03 12:22:03 -0600370 ENV_NAME("MMC")
Simon Glass082af922017-08-03 12:22:01 -0600371 .load = env_mmc_load,
Simon Glassc10a88e2017-08-03 12:21:58 -0600372#ifndef CONFIG_SPL_BUILD
Simon Glass082af922017-08-03 12:22:01 -0600373 .save = env_save_ptr(env_mmc_save),
Simon Glassc10a88e2017-08-03 12:21:58 -0600374#endif
Simon Glassc10a88e2017-08-03 12:21:58 -0600375};