]>
Commit | Line | Data |
---|---|---|
a8060359 | 1 | /* |
97039ab9 | 2 | * (C) Copyright 2008-2011 Freescale Semiconductor, Inc. |
a8060359 TL |
3 | * |
4 | * See file CREDITS for list of people who contributed to this | |
5 | * project. | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or | |
8 | * modify it under the terms of the GNU General Public License as | |
9 | * published by the Free Software Foundation; either version 2 of | |
10 | * the License, or (at your option) any later version. | |
11 | * | |
12 | * This program is distributed in the hope that it will be useful, | |
13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
15 | * GNU General Public License for more details. | |
16 | * | |
17 | * You should have received a copy of the GNU General Public License | |
18 | * along with this program; if not, write to the Free Software | |
19 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, | |
20 | * MA 02111-1307 USA | |
21 | */ | |
22 | ||
23 | /* #define DEBUG */ | |
24 | ||
25 | #include <common.h> | |
26 | ||
27 | #include <command.h> | |
28 | #include <environment.h> | |
29 | #include <linux/stddef.h> | |
30 | #include <malloc.h> | |
31 | #include <mmc.h> | |
6d1d51b3 | 32 | #include <search.h> |
e79f4839 | 33 | #include <errno.h> |
a8060359 | 34 | |
a8060359 TL |
35 | char *env_name_spec = "MMC"; |
36 | ||
37 | #ifdef ENV_IS_EMBEDDED | |
994bc671 | 38 | env_t *env_ptr = &environment; |
a8060359 | 39 | #else /* ! ENV_IS_EMBEDDED */ |
e8db8f71 | 40 | env_t *env_ptr; |
a8060359 TL |
41 | #endif /* ENV_IS_EMBEDDED */ |
42 | ||
a8060359 TL |
43 | DECLARE_GLOBAL_DATA_PTR; |
44 | ||
97039ab9 MH |
45 | #if !defined(CONFIG_ENV_OFFSET) |
46 | #define CONFIG_ENV_OFFSET 0 | |
47 | #endif | |
48 | ||
49 | static int __mmc_get_env_addr(struct mmc *mmc, u32 *env_addr) | |
50 | { | |
51 | *env_addr = CONFIG_ENV_OFFSET; | |
52 | return 0; | |
53 | } | |
e8db8f71 IG |
54 | int mmc_get_env_addr(struct mmc *mmc, u32 *env_addr) |
55 | __attribute__((weak, alias("__mmc_get_env_addr"))); | |
97039ab9 | 56 | |
a8060359 TL |
57 | int env_init(void) |
58 | { | |
59 | /* use default */ | |
e8db8f71 IG |
60 | gd->env_addr = (ulong)&default_environment[0]; |
61 | gd->env_valid = 1; | |
a8060359 TL |
62 | |
63 | return 0; | |
64 | } | |
65 | ||
e8db8f71 | 66 | static int init_mmc_for_env(struct mmc *mmc) |
a8060359 TL |
67 | { |
68 | if (!mmc) { | |
69 | puts("No MMC card found\n"); | |
70 | return -1; | |
71 | } | |
72 | ||
73 | if (mmc_init(mmc)) { | |
74 | puts("MMC init failed\n"); | |
e8db8f71 | 75 | return -1; |
a8060359 TL |
76 | } |
77 | ||
9404a5fc SW |
78 | #ifdef CONFIG_SYS_MMC_ENV_PART |
79 | if (CONFIG_SYS_MMC_ENV_PART != mmc->part_num) { | |
80 | if (mmc_switch_part(CONFIG_SYS_MMC_ENV_DEV, | |
81 | CONFIG_SYS_MMC_ENV_PART)) { | |
82 | puts("MMC partition switch failed\n"); | |
83 | return -1; | |
84 | } | |
85 | } | |
86 | #endif | |
87 | ||
a8060359 TL |
88 | return 0; |
89 | } | |
90 | ||
9404a5fc SW |
91 | static void fini_mmc_for_env(struct mmc *mmc) |
92 | { | |
93 | #ifdef CONFIG_SYS_MMC_ENV_PART | |
94 | if (CONFIG_SYS_MMC_ENV_PART != mmc->part_num) | |
95 | mmc_switch_part(CONFIG_SYS_MMC_ENV_DEV, | |
96 | mmc->part_num); | |
97 | #endif | |
98 | } | |
99 | ||
a8060359 | 100 | #ifdef CONFIG_CMD_SAVEENV |
e8db8f71 IG |
101 | static inline int write_env(struct mmc *mmc, unsigned long size, |
102 | unsigned long offset, const void *buffer) | |
a8060359 TL |
103 | { |
104 | uint blk_start, blk_cnt, n; | |
105 | ||
e8db8f71 IG |
106 | blk_start = ALIGN(offset, mmc->write_bl_len) / mmc->write_bl_len; |
107 | blk_cnt = ALIGN(size, mmc->write_bl_len) / mmc->write_bl_len; | |
a8060359 TL |
108 | |
109 | n = mmc->block_dev.block_write(CONFIG_SYS_MMC_ENV_DEV, blk_start, | |
110 | blk_cnt, (u_char *)buffer); | |
111 | ||
112 | return (n == blk_cnt) ? 0 : -1; | |
113 | } | |
114 | ||
115 | int saveenv(void) | |
116 | { | |
4036b630 | 117 | ALLOC_CACHE_ALIGN_BUFFER(env_t, env_new, 1); |
e79f4839 LW |
118 | ssize_t len; |
119 | char *res; | |
a8060359 | 120 | struct mmc *mmc = find_mmc_device(CONFIG_SYS_MMC_ENV_DEV); |
e8db8f71 | 121 | u32 offset; |
9404a5fc | 122 | int ret; |
a8060359 | 123 | |
9404a5fc | 124 | if (init_mmc_for_env(mmc)) |
97039ab9 MH |
125 | return 1; |
126 | ||
9404a5fc SW |
127 | if (mmc_get_env_addr(mmc, &offset)) { |
128 | ret = 1; | |
129 | goto fini; | |
130 | } | |
131 | ||
4036b630 | 132 | res = (char *)&env_new->data; |
be11235a | 133 | len = hexport_r(&env_htab, '\0', 0, &res, ENV_SIZE, 0, NULL); |
e79f4839 LW |
134 | if (len < 0) { |
135 | error("Cannot export environment: errno = %d\n", errno); | |
9404a5fc SW |
136 | ret = 1; |
137 | goto fini; | |
e79f4839 | 138 | } |
e8db8f71 | 139 | |
4036b630 | 140 | env_new->crc = crc32(0, &env_new->data[0], ENV_SIZE); |
a8060359 | 141 | printf("Writing to MMC(%d)... ", CONFIG_SYS_MMC_ENV_DEV); |
4036b630 | 142 | if (write_env(mmc, CONFIG_ENV_SIZE, offset, (u_char *)env_new)) { |
a8060359 | 143 | puts("failed\n"); |
9404a5fc SW |
144 | ret = 1; |
145 | goto fini; | |
a8060359 TL |
146 | } |
147 | ||
148 | puts("done\n"); | |
9404a5fc SW |
149 | ret = 0; |
150 | ||
151 | fini: | |
152 | fini_mmc_for_env(mmc); | |
153 | return ret; | |
a8060359 TL |
154 | } |
155 | #endif /* CONFIG_CMD_SAVEENV */ | |
156 | ||
e8db8f71 IG |
157 | static inline int read_env(struct mmc *mmc, unsigned long size, |
158 | unsigned long offset, const void *buffer) | |
a8060359 TL |
159 | { |
160 | uint blk_start, blk_cnt, n; | |
161 | ||
e8db8f71 IG |
162 | blk_start = ALIGN(offset, mmc->read_bl_len) / mmc->read_bl_len; |
163 | blk_cnt = ALIGN(size, mmc->read_bl_len) / mmc->read_bl_len; | |
a8060359 TL |
164 | |
165 | n = mmc->block_dev.block_read(CONFIG_SYS_MMC_ENV_DEV, blk_start, | |
166 | blk_cnt, (uchar *)buffer); | |
167 | ||
168 | return (n == blk_cnt) ? 0 : -1; | |
169 | } | |
170 | ||
171 | void env_relocate_spec(void) | |
172 | { | |
173 | #if !defined(ENV_IS_EMBEDDED) | |
4036b630 | 174 | ALLOC_CACHE_ALIGN_BUFFER(char, buf, CONFIG_ENV_SIZE); |
a8060359 | 175 | struct mmc *mmc = find_mmc_device(CONFIG_SYS_MMC_ENV_DEV); |
97039ab9 | 176 | u32 offset; |
9404a5fc | 177 | int ret; |
a8060359 | 178 | |
9404a5fc SW |
179 | if (init_mmc_for_env(mmc)) { |
180 | ret = 1; | |
181 | goto err; | |
182 | } | |
a8060359 | 183 | |
9404a5fc SW |
184 | if (mmc_get_env_addr(mmc, &offset)) { |
185 | ret = 1; | |
186 | goto fini; | |
187 | } | |
188 | ||
189 | if (read_env(mmc, CONFIG_ENV_SIZE, offset, buf)) { | |
190 | ret = 1; | |
191 | goto fini; | |
192 | } | |
a8060359 | 193 | |
d470a6f6 | 194 | env_import(buf, 1); |
9404a5fc SW |
195 | ret = 0; |
196 | ||
197 | fini: | |
198 | fini_mmc_for_env(mmc); | |
199 | err: | |
200 | if (ret) | |
201 | set_default_env(NULL); | |
a8060359 TL |
202 | #endif |
203 | } |