]>
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 | ||
b5654080 | 49 | __weak int mmc_get_env_addr(struct mmc *mmc, u32 *env_addr) |
97039ab9 MH |
50 | { |
51 | *env_addr = CONFIG_ENV_OFFSET; | |
52 | return 0; | |
53 | } | |
97039ab9 | 54 | |
a8060359 TL |
55 | int env_init(void) |
56 | { | |
57 | /* use default */ | |
e8db8f71 IG |
58 | gd->env_addr = (ulong)&default_environment[0]; |
59 | gd->env_valid = 1; | |
a8060359 TL |
60 | |
61 | return 0; | |
62 | } | |
63 | ||
e8db8f71 | 64 | static int init_mmc_for_env(struct mmc *mmc) |
a8060359 TL |
65 | { |
66 | if (!mmc) { | |
67 | puts("No MMC card found\n"); | |
68 | return -1; | |
69 | } | |
70 | ||
71 | if (mmc_init(mmc)) { | |
72 | puts("MMC init failed\n"); | |
e8db8f71 | 73 | return -1; |
a8060359 TL |
74 | } |
75 | ||
9404a5fc SW |
76 | #ifdef CONFIG_SYS_MMC_ENV_PART |
77 | if (CONFIG_SYS_MMC_ENV_PART != mmc->part_num) { | |
78 | if (mmc_switch_part(CONFIG_SYS_MMC_ENV_DEV, | |
79 | CONFIG_SYS_MMC_ENV_PART)) { | |
80 | puts("MMC partition switch failed\n"); | |
81 | return -1; | |
82 | } | |
83 | } | |
84 | #endif | |
85 | ||
a8060359 TL |
86 | return 0; |
87 | } | |
88 | ||
9404a5fc SW |
89 | static void fini_mmc_for_env(struct mmc *mmc) |
90 | { | |
91 | #ifdef CONFIG_SYS_MMC_ENV_PART | |
92 | if (CONFIG_SYS_MMC_ENV_PART != mmc->part_num) | |
93 | mmc_switch_part(CONFIG_SYS_MMC_ENV_DEV, | |
94 | mmc->part_num); | |
95 | #endif | |
96 | } | |
97 | ||
a8060359 | 98 | #ifdef CONFIG_CMD_SAVEENV |
e8db8f71 IG |
99 | static inline int write_env(struct mmc *mmc, unsigned long size, |
100 | unsigned long offset, const void *buffer) | |
a8060359 TL |
101 | { |
102 | uint blk_start, blk_cnt, n; | |
103 | ||
e8db8f71 IG |
104 | blk_start = ALIGN(offset, mmc->write_bl_len) / mmc->write_bl_len; |
105 | blk_cnt = ALIGN(size, mmc->write_bl_len) / mmc->write_bl_len; | |
a8060359 TL |
106 | |
107 | n = mmc->block_dev.block_write(CONFIG_SYS_MMC_ENV_DEV, blk_start, | |
108 | blk_cnt, (u_char *)buffer); | |
109 | ||
110 | return (n == blk_cnt) ? 0 : -1; | |
111 | } | |
112 | ||
113 | int saveenv(void) | |
114 | { | |
cd0f4fa1 | 115 | ALLOC_CACHE_ALIGN_BUFFER(env_t, env_new, 1); |
e79f4839 LW |
116 | ssize_t len; |
117 | char *res; | |
a8060359 | 118 | struct mmc *mmc = find_mmc_device(CONFIG_SYS_MMC_ENV_DEV); |
e8db8f71 | 119 | u32 offset; |
9404a5fc | 120 | int ret; |
a8060359 | 121 | |
9404a5fc | 122 | if (init_mmc_for_env(mmc)) |
97039ab9 MH |
123 | return 1; |
124 | ||
9404a5fc SW |
125 | if (mmc_get_env_addr(mmc, &offset)) { |
126 | ret = 1; | |
127 | goto fini; | |
128 | } | |
129 | ||
cd0f4fa1 | 130 | res = (char *)&env_new->data; |
be11235a | 131 | len = hexport_r(&env_htab, '\0', 0, &res, ENV_SIZE, 0, NULL); |
e79f4839 LW |
132 | if (len < 0) { |
133 | error("Cannot export environment: errno = %d\n", errno); | |
9404a5fc SW |
134 | ret = 1; |
135 | goto fini; | |
e79f4839 | 136 | } |
e8db8f71 | 137 | |
cd0f4fa1 | 138 | env_new->crc = crc32(0, &env_new->data[0], ENV_SIZE); |
a8060359 | 139 | printf("Writing to MMC(%d)... ", CONFIG_SYS_MMC_ENV_DEV); |
4036b630 | 140 | if (write_env(mmc, CONFIG_ENV_SIZE, offset, (u_char *)env_new)) { |
a8060359 | 141 | puts("failed\n"); |
9404a5fc SW |
142 | ret = 1; |
143 | goto fini; | |
a8060359 TL |
144 | } |
145 | ||
146 | puts("done\n"); | |
9404a5fc SW |
147 | ret = 0; |
148 | ||
149 | fini: | |
150 | fini_mmc_for_env(mmc); | |
151 | return ret; | |
a8060359 TL |
152 | } |
153 | #endif /* CONFIG_CMD_SAVEENV */ | |
154 | ||
e8db8f71 IG |
155 | static inline int read_env(struct mmc *mmc, unsigned long size, |
156 | unsigned long offset, const void *buffer) | |
a8060359 TL |
157 | { |
158 | uint blk_start, blk_cnt, n; | |
159 | ||
e8db8f71 IG |
160 | blk_start = ALIGN(offset, mmc->read_bl_len) / mmc->read_bl_len; |
161 | blk_cnt = ALIGN(size, mmc->read_bl_len) / mmc->read_bl_len; | |
a8060359 TL |
162 | |
163 | n = mmc->block_dev.block_read(CONFIG_SYS_MMC_ENV_DEV, blk_start, | |
164 | blk_cnt, (uchar *)buffer); | |
165 | ||
166 | return (n == blk_cnt) ? 0 : -1; | |
167 | } | |
168 | ||
169 | void env_relocate_spec(void) | |
170 | { | |
171 | #if !defined(ENV_IS_EMBEDDED) | |
cd0f4fa1 | 172 | ALLOC_CACHE_ALIGN_BUFFER(char, buf, CONFIG_ENV_SIZE); |
a8060359 | 173 | struct mmc *mmc = find_mmc_device(CONFIG_SYS_MMC_ENV_DEV); |
97039ab9 | 174 | u32 offset; |
9404a5fc | 175 | int ret; |
a8060359 | 176 | |
9404a5fc SW |
177 | if (init_mmc_for_env(mmc)) { |
178 | ret = 1; | |
179 | goto err; | |
180 | } | |
a8060359 | 181 | |
9404a5fc SW |
182 | if (mmc_get_env_addr(mmc, &offset)) { |
183 | ret = 1; | |
184 | goto fini; | |
185 | } | |
186 | ||
cd0f4fa1 | 187 | if (read_env(mmc, CONFIG_ENV_SIZE, offset, buf)) { |
9404a5fc SW |
188 | ret = 1; |
189 | goto fini; | |
190 | } | |
a8060359 | 191 | |
cd0f4fa1 | 192 | env_import(buf, 1); |
9404a5fc SW |
193 | ret = 0; |
194 | ||
195 | fini: | |
196 | fini_mmc_for_env(mmc); | |
197 | err: | |
198 | if (ret) | |
199 | set_default_env(NULL); | |
a8060359 TL |
200 | #endif |
201 | } |