]>
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 TL |
39 | #else /* ! ENV_IS_EMBEDDED */ |
40 | env_t *env_ptr = NULL; | |
41 | #endif /* ENV_IS_EMBEDDED */ | |
42 | ||
43 | /* local functions */ | |
44 | #if !defined(ENV_IS_EMBEDDED) | |
45 | static void use_default(void); | |
46 | #endif | |
47 | ||
48 | DECLARE_GLOBAL_DATA_PTR; | |
49 | ||
97039ab9 MH |
50 | #if !defined(CONFIG_ENV_OFFSET) |
51 | #define CONFIG_ENV_OFFSET 0 | |
52 | #endif | |
53 | ||
54 | static int __mmc_get_env_addr(struct mmc *mmc, u32 *env_addr) | |
55 | { | |
56 | *env_addr = CONFIG_ENV_OFFSET; | |
57 | return 0; | |
58 | } | |
59 | __attribute__((weak, alias("__mmc_get_env_addr"))) | |
60 | int mmc_get_env_addr(struct mmc *mmc, u32 *env_addr); | |
61 | ||
62 | ||
a8060359 TL |
63 | uchar env_get_char_spec(int index) |
64 | { | |
65 | return *((uchar *)(gd->env_addr + index)); | |
66 | } | |
67 | ||
68 | int env_init(void) | |
69 | { | |
70 | /* use default */ | |
71 | gd->env_addr = (ulong)&default_environment[0]; | |
72 | gd->env_valid = 1; | |
73 | ||
74 | return 0; | |
75 | } | |
76 | ||
77 | int init_mmc_for_env(struct mmc *mmc) | |
78 | { | |
79 | if (!mmc) { | |
80 | puts("No MMC card found\n"); | |
81 | return -1; | |
82 | } | |
83 | ||
84 | if (mmc_init(mmc)) { | |
85 | puts("MMC init failed\n"); | |
86 | return -1; | |
87 | } | |
88 | ||
89 | return 0; | |
90 | } | |
91 | ||
92 | #ifdef CONFIG_CMD_SAVEENV | |
93 | ||
94 | inline int write_env(struct mmc *mmc, unsigned long size, | |
95 | unsigned long offset, const void *buffer) | |
96 | { | |
97 | uint blk_start, blk_cnt, n; | |
98 | ||
99 | blk_start = ALIGN(offset, mmc->write_bl_len) / mmc->write_bl_len; | |
100 | blk_cnt = ALIGN(size, mmc->write_bl_len) / mmc->write_bl_len; | |
101 | ||
102 | n = mmc->block_dev.block_write(CONFIG_SYS_MMC_ENV_DEV, blk_start, | |
103 | blk_cnt, (u_char *)buffer); | |
104 | ||
105 | return (n == blk_cnt) ? 0 : -1; | |
106 | } | |
107 | ||
108 | int saveenv(void) | |
109 | { | |
e79f4839 LW |
110 | env_t env_new; |
111 | ssize_t len; | |
112 | char *res; | |
a8060359 | 113 | struct mmc *mmc = find_mmc_device(CONFIG_SYS_MMC_ENV_DEV); |
97039ab9 | 114 | u32 offset; |
a8060359 TL |
115 | |
116 | if (init_mmc_for_env(mmc)) | |
117 | return 1; | |
118 | ||
97039ab9 MH |
119 | if(mmc_get_env_addr(mmc, &offset)) |
120 | return 1; | |
121 | ||
e79f4839 | 122 | res = (char *)&env_new.data; |
37f2fe74 | 123 | len = hexport_r(&env_htab, '\0', &res, ENV_SIZE, 0, NULL); |
e79f4839 LW |
124 | if (len < 0) { |
125 | error("Cannot export environment: errno = %d\n", errno); | |
126 | return 1; | |
127 | } | |
128 | env_new.crc = crc32(0, env_new.data, ENV_SIZE); | |
a8060359 | 129 | printf("Writing to MMC(%d)... ", CONFIG_SYS_MMC_ENV_DEV); |
97039ab9 | 130 | if (write_env(mmc, CONFIG_ENV_SIZE, offset, (u_char *)&env_new)) { |
a8060359 TL |
131 | puts("failed\n"); |
132 | return 1; | |
133 | } | |
134 | ||
135 | puts("done\n"); | |
136 | return 0; | |
137 | } | |
138 | #endif /* CONFIG_CMD_SAVEENV */ | |
139 | ||
140 | inline int read_env(struct mmc *mmc, unsigned long size, | |
141 | unsigned long offset, const void *buffer) | |
142 | { | |
143 | uint blk_start, blk_cnt, n; | |
144 | ||
145 | blk_start = ALIGN(offset, mmc->read_bl_len) / mmc->read_bl_len; | |
146 | blk_cnt = ALIGN(size, mmc->read_bl_len) / mmc->read_bl_len; | |
147 | ||
148 | n = mmc->block_dev.block_read(CONFIG_SYS_MMC_ENV_DEV, blk_start, | |
149 | blk_cnt, (uchar *)buffer); | |
150 | ||
151 | return (n == blk_cnt) ? 0 : -1; | |
152 | } | |
153 | ||
154 | void env_relocate_spec(void) | |
155 | { | |
156 | #if !defined(ENV_IS_EMBEDDED) | |
97039ab9 | 157 | char buf[CONFIG_ENV_SIZE]; |
d470a6f6 | 158 | |
a8060359 | 159 | struct mmc *mmc = find_mmc_device(CONFIG_SYS_MMC_ENV_DEV); |
97039ab9 | 160 | u32 offset; |
a8060359 | 161 | |
d470a6f6 SS |
162 | if (init_mmc_for_env(mmc)) { |
163 | use_default(); | |
a8060359 | 164 | return; |
d470a6f6 | 165 | } |
a8060359 | 166 | |
97039ab9 MH |
167 | if(mmc_get_env_addr(mmc, &offset)) { |
168 | use_default(); | |
169 | return ; | |
170 | } | |
171 | ||
172 | if (read_env(mmc, CONFIG_ENV_SIZE, offset, buf)) { | |
d470a6f6 SS |
173 | use_default(); |
174 | return; | |
175 | } | |
a8060359 | 176 | |
d470a6f6 | 177 | env_import(buf, 1); |
a8060359 TL |
178 | #endif |
179 | } | |
180 | ||
181 | #if !defined(ENV_IS_EMBEDDED) | |
182 | static void use_default() | |
183 | { | |
a2f69d35 | 184 | set_default_env(NULL); |
a8060359 TL |
185 | } |
186 | #endif |