blob: 5e3da6dca7596919ca5ae1f01e2f495d05d1b536 [file] [log] [blame]
Tom Rini10e47792018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Terry Lvb4eceac2010-05-17 10:57:01 +08002/*
Mingkai Hua55fce32011-01-24 17:09:55 +00003 * (C) Copyright 2008-2011 Freescale Semiconductor, Inc.
Terry Lvb4eceac2010-05-17 10:57:01 +08004 */
5
6/* #define DEBUG */
7
8#include <common.h>
9
10#include <command.h>
11#include <environment.h>
Philipp Tomsich8ab507b2017-05-16 00:16:31 +020012#include <fdtdec.h>
Terry Lvb4eceac2010-05-17 10:57:01 +080013#include <linux/stddef.h>
14#include <malloc.h>
Simon Glass2dd337a2015-09-02 17:24:58 -060015#include <memalign.h>
Terry Lvb4eceac2010-05-17 10:57:01 +080016#include <mmc.h>
Jorge Ramirez-Ortiz03ab46c2017-11-06 14:16:37 +010017#include <part.h>
Lei Wen9f84f212010-11-10 07:39:23 +080018#include <search.h>
Lei Wenff833ed2010-10-13 11:07:21 +080019#include <errno.h>
Terry Lvb4eceac2010-05-17 10:57:01 +080020
Jorge Ramirez-Ortiz03ab46c2017-11-06 14:16:37 +010021#define __STR(X) #X
22#define STR(X) __STR(X)
23
Michael Heimpolda1d25a32013-04-10 10:36:19 +000024#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
Terry Lvb4eceac2010-05-17 10:57:01 +080029DECLARE_GLOBAL_DATA_PTR;
30
Mingkai Hua55fce32011-01-24 17:09:55 +000031#if !defined(CONFIG_ENV_OFFSET)
32#define CONFIG_ENV_OFFSET 0
33#endif
34
Philipp Tomsich8ab507b2017-05-16 00:16:31 +020035#if CONFIG_IS_ENABLED(OF_CONTROL)
Jorge Ramirez-Ortiz03ab46c2017-11-06 14:16:37 +010036static 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
Philipp Tomsich8ab507b2017-05-16 00:16:31 +020064static inline s64 mmc_offset(int copy)
65{
Jorge Ramirez-Ortiz03ab46c2017-11-06 14:16:37 +010066 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 };
Philipp Tomsich745d8de2017-11-21 23:29:40 +010075 s64 val = 0, defvalue;
Jorge Ramirez-Ortiz03ab46c2017-11-06 14:16:37 +010076 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;
Philipp Tomsich8ab507b2017-05-16 00:16:31 +020091
92#if defined(CONFIG_ENV_OFFSET_REDUND)
93 if (copy) {
Philipp Tomsich8ab507b2017-05-16 00:16:31 +020094 defvalue = CONFIG_ENV_OFFSET_REDUND;
Jorge Ramirez-Ortiz03ab46c2017-11-06 14:16:37 +010095 propname = dt_prop.offset_redund;
Philipp Tomsich8ab507b2017-05-16 00:16:31 +020096 }
97#endif
Philipp Tomsich8ab507b2017-05-16 00:16:31 +020098 return fdtdec_get_config_int(gd->fdt_blob, propname, defvalue);
99}
100#else
101static inline s64 mmc_offset(int copy)
Mingkai Hua55fce32011-01-24 17:09:55 +0000102{
Philipp Tomsich8ab507b2017-05-16 00:16:31 +0200103 s64 offset = CONFIG_ENV_OFFSET;
Stephen Warren24dc2032013-06-11 15:14:02 -0600104
Philipp Tomsich8ab507b2017-05-16 00:16:31 +0200105#if defined(CONFIG_ENV_OFFSET_REDUND)
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000106 if (copy)
Stephen Warren24dc2032013-06-11 15:14:02 -0600107 offset = CONFIG_ENV_OFFSET_REDUND;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000108#endif
Philipp Tomsich8ab507b2017-05-16 00:16:31 +0200109 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);
Stephen Warren24dc2032013-06-11 15:14:02 -0600116
117 if (offset < 0)
118 offset += mmc->capacity;
119
120 *env_addr = offset;
121
Mingkai Hua55fce32011-01-24 17:09:55 +0000122 return 0;
123}
Mingkai Hua55fce32011-01-24 17:09:55 +0000124
Clemens Gruberf7b61442016-01-20 15:43:37 +0100125__weak int mmc_get_env_dev(void)
126{
127 return CONFIG_SYS_MMC_ENV_DEV;
128}
129
Tom Rinic929f822014-03-28 12:03:34 -0400130#ifdef CONFIG_SYS_MMC_ENV_PART
Dmitry Lifshitz97d2fb92014-07-30 13:19:06 +0300131__weak uint mmc_get_env_part(struct mmc *mmc)
132{
133 return CONFIG_SYS_MMC_ENV_PART;
134}
135
Stephen Warren1e0f92a2015-12-07 11:38:49 -0700136static unsigned char env_mmc_orig_hwpart;
137
Dmitry Lifshitz97d2fb92014-07-30 13:19:06 +0300138static int mmc_set_env_part(struct mmc *mmc)
139{
140 uint part = mmc_get_env_part(mmc);
Clemens Gruberf7b61442016-01-20 15:43:37 +0100141 int dev = mmc_get_env_dev();
Dmitry Lifshitz97d2fb92014-07-30 13:19:06 +0300142 int ret = 0;
Tom Rinic929f822014-03-28 12:03:34 -0400143
Simon Glass11f2bb62016-05-01 13:52:29 -0600144 env_mmc_orig_hwpart = mmc_get_blk_desc(mmc)->hwpart;
145 ret = blk_select_hwpart_devnum(IF_TYPE_MMC, dev, part);
Stephen Warren1e0f92a2015-12-07 11:38:49 -0700146 if (ret)
147 puts("MMC partition switch failed\n");
Dmitry Lifshitz97d2fb92014-07-30 13:19:06 +0300148
149 return ret;
150}
151#else
152static inline int mmc_set_env_part(struct mmc *mmc) {return 0; };
Tom Rinic929f822014-03-28 12:03:34 -0400153#endif
154
Tim Harveyeda75c32015-05-08 14:52:09 -0700155static const char *init_mmc_for_env(struct mmc *mmc)
Dmitry Lifshitz97d2fb92014-07-30 13:19:06 +0300156{
Tim Harveyeda75c32015-05-08 14:52:09 -0700157 if (!mmc)
Hans de Goede8764fd62015-08-15 20:05:01 +0200158 return "!No MMC card found";
Terry Lvb4eceac2010-05-17 10:57:01 +0800159
Sjoerd Simons5e4546d2018-03-22 22:53:50 +0100160#if CONFIG_IS_ENABLED(BLK)
Simon Glass1d9907c2017-05-27 11:37:18 -0600161 struct udevice *dev;
162
163 if (blk_get_from_parent(mmc->dev, &dev))
164 return "!No block device";
165#else
Tim Harveyeda75c32015-05-08 14:52:09 -0700166 if (mmc_init(mmc))
Hans de Goede8764fd62015-08-15 20:05:01 +0200167 return "!MMC init failed";
Simon Glass86d78c72017-04-23 20:02:04 -0600168#endif
Tim Harveyeda75c32015-05-08 14:52:09 -0700169 if (mmc_set_env_part(mmc))
Hans de Goede8764fd62015-08-15 20:05:01 +0200170 return "!MMC partition switch failed";
Tim Harveyeda75c32015-05-08 14:52:09 -0700171
172 return NULL;
Terry Lvb4eceac2010-05-17 10:57:01 +0800173}
174
Stephen Warren27ee0f32012-07-30 10:55:44 +0000175static void fini_mmc_for_env(struct mmc *mmc)
176{
177#ifdef CONFIG_SYS_MMC_ENV_PART
Clemens Gruberf7b61442016-01-20 15:43:37 +0100178 int dev = mmc_get_env_dev();
Tom Rinic929f822014-03-28 12:03:34 -0400179
Simon Glass11f2bb62016-05-01 13:52:29 -0600180 blk_select_hwpart_devnum(IF_TYPE_MMC, dev, env_mmc_orig_hwpart);
Stephen Warren27ee0f32012-07-30 10:55:44 +0000181#endif
182}
183
Simon Glass082af922017-08-03 12:22:01 -0600184#if defined(CONFIG_CMD_SAVEENV) && !defined(CONFIG_SPL_BUILD)
Igor Grinbergecbfb622011-11-07 01:14:05 +0000185static inline int write_env(struct mmc *mmc, unsigned long size,
186 unsigned long offset, const void *buffer)
Terry Lvb4eceac2010-05-17 10:57:01 +0800187{
188 uint blk_start, blk_cnt, n;
Simon Glassda898922016-05-14 14:03:03 -0600189 struct blk_desc *desc = mmc_get_blk_desc(mmc);
Terry Lvb4eceac2010-05-17 10:57:01 +0800190
Igor Grinbergecbfb622011-11-07 01:14:05 +0000191 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;
Terry Lvb4eceac2010-05-17 10:57:01 +0800193
Simon Glassda898922016-05-14 14:03:03 -0600194 n = blk_dwrite(desc, blk_start, blk_cnt, (u_char *)buffer);
Terry Lvb4eceac2010-05-17 10:57:01 +0800195
196 return (n == blk_cnt) ? 0 : -1;
197}
198
Simon Glass082af922017-08-03 12:22:01 -0600199static int env_mmc_save(void)
Terry Lvb4eceac2010-05-17 10:57:01 +0800200{
Tom Rinia840b8e2013-04-05 14:55:21 -0400201 ALLOC_CACHE_ALIGN_BUFFER(env_t, env_new, 1);
Clemens Gruberf7b61442016-01-20 15:43:37 +0100202 int dev = mmc_get_env_dev();
203 struct mmc *mmc = find_mmc_device(dev);
Igor Grinbergecbfb622011-11-07 01:14:05 +0000204 u32 offset;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000205 int ret, copy = 0;
Tim Harveyeda75c32015-05-08 14:52:09 -0700206 const char *errmsg;
Terry Lvb4eceac2010-05-17 10:57:01 +0800207
Tim Harveyeda75c32015-05-08 14:52:09 -0700208 errmsg = init_mmc_for_env(mmc);
209 if (errmsg) {
210 printf("%s\n", errmsg);
Terry Lvb4eceac2010-05-17 10:57:01 +0800211 return 1;
Tim Harveyeda75c32015-05-08 14:52:09 -0700212 }
Terry Lvb4eceac2010-05-17 10:57:01 +0800213
Marek Vasutd73c1292014-03-05 19:59:50 +0100214 ret = env_export(env_new);
215 if (ret)
Stephen Warren27ee0f32012-07-30 10:55:44 +0000216 goto fini;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000217
218#ifdef CONFIG_ENV_OFFSET_REDUND
Simon Glass4bc2ad22017-08-03 12:21:56 -0600219 if (gd->env_valid == ENV_VALID)
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000220 copy = 1;
221#endif
222
223 if (mmc_get_env_addr(mmc, copy, &offset)) {
224 ret = 1;
225 goto fini;
226 }
227
Clemens Gruberf7b61442016-01-20 15:43:37 +0100228 printf("Writing to %sMMC(%d)... ", copy ? "redundant " : "", dev);
Stephen Warren42a3c442012-05-24 11:38:33 +0000229 if (write_env(mmc, CONFIG_ENV_SIZE, offset, (u_char *)env_new)) {
Terry Lvb4eceac2010-05-17 10:57:01 +0800230 puts("failed\n");
Stephen Warren27ee0f32012-07-30 10:55:44 +0000231 ret = 1;
232 goto fini;
Terry Lvb4eceac2010-05-17 10:57:01 +0800233 }
234
Stephen Warren27ee0f32012-07-30 10:55:44 +0000235 ret = 0;
236
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000237#ifdef CONFIG_ENV_OFFSET_REDUND
Simon Glass4bc2ad22017-08-03 12:21:56 -0600238 gd->env_valid = gd->env_valid == ENV_REDUND ? ENV_VALID : ENV_REDUND;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000239#endif
240
Stephen Warren27ee0f32012-07-30 10:55:44 +0000241fini:
242 fini_mmc_for_env(mmc);
243 return ret;
Terry Lvb4eceac2010-05-17 10:57:01 +0800244}
Simon Glass082af922017-08-03 12:22:01 -0600245#endif /* CONFIG_CMD_SAVEENV && !CONFIG_SPL_BUILD */
Terry Lvb4eceac2010-05-17 10:57:01 +0800246
Igor Grinbergecbfb622011-11-07 01:14:05 +0000247static inline int read_env(struct mmc *mmc, unsigned long size,
248 unsigned long offset, const void *buffer)
Terry Lvb4eceac2010-05-17 10:57:01 +0800249{
250 uint blk_start, blk_cnt, n;
Simon Glassda898922016-05-14 14:03:03 -0600251 struct blk_desc *desc = mmc_get_blk_desc(mmc);
Terry Lvb4eceac2010-05-17 10:57:01 +0800252
Igor Grinbergecbfb622011-11-07 01:14:05 +0000253 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;
Terry Lvb4eceac2010-05-17 10:57:01 +0800255
Simon Glassda898922016-05-14 14:03:03 -0600256 n = blk_dread(desc, blk_start, blk_cnt, (uchar *)buffer);
Terry Lvb4eceac2010-05-17 10:57:01 +0800257
258 return (n == blk_cnt) ? 0 : -1;
259}
260
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000261#ifdef CONFIG_ENV_OFFSET_REDUND
Simon Glass99778492017-08-03 12:22:17 -0600262static int env_mmc_load(void)
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000263{
264#if !defined(ENV_IS_EMBEDDED)
Tom Rinic929f822014-03-28 12:03:34 -0400265 struct mmc *mmc;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000266 u32 offset1, offset2;
267 int read1_fail = 0, read2_fail = 0;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000268 int ret;
Clemens Gruberf7b61442016-01-20 15:43:37 +0100269 int dev = mmc_get_env_dev();
Tim Harveyeda75c32015-05-08 14:52:09 -0700270 const char *errmsg = NULL;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000271
Markus Niebel6ef41fd2013-10-04 15:48:03 +0200272 ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env1, 1);
273 ALLOC_CACHE_ALIGN_BUFFER(env_t, tmp_env2, 1);
274
Faiz Abbasaae518f2018-02-12 19:24:31 +0530275 mmc_initialize(NULL);
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
Simon Goldschmidte07096e2018-01-31 14:47:11 +0100294 ret = env_import_redund((char *)tmp_env1, read1_fail, (char *)tmp_env2,
295 read2_fail);
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000296
297fini:
298 fini_mmc_for_env(mmc);
299err:
300 if (ret)
Tim Harveyeda75c32015-05-08 14:52:09 -0700301 set_default_env(errmsg);
Simon Glass99778492017-08-03 12:22:17 -0600302
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000303#endif
Simon Glass99778492017-08-03 12:22:17 -0600304 return ret;
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000305}
306#else /* ! CONFIG_ENV_OFFSET_REDUND */
Simon Glass99778492017-08-03 12:22:17 -0600307static int env_mmc_load(void)
Terry Lvb4eceac2010-05-17 10:57:01 +0800308{
309#if !defined(ENV_IS_EMBEDDED)
Tom Rinia840b8e2013-04-05 14:55:21 -0400310 ALLOC_CACHE_ALIGN_BUFFER(char, buf, CONFIG_ENV_SIZE);
Tom Rinic929f822014-03-28 12:03:34 -0400311 struct mmc *mmc;
Mingkai Hua55fce32011-01-24 17:09:55 +0000312 u32 offset;
Stephen Warren27ee0f32012-07-30 10:55:44 +0000313 int ret;
Clemens Gruberf7b61442016-01-20 15:43:37 +0100314 int dev = mmc_get_env_dev();
Tim Harveyeda75c32015-05-08 14:52:09 -0700315 const char *errmsg;
Tom Rinic929f822014-03-28 12:03:34 -0400316
Tom Rinic929f822014-03-28 12:03:34 -0400317 mmc = find_mmc_device(dev);
Stephen Warren27ee0f32012-07-30 10:55:44 +0000318
Tim Harveyeda75c32015-05-08 14:52:09 -0700319 errmsg = init_mmc_for_env(mmc);
320 if (errmsg) {
Simon Glass99778492017-08-03 12:22:17 -0600321 ret = -EIO;
Stephen Warren27ee0f32012-07-30 10:55:44 +0000322 goto err;
323 }
Terry Lvb4eceac2010-05-17 10:57:01 +0800324
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000325 if (mmc_get_env_addr(mmc, 0, &offset)) {
Simon Glass99778492017-08-03 12:22:17 -0600326 ret = -EIO;
Stephen Warren27ee0f32012-07-30 10:55:44 +0000327 goto fini;
328 }
Terry Lvb4eceac2010-05-17 10:57:01 +0800329
Tom Rinia840b8e2013-04-05 14:55:21 -0400330 if (read_env(mmc, CONFIG_ENV_SIZE, offset, buf)) {
Tim Harveyeda75c32015-05-08 14:52:09 -0700331 errmsg = "!read failed";
Simon Glass99778492017-08-03 12:22:17 -0600332 ret = -EIO;
Stephen Warren27ee0f32012-07-30 10:55:44 +0000333 goto fini;
334 }
Terry Lvb4eceac2010-05-17 10:57:01 +0800335
Simon Goldschmidt35b4c322018-01-31 14:47:12 +0100336 ret = env_import(buf, 1);
Stephen Warren27ee0f32012-07-30 10:55:44 +0000337
338fini:
339 fini_mmc_for_env(mmc);
340err:
341 if (ret)
Tim Harveyeda75c32015-05-08 14:52:09 -0700342 set_default_env(errmsg);
Terry Lvb4eceac2010-05-17 10:57:01 +0800343#endif
Simon Glass99778492017-08-03 12:22:17 -0600344 return ret;
Terry Lvb4eceac2010-05-17 10:57:01 +0800345}
Michael Heimpolda1d25a32013-04-10 10:36:19 +0000346#endif /* CONFIG_ENV_OFFSET_REDUND */
Simon Glassc10a88e2017-08-03 12:21:58 -0600347
348U_BOOT_ENV_LOCATION(mmc) = {
349 .location = ENVL_MMC,
Simon Glassd8273ed2017-08-03 12:22:03 -0600350 ENV_NAME("MMC")
Simon Glass082af922017-08-03 12:22:01 -0600351 .load = env_mmc_load,
Simon Glassc10a88e2017-08-03 12:21:58 -0600352#ifndef CONFIG_SPL_BUILD
Simon Glass082af922017-08-03 12:22:01 -0600353 .save = env_save_ptr(env_mmc_save),
Simon Glassc10a88e2017-08-03 12:21:58 -0600354#endif
Simon Glassc10a88e2017-08-03 12:21:58 -0600355};