blob: 5e3da6dca7596919ca5ae1f01e2f495d05d1b536 [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Terry Lva8060352010-05-17 10:57:01 +08002/*
Mingkai Hu97039ab2011-01-24 17:09:55 +00003 * (C) Copyright 2008-2011 Freescale Semiconductor, Inc.
Terry Lva8060352010-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 Tomsichf8b8a552017-05-16 00:16:31 +020012#include <fdtdec.h>
Terry Lva8060352010-05-17 10:57:01 +080013#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>
Jorge Ramirez-Ortizc9e87ba2017-11-06 14:16:37 +010017#include <part.h>
Lei Wen6d1d51b2010-11-10 07:39:23 +080018#include <search.h>
Lei Wene79f4832010-10-13 11:07:21 +080019#include <errno.h>
Terry Lva8060352010-05-17 10:57:01 +080020
Jorge Ramirez-Ortizc9e87ba2017-11-06 14:16:37 +010021#define __STR(X) #X
22#define STR(X) __STR(X)
23
Michael Heimpoldd196bd82013-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 Lva8060352010-05-17 10:57:01 +080029DECLARE_GLOBAL_DATA_PTR;
30
Mingkai Hu97039ab2011-01-24 17:09:55 +000031#if !defined(CONFIG_ENV_OFFSET)
32#define CONFIG_ENV_OFFSET 0
33#endif
34
Philipp Tomsichf8b8a552017-05-16 00:16:31 +020035#if CONFIG_IS_ENABLED(OF_CONTROL)
Jorge Ramirez-Ortizc9e87ba2017-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 Tomsichf8b8a552017-05-16 00:16:31 +020064static inline s64 mmc_offset(int copy)
Mingkai Hu97039ab2011-01-24 17:09:55 +000065{
Jorge Ramirez-Ortizc9e87ba2017-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 Tomsichfd374662017-11-21 23:29:40 +010075 s64 val = 0, defvalue;
Jorge Ramirez-Ortizc9e87ba2017-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;
Stephen Warren5c088ee2013-06-11 15:14:02 -060091
Philipp Tomsichf8b8a552017-05-16 00:16:31 +020092#if defined(CONFIG_ENV_OFFSET_REDUND)
93 if (copy) {
Philipp Tomsichf8b8a552017-05-16 00:16:31 +020094 defvalue = CONFIG_ENV_OFFSET_REDUND;
Jorge Ramirez-Ortizc9e87ba2017-11-06 14:16:37 +010095 propname = dt_prop.offset_redund;
Philipp Tomsichf8b8a552017-05-16 00:16:31 +020096 }
97#endif
Philipp Tomsichf8b8a552017-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)
102{
103 s64 offset = CONFIG_ENV_OFFSET;
104
105#if defined(CONFIG_ENV_OFFSET_REDUND)
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000106 if (copy)
Stephen Warren5c088ee2013-06-11 15:14:02 -0600107 offset = CONFIG_ENV_OFFSET_REDUND;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000108#endif
Philipp Tomsichf8b8a552017-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 Warren5c088ee2013-06-11 15:14:02 -0600116
117 if (offset < 0)
118 offset += mmc->capacity;
119
120 *env_addr = offset;
121
Mingkai Hu97039ab2011-01-24 17:09:55 +0000122 return 0;
123}
Mingkai Hu97039ab2011-01-24 17:09:55 +0000124
Clemens Grubere92029c2016-01-20 15:43:37 +0100125__weak int mmc_get_env_dev(void)
126{
127 return CONFIG_SYS_MMC_ENV_DEV;
128}
129
Tom Rinib9c8cca2014-03-28 12:03:34 -0400130#ifdef CONFIG_SYS_MMC_ENV_PART
Dmitry Lifshitz6e7b7df2014-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 Warren873cc1d2015-12-07 11:38:49 -0700136static unsigned char env_mmc_orig_hwpart;
137
Dmitry Lifshitz6e7b7df2014-07-30 13:19:06 +0300138static int mmc_set_env_part(struct mmc *mmc)
139{
140 uint part = mmc_get_env_part(mmc);
Clemens Grubere92029c2016-01-20 15:43:37 +0100141 int dev = mmc_get_env_dev();
Dmitry Lifshitz6e7b7df2014-07-30 13:19:06 +0300142 int ret = 0;
Tom Rinib9c8cca2014-03-28 12:03:34 -0400143
Simon Glass69f45cd2016-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 Warren873cc1d2015-12-07 11:38:49 -0700146 if (ret)
147 puts("MMC partition switch failed\n");
Dmitry Lifshitz6e7b7df2014-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 Rinib9c8cca2014-03-28 12:03:34 -0400153#endif
154
Tim Harveyc75648d2015-05-08 14:52:09 -0700155static const char *init_mmc_for_env(struct mmc *mmc)
Dmitry Lifshitz6e7b7df2014-07-30 13:19:06 +0300156{
Tim Harveyc75648d2015-05-08 14:52:09 -0700157 if (!mmc)
Hans de Goedea85da212015-08-15 20:05:01 +0200158 return "!No MMC card found";
Terry Lva8060352010-05-17 10:57:01 +0800159
Sjoerd Simonsd48b8d12018-03-22 22:53:50 +0100160#if CONFIG_IS_ENABLED(BLK)
Simon Glass01b73fe2017-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 Harveyc75648d2015-05-08 14:52:09 -0700166 if (mmc_init(mmc))
Hans de Goedea85da212015-08-15 20:05:01 +0200167 return "!MMC init failed";
Simon Glasse7017a32017-04-23 20:02:04 -0600168#endif
Tim Harveyc75648d2015-05-08 14:52:09 -0700169 if (mmc_set_env_part(mmc))
Hans de Goedea85da212015-08-15 20:05:01 +0200170 return "!MMC partition switch failed";
Tim Harveyc75648d2015-05-08 14:52:09 -0700171
172 return NULL;
Terry Lva8060352010-05-17 10:57:01 +0800173}
174
Stephen Warren9404a5f2012-07-30 10:55:44 +0000175static void fini_mmc_for_env(struct mmc *mmc)
176{
177#ifdef CONFIG_SYS_MMC_ENV_PART
Clemens Grubere92029c2016-01-20 15:43:37 +0100178 int dev = mmc_get_env_dev();
Tom Rinib9c8cca2014-03-28 12:03:34 -0400179
Simon Glass69f45cd2016-05-01 13:52:29 -0600180 blk_select_hwpart_devnum(IF_TYPE_MMC, dev, env_mmc_orig_hwpart);
Stephen Warren9404a5f2012-07-30 10:55:44 +0000181#endif
182}
183
Simon Glasse5bce242017-08-03 12:22:01 -0600184#if defined(CONFIG_CMD_SAVEENV) && !defined(CONFIG_SPL_BUILD)
Igor Grinberge8db8f72011-11-07 01:14:05 +0000185static inline int write_env(struct mmc *mmc, unsigned long size,
186 unsigned long offset, const void *buffer)
Terry Lva8060352010-05-17 10:57:01 +0800187{
188 uint blk_start, blk_cnt, n;
Simon Glass5461acb2016-05-14 14:03:03 -0600189 struct blk_desc *desc = mmc_get_blk_desc(mmc);
Terry Lva8060352010-05-17 10:57:01 +0800190
Igor Grinberge8db8f72011-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 Lva8060352010-05-17 10:57:01 +0800193
Simon Glass5461acb2016-05-14 14:03:03 -0600194 n = blk_dwrite(desc, blk_start, blk_cnt, (u_char *)buffer);
Terry Lva8060352010-05-17 10:57:01 +0800195
196 return (n == blk_cnt) ? 0 : -1;
197}
198
Simon Glasse5bce242017-08-03 12:22:01 -0600199static int env_mmc_save(void)
Terry Lva8060352010-05-17 10:57:01 +0800200{
Tom Rinicd0f4fa2013-04-05 14:55:21 -0400201 ALLOC_CACHE_ALIGN_BUFFER(env_t, env_new, 1);
Clemens Grubere92029c2016-01-20 15:43:37 +0100202 int dev = mmc_get_env_dev();
203 struct mmc *mmc = find_mmc_device(dev);
Igor Grinberge8db8f72011-11-07 01:14:05 +0000204 u32 offset;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000205 int ret, copy = 0;
Tim Harveyc75648d2015-05-08 14:52:09 -0700206 const char *errmsg;
Terry Lva8060352010-05-17 10:57:01 +0800207
Tim Harveyc75648d2015-05-08 14:52:09 -0700208 errmsg = init_mmc_for_env(mmc);
209 if (errmsg) {
210 printf("%s\n", errmsg);
Mingkai Hu97039ab2011-01-24 17:09:55 +0000211 return 1;
Tim Harveyc75648d2015-05-08 14:52:09 -0700212 }
Mingkai Hu97039ab2011-01-24 17:09:55 +0000213
Marek Vasut7ce15262014-03-05 19:59:50 +0100214 ret = env_export(env_new);
215 if (ret)
Stephen Warren9404a5f2012-07-30 10:55:44 +0000216 goto fini;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000217
218#ifdef CONFIG_ENV_OFFSET_REDUND
Simon Glass203e94f2017-08-03 12:21:56 -0600219 if (gd->env_valid == ENV_VALID)
Michael Heimpoldd196bd82013-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 Grubere92029c2016-01-20 15:43:37 +0100228 printf("Writing to %sMMC(%d)... ", copy ? "redundant " : "", dev);
Stephen Warren4036b632012-05-24 11:38:33 +0000229 if (write_env(mmc, CONFIG_ENV_SIZE, offset, (u_char *)env_new)) {
Terry Lva8060352010-05-17 10:57:01 +0800230 puts("failed\n");
Stephen Warren9404a5f2012-07-30 10:55:44 +0000231 ret = 1;
232 goto fini;
Terry Lva8060352010-05-17 10:57:01 +0800233 }
234
Stephen Warren9404a5f2012-07-30 10:55:44 +0000235 ret = 0;
236
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000237#ifdef CONFIG_ENV_OFFSET_REDUND
Simon Glass203e94f2017-08-03 12:21:56 -0600238 gd->env_valid = gd->env_valid == ENV_REDUND ? ENV_VALID : ENV_REDUND;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000239#endif
240
Stephen Warren9404a5f2012-07-30 10:55:44 +0000241fini:
242 fini_mmc_for_env(mmc);
243 return ret;
Terry Lva8060352010-05-17 10:57:01 +0800244}
Simon Glasse5bce242017-08-03 12:22:01 -0600245#endif /* CONFIG_CMD_SAVEENV && !CONFIG_SPL_BUILD */
Terry Lva8060352010-05-17 10:57:01 +0800246
Igor Grinberge8db8f72011-11-07 01:14:05 +0000247static inline int read_env(struct mmc *mmc, unsigned long size,
248 unsigned long offset, const void *buffer)
Terry Lva8060352010-05-17 10:57:01 +0800249{
250 uint blk_start, blk_cnt, n;
Simon Glass5461acb2016-05-14 14:03:03 -0600251 struct blk_desc *desc = mmc_get_blk_desc(mmc);
Terry Lva8060352010-05-17 10:57:01 +0800252
Igor Grinberge8db8f72011-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 Lva8060352010-05-17 10:57:01 +0800255
Simon Glass5461acb2016-05-14 14:03:03 -0600256 n = blk_dread(desc, blk_start, blk_cnt, (uchar *)buffer);
Terry Lva8060352010-05-17 10:57:01 +0800257
258 return (n == blk_cnt) ? 0 : -1;
259}
260
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000261#ifdef CONFIG_ENV_OFFSET_REDUND
Simon Glassc5951992017-08-03 12:22:17 -0600262static int env_mmc_load(void)
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000263{
264#if !defined(ENV_IS_EMBEDDED)
Tom Rinib9c8cca2014-03-28 12:03:34 -0400265 struct mmc *mmc;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000266 u32 offset1, offset2;
267 int read1_fail = 0, read2_fail = 0;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000268 int ret;
Clemens Grubere92029c2016-01-20 15:43:37 +0100269 int dev = mmc_get_env_dev();
Tim Harveyc75648d2015-05-08 14:52:09 -0700270 const char *errmsg = NULL;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000271
Markus Niebel452a2722013-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 Abbas26862b42018-02-12 19:24:31 +0530275 mmc_initialize(NULL);
276
Tom Rinib9c8cca2014-03-28 12:03:34 -0400277 mmc = find_mmc_device(dev);
278
Tim Harveyc75648d2015-05-08 14:52:09 -0700279 errmsg = init_mmc_for_env(mmc);
280 if (errmsg) {
Simon Glassc5951992017-08-03 12:22:17 -0600281 ret = -EIO;
Michael Heimpoldd196bd82013-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 Glassc5951992017-08-03 12:22:17 -0600287 ret = -EIO;
Michael Heimpoldd196bd82013-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 Goldschmidt31f044b2018-01-31 14:47:11 +0100294 ret = env_import_redund((char *)tmp_env1, read1_fail, (char *)tmp_env2,
295 read2_fail);
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000296
297fini:
298 fini_mmc_for_env(mmc);
299err:
300 if (ret)
Tim Harveyc75648d2015-05-08 14:52:09 -0700301 set_default_env(errmsg);
Simon Glassc5951992017-08-03 12:22:17 -0600302
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000303#endif
Simon Glassc5951992017-08-03 12:22:17 -0600304 return ret;
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000305}
306#else /* ! CONFIG_ENV_OFFSET_REDUND */
Simon Glassc5951992017-08-03 12:22:17 -0600307static int env_mmc_load(void)
Terry Lva8060352010-05-17 10:57:01 +0800308{
309#if !defined(ENV_IS_EMBEDDED)
Tom Rinicd0f4fa2013-04-05 14:55:21 -0400310 ALLOC_CACHE_ALIGN_BUFFER(char, buf, CONFIG_ENV_SIZE);
Tom Rinib9c8cca2014-03-28 12:03:34 -0400311 struct mmc *mmc;
Mingkai Hu97039ab2011-01-24 17:09:55 +0000312 u32 offset;
Stephen Warren9404a5f2012-07-30 10:55:44 +0000313 int ret;
Clemens Grubere92029c2016-01-20 15:43:37 +0100314 int dev = mmc_get_env_dev();
Tim Harveyc75648d2015-05-08 14:52:09 -0700315 const char *errmsg;
Tom Rinib9c8cca2014-03-28 12:03:34 -0400316
Tom Rinib9c8cca2014-03-28 12:03:34 -0400317 mmc = find_mmc_device(dev);
Terry Lva8060352010-05-17 10:57:01 +0800318
Tim Harveyc75648d2015-05-08 14:52:09 -0700319 errmsg = init_mmc_for_env(mmc);
320 if (errmsg) {
Simon Glassc5951992017-08-03 12:22:17 -0600321 ret = -EIO;
Stephen Warren9404a5f2012-07-30 10:55:44 +0000322 goto err;
323 }
Terry Lva8060352010-05-17 10:57:01 +0800324
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000325 if (mmc_get_env_addr(mmc, 0, &offset)) {
Simon Glassc5951992017-08-03 12:22:17 -0600326 ret = -EIO;
Stephen Warren9404a5f2012-07-30 10:55:44 +0000327 goto fini;
328 }
329
Tom Rinicd0f4fa2013-04-05 14:55:21 -0400330 if (read_env(mmc, CONFIG_ENV_SIZE, offset, buf)) {
Tim Harveyc75648d2015-05-08 14:52:09 -0700331 errmsg = "!read failed";
Simon Glassc5951992017-08-03 12:22:17 -0600332 ret = -EIO;
Stephen Warren9404a5f2012-07-30 10:55:44 +0000333 goto fini;
334 }
Terry Lva8060352010-05-17 10:57:01 +0800335
Simon Goldschmidt2166ebf2018-01-31 14:47:12 +0100336 ret = env_import(buf, 1);
Stephen Warren9404a5f2012-07-30 10:55:44 +0000337
338fini:
339 fini_mmc_for_env(mmc);
340err:
341 if (ret)
Tim Harveyc75648d2015-05-08 14:52:09 -0700342 set_default_env(errmsg);
Terry Lva8060352010-05-17 10:57:01 +0800343#endif
Simon Glassc5951992017-08-03 12:22:17 -0600344 return ret;
Terry Lva8060352010-05-17 10:57:01 +0800345}
Michael Heimpoldd196bd82013-04-10 10:36:19 +0000346#endif /* CONFIG_ENV_OFFSET_REDUND */
Simon Glass4415f1d2017-08-03 12:21:58 -0600347
348U_BOOT_ENV_LOCATION(mmc) = {
349 .location = ENVL_MMC,
Simon Glassac358be2017-08-03 12:22:03 -0600350 ENV_NAME("MMC")
Simon Glasse5bce242017-08-03 12:22:01 -0600351 .load = env_mmc_load,
Simon Glass4415f1d2017-08-03 12:21:58 -0600352#ifndef CONFIG_SPL_BUILD
Simon Glasse5bce242017-08-03 12:22:01 -0600353 .save = env_save_ptr(env_mmc_save),
Simon Glass4415f1d2017-08-03 12:21:58 -0600354#endif
Simon Glass4415f1d2017-08-03 12:21:58 -0600355};