]>
Commit | Line | Data |
---|---|---|
0bc4a1ac | 1 | /* |
ea882baf | 2 | * (C) Copyright 2000-2010 |
0bc4a1ac WD |
3 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. |
4 | * | |
5 | * (C) Copyright 2001 Sysgo Real-Time Solutions, GmbH <www.elinos.com> | |
6 | * Andreas Heppel <aheppel@sysgo.de> | |
ea882baf | 7 | * |
1a459660 | 8 | * SPDX-License-Identifier: GPL-2.0+ |
0bc4a1ac WD |
9 | */ |
10 | ||
11 | #include <common.h> | |
0bc4a1ac WD |
12 | #include <command.h> |
13 | #include <environment.h> | |
0bc4a1ac | 14 | #include <linux/stddef.h> |
548738b4 HS |
15 | #if defined(CONFIG_I2C_ENV_EEPROM_BUS) |
16 | #include <i2c.h> | |
17 | #endif | |
ea882baf WD |
18 | #include <search.h> |
19 | #include <errno.h> | |
20 | #include <linux/compiler.h> /* for BUG_ON */ | |
0bc4a1ac | 21 | |
d87080b7 WD |
22 | DECLARE_GLOBAL_DATA_PTR; |
23 | ||
dd2a233c | 24 | env_t *env_ptr; |
0bc4a1ac | 25 | |
ea882baf | 26 | char *env_name_spec = "EEPROM"; |
548738b4 HS |
27 | int env_eeprom_bus = -1; |
28 | ||
ea882baf | 29 | static int eeprom_bus_read(unsigned dev_addr, unsigned offset, |
dd2a233c | 30 | uchar *buffer, unsigned cnt) |
548738b4 HS |
31 | { |
32 | int rcode; | |
33 | #if defined(CONFIG_I2C_ENV_EEPROM_BUS) | |
34 | int old_bus = i2c_get_bus_num(); | |
35 | ||
36 | if (gd->flags & GD_FLG_RELOC) { | |
37 | if (env_eeprom_bus == -1) { | |
38 | I2C_MUX_DEVICE *dev = NULL; | |
39 | dev = i2c_mux_ident_muxstring( | |
40 | (uchar *)CONFIG_I2C_ENV_EEPROM_BUS); | |
ea882baf | 41 | if (dev != NULL) |
548738b4 | 42 | env_eeprom_bus = dev->busid; |
ea882baf | 43 | else |
dd2a233c | 44 | printf("error adding env eeprom bus.\n"); |
548738b4 HS |
45 | } |
46 | if (old_bus != env_eeprom_bus) { | |
47 | i2c_set_bus_num(env_eeprom_bus); | |
48 | old_bus = env_eeprom_bus; | |
49 | } | |
50 | } else { | |
51 | rcode = i2c_mux_ident_muxstring_f( | |
52 | (uchar *)CONFIG_I2C_ENV_EEPROM_BUS); | |
53 | } | |
54 | #endif | |
55 | ||
dd2a233c | 56 | rcode = eeprom_read(dev_addr, offset, buffer, cnt); |
ea882baf | 57 | |
548738b4 HS |
58 | #if defined(CONFIG_I2C_ENV_EEPROM_BUS) |
59 | if (old_bus != env_eeprom_bus) | |
60 | i2c_set_bus_num(old_bus); | |
61 | #endif | |
62 | return rcode; | |
63 | } | |
64 | ||
ea882baf | 65 | static int eeprom_bus_write(unsigned dev_addr, unsigned offset, |
dd2a233c | 66 | uchar *buffer, unsigned cnt) |
548738b4 HS |
67 | { |
68 | int rcode; | |
69 | #if defined(CONFIG_I2C_ENV_EEPROM_BUS) | |
70 | int old_bus = i2c_get_bus_num(); | |
71 | ||
72 | rcode = i2c_mux_ident_muxstring_f((uchar *)CONFIG_I2C_ENV_EEPROM_BUS); | |
73 | #endif | |
ea882baf | 74 | rcode = eeprom_write(dev_addr, offset, buffer, cnt); |
548738b4 HS |
75 | #if defined(CONFIG_I2C_ENV_EEPROM_BUS) |
76 | i2c_set_bus_num(old_bus); | |
77 | #endif | |
78 | return rcode; | |
79 | } | |
0bc4a1ac | 80 | |
dd2a233c | 81 | uchar env_get_char_spec(int index) |
0bc4a1ac WD |
82 | { |
83 | uchar c; | |
dd2a233c | 84 | unsigned int off = CONFIG_ENV_OFFSET; |
ea882baf | 85 | |
1567b596 HS |
86 | #ifdef CONFIG_ENV_OFFSET_REDUND |
87 | if (gd->env_valid == 2) | |
88 | off = CONFIG_ENV_OFFSET_REDUND; | |
89 | #endif | |
ea882baf | 90 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
dd2a233c | 91 | off + index + offsetof(env_t, data), &c, 1); |
0bc4a1ac | 92 | |
dd2a233c | 93 | return c; |
0bc4a1ac WD |
94 | } |
95 | ||
dd2a233c | 96 | void env_relocate_spec(void) |
0bc4a1ac | 97 | { |
cd0f4fa1 | 98 | char buf[CONFIG_ENV_SIZE]; |
1567b596 | 99 | unsigned int off = CONFIG_ENV_OFFSET; |
ea882baf | 100 | |
1567b596 HS |
101 | #ifdef CONFIG_ENV_OFFSET_REDUND |
102 | if (gd->env_valid == 2) | |
103 | off = CONFIG_ENV_OFFSET_REDUND; | |
104 | #endif | |
ea882baf | 105 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
dd2a233c | 106 | off, (uchar *)buf, CONFIG_ENV_SIZE); |
ea882baf WD |
107 | |
108 | env_import(buf, 1); | |
0bc4a1ac WD |
109 | } |
110 | ||
111 | int saveenv(void) | |
112 | { | |
cd0f4fa1 | 113 | env_t env_new; |
ea882baf WD |
114 | ssize_t len; |
115 | char *res; | |
dd2a233c IG |
116 | int rc; |
117 | unsigned int off = CONFIG_ENV_OFFSET; | |
1567b596 | 118 | #ifdef CONFIG_ENV_OFFSET_REDUND |
dd2a233c IG |
119 | unsigned int off_red = CONFIG_ENV_OFFSET_REDUND; |
120 | char flag_obsolete = OBSOLETE_FLAG; | |
ea882baf WD |
121 | #endif |
122 | ||
123 | BUG_ON(env_ptr != NULL); | |
124 | ||
cd0f4fa1 | 125 | res = (char *)&env_new.data; |
be11235a | 126 | len = hexport_r(&env_htab, '\0', 0, &res, ENV_SIZE, 0, NULL); |
ea882baf WD |
127 | if (len < 0) { |
128 | error("Cannot export environment: errno = %d\n", errno); | |
129 | return 1; | |
130 | } | |
cd0f4fa1 | 131 | env_new.crc = crc32(0, env_new.data, ENV_SIZE); |
ea882baf WD |
132 | |
133 | #ifdef CONFIG_ENV_OFFSET_REDUND | |
1567b596 | 134 | if (gd->env_valid == 1) { |
dd2a233c IG |
135 | off = CONFIG_ENV_OFFSET_REDUND; |
136 | off_red = CONFIG_ENV_OFFSET; | |
1567b596 HS |
137 | } |
138 | ||
cd0f4fa1 | 139 | env_new.flags = ACTIVE_FLAG; |
1567b596 HS |
140 | #endif |
141 | ||
ea882baf | 142 | rc = eeprom_bus_write(CONFIG_SYS_DEF_EEPROM_ADDR, |
cd0f4fa1 | 143 | off, (uchar *)&env_new, CONFIG_ENV_SIZE); |
1567b596 HS |
144 | |
145 | #ifdef CONFIG_ENV_OFFSET_REDUND | |
146 | if (rc == 0) { | |
ea882baf | 147 | eeprom_bus_write(CONFIG_SYS_DEF_EEPROM_ADDR, |
dd2a233c IG |
148 | off_red + offsetof(env_t, flags), |
149 | (uchar *)&flag_obsolete, 1); | |
150 | ||
1567b596 HS |
151 | if (gd->env_valid == 1) |
152 | gd->env_valid = 2; | |
153 | else | |
154 | gd->env_valid = 1; | |
1567b596 HS |
155 | } |
156 | #endif | |
1567b596 | 157 | return rc; |
0bc4a1ac WD |
158 | } |
159 | ||
ea882baf | 160 | /* |
0bc4a1ac WD |
161 | * Initialize Environment use |
162 | * | |
ea882baf | 163 | * We are still running from ROM, so data use is limited. |
0bc4a1ac WD |
164 | * Use a (moderately small) buffer on the stack |
165 | */ | |
1567b596 HS |
166 | #ifdef CONFIG_ENV_OFFSET_REDUND |
167 | int env_init(void) | |
168 | { | |
dd2a233c | 169 | ulong len, crc[2], crc_tmp; |
1567b596 | 170 | unsigned int off, off_env[2]; |
dd2a233c IG |
171 | uchar buf[64], flags[2]; |
172 | int i, crc_ok[2] = {0, 0}; | |
1567b596 | 173 | |
ea882baf | 174 | eeprom_init(); /* prepare for EEPROM read/write */ |
1567b596 HS |
175 | |
176 | off_env[0] = CONFIG_ENV_OFFSET; | |
177 | off_env[1] = CONFIG_ENV_OFFSET_REDUND; | |
178 | ||
179 | for (i = 0; i < 2; i++) { | |
180 | /* read CRC */ | |
ea882baf | 181 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
dd2a233c IG |
182 | off_env[i] + offsetof(env_t, crc), |
183 | (uchar *)&crc[i], sizeof(ulong)); | |
1567b596 | 184 | /* read FLAGS */ |
ea882baf | 185 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
dd2a233c IG |
186 | off_env[i] + offsetof(env_t, flags), |
187 | (uchar *)&flags[i], sizeof(uchar)); | |
1567b596 | 188 | |
ea882baf | 189 | crc_tmp = 0; |
1567b596 | 190 | len = ENV_SIZE; |
dd2a233c | 191 | off = off_env[i] + offsetof(env_t, data); |
1567b596 HS |
192 | while (len > 0) { |
193 | int n = (len > sizeof(buf)) ? sizeof(buf) : len; | |
194 | ||
ea882baf | 195 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, off, |
dd2a233c | 196 | buf, n); |
1567b596 | 197 | |
ea882baf | 198 | crc_tmp = crc32(crc_tmp, buf, n); |
1567b596 HS |
199 | len -= n; |
200 | off += n; | |
201 | } | |
dd2a233c | 202 | |
1567b596 HS |
203 | if (crc_tmp == crc[i]) |
204 | crc_ok[i] = 1; | |
205 | } | |
206 | ||
207 | if (!crc_ok[0] && !crc_ok[1]) { | |
dd2a233c IG |
208 | gd->env_addr = 0; |
209 | gd->env_valid = 0; | |
1567b596 HS |
210 | |
211 | return 0; | |
212 | } else if (crc_ok[0] && !crc_ok[1]) { | |
213 | gd->env_valid = 1; | |
dd2a233c | 214 | } else if (!crc_ok[0] && crc_ok[1]) { |
1567b596 HS |
215 | gd->env_valid = 2; |
216 | } else { | |
217 | /* both ok - check serial */ | |
218 | if (flags[0] == ACTIVE_FLAG && flags[1] == OBSOLETE_FLAG) | |
219 | gd->env_valid = 1; | |
220 | else if (flags[0] == OBSOLETE_FLAG && flags[1] == ACTIVE_FLAG) | |
221 | gd->env_valid = 2; | |
222 | else if (flags[0] == 0xFF && flags[1] == 0) | |
223 | gd->env_valid = 2; | |
dd2a233c | 224 | else if (flags[1] == 0xFF && flags[0] == 0) |
1567b596 HS |
225 | gd->env_valid = 1; |
226 | else /* flags are equal - almost impossible */ | |
227 | gd->env_valid = 1; | |
228 | } | |
229 | ||
230 | if (gd->env_valid == 2) | |
dd2a233c | 231 | gd->env_addr = off_env[1] + offsetof(env_t, data); |
1567b596 | 232 | else if (gd->env_valid == 1) |
dd2a233c | 233 | gd->env_addr = off_env[0] + offsetof(env_t, data); |
1567b596 | 234 | |
dd2a233c | 235 | return 0; |
1567b596 HS |
236 | } |
237 | #else | |
0bc4a1ac WD |
238 | int env_init(void) |
239 | { | |
0bc4a1ac WD |
240 | ulong crc, len, new; |
241 | unsigned off; | |
242 | uchar buf[64]; | |
243 | ||
ea882baf | 244 | eeprom_init(); /* prepare for EEPROM read/write */ |
0bc4a1ac WD |
245 | |
246 | /* read old CRC */ | |
ea882baf | 247 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
dd2a233c IG |
248 | CONFIG_ENV_OFFSET + offsetof(env_t, crc), |
249 | (uchar *)&crc, sizeof(ulong)); | |
0bc4a1ac WD |
250 | |
251 | new = 0; | |
252 | len = ENV_SIZE; | |
dd2a233c | 253 | off = offsetof(env_t, data); |
ea882baf | 254 | |
0bc4a1ac WD |
255 | while (len > 0) { |
256 | int n = (len > sizeof(buf)) ? sizeof(buf) : len; | |
257 | ||
ea882baf | 258 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
548738b4 | 259 | CONFIG_ENV_OFFSET + off, buf, n); |
ea882baf | 260 | new = crc32(new, buf, n); |
0bc4a1ac WD |
261 | len -= n; |
262 | off += n; | |
263 | } | |
264 | ||
265 | if (crc == new) { | |
dd2a233c IG |
266 | gd->env_addr = offsetof(env_t, data); |
267 | gd->env_valid = 1; | |
0bc4a1ac | 268 | } else { |
dd2a233c IG |
269 | gd->env_addr = 0; |
270 | gd->env_valid = 0; | |
0bc4a1ac WD |
271 | } |
272 | ||
dd2a233c | 273 | return 0; |
0bc4a1ac | 274 | } |
1567b596 | 275 | #endif |