1
2
3
4
5
6
7
8
9
10
11#include <common.h>
12#include <command.h>
13#include <environment.h>
14#include <linux/stddef.h>
15#if defined(CONFIG_I2C_ENV_EEPROM_BUS)
16#include <i2c.h>
17#endif
18#include <search.h>
19#include <errno.h>
20#include <linux/compiler.h>
21
22DECLARE_GLOBAL_DATA_PTR;
23
24env_t *env_ptr;
25
26char *env_name_spec = "EEPROM";
27
28static int eeprom_bus_read(unsigned dev_addr, unsigned offset,
29 uchar *buffer, unsigned cnt)
30{
31 int rcode;
32#if defined(CONFIG_I2C_ENV_EEPROM_BUS)
33 int old_bus = i2c_get_bus_num();
34
35 if (old_bus != CONFIG_I2C_ENV_EEPROM_BUS)
36 i2c_set_bus_num(CONFIG_I2C_ENV_EEPROM_BUS);
37#endif
38
39 rcode = eeprom_read(dev_addr, offset, buffer, cnt);
40
41#if defined(CONFIG_I2C_ENV_EEPROM_BUS)
42 i2c_set_bus_num(old_bus);
43#endif
44
45 return rcode;
46}
47
48static int eeprom_bus_write(unsigned dev_addr, unsigned offset,
49 uchar *buffer, unsigned cnt)
50{
51 int rcode;
52#if defined(CONFIG_I2C_ENV_EEPROM_BUS)
53 int old_bus = i2c_get_bus_num();
54
55 if (old_bus != CONFIG_I2C_ENV_EEPROM_BUS)
56 i2c_set_bus_num(CONFIG_I2C_ENV_EEPROM_BUS);
57#endif
58
59 rcode = eeprom_write(dev_addr, offset, buffer, cnt);
60
61#if defined(CONFIG_I2C_ENV_EEPROM_BUS)
62 i2c_set_bus_num(old_bus);
63#endif
64
65 return rcode;
66}
67
68uchar env_get_char_spec(int index)
69{
70 uchar c;
71 unsigned int off = CONFIG_ENV_OFFSET;
72
73#ifdef CONFIG_ENV_OFFSET_REDUND
74 if (gd->env_valid == 2)
75 off = CONFIG_ENV_OFFSET_REDUND;
76#endif
77 eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR,
78 off + index + offsetof(env_t, data), &c, 1);
79
80 return c;
81}
82
83void env_relocate_spec(void)
84{
85 char buf[CONFIG_ENV_SIZE];
86 unsigned int off = CONFIG_ENV_OFFSET;
87
88#ifdef CONFIG_ENV_OFFSET_REDUND
89 if (gd->env_valid == 2)
90 off = CONFIG_ENV_OFFSET_REDUND;
91#endif
92 eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR,
93 off, (uchar *)buf, CONFIG_ENV_SIZE);
94
95 env_import(buf, 1);
96}
97
98int saveenv(void)
99{
100 env_t env_new;
101 int rc;
102 unsigned int off = CONFIG_ENV_OFFSET;
103#ifdef CONFIG_ENV_OFFSET_REDUND
104 unsigned int off_red = CONFIG_ENV_OFFSET_REDUND;
105 char flag_obsolete = OBSOLETE_FLAG;
106#endif
107
108 BUG_ON(env_ptr != NULL);
109
110 rc = env_export(&env_new);
111 if (rc)
112 return rc;
113
114#ifdef CONFIG_ENV_OFFSET_REDUND
115 if (gd->env_valid == 1) {
116 off = CONFIG_ENV_OFFSET_REDUND;
117 off_red = CONFIG_ENV_OFFSET;
118 }
119
120 env_new.flags = ACTIVE_FLAG;
121#endif
122
123 rc = eeprom_bus_write(CONFIG_SYS_DEF_EEPROM_ADDR,
124 off, (uchar *)&env_new, CONFIG_ENV_SIZE);
125
126#ifdef CONFIG_ENV_OFFSET_REDUND
127 if (rc == 0) {
128 eeprom_bus_write(CONFIG_SYS_DEF_EEPROM_ADDR,
129 off_red + offsetof(env_t, flags),
130 (uchar *)&flag_obsolete, 1);
131
132 if (gd->env_valid == 1)
133 gd->env_valid = 2;
134 else
135 gd->env_valid = 1;
136 }
137#endif
138 return rc;
139}
140
141
142
143
144
145
146
147#ifdef CONFIG_ENV_OFFSET_REDUND
148int env_init(void)
149{
150#ifdef ENV_IS_EMBEDDED
151 ulong len, crc[2], crc_tmp;
152 unsigned int off, off_env[2];
153 uchar buf[64], flags[2];
154 int i, crc_ok[2] = {0, 0};
155
156 eeprom_init();
157
158 off_env[0] = CONFIG_ENV_OFFSET;
159 off_env[1] = CONFIG_ENV_OFFSET_REDUND;
160
161 for (i = 0; i < 2; i++) {
162
163 eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR,
164 off_env[i] + offsetof(env_t, crc),
165 (uchar *)&crc[i], sizeof(ulong));
166
167 eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR,
168 off_env[i] + offsetof(env_t, flags),
169 (uchar *)&flags[i], sizeof(uchar));
170
171 crc_tmp = 0;
172 len = ENV_SIZE;
173 off = off_env[i] + offsetof(env_t, data);
174 while (len > 0) {
175 int n = (len > sizeof(buf)) ? sizeof(buf) : len;
176
177 eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, off,
178 buf, n);
179
180 crc_tmp = crc32(crc_tmp, buf, n);
181 len -= n;
182 off += n;
183 }
184
185 if (crc_tmp == crc[i])
186 crc_ok[i] = 1;
187 }
188
189 if (!crc_ok[0] && !crc_ok[1]) {
190 gd->env_addr = 0;
191 gd->env_valid = 0;
192
193 return 0;
194 } else if (crc_ok[0] && !crc_ok[1]) {
195 gd->env_valid = 1;
196 } else if (!crc_ok[0] && crc_ok[1]) {
197 gd->env_valid = 2;
198 } else {
199
200 if (flags[0] == ACTIVE_FLAG && flags[1] == OBSOLETE_FLAG)
201 gd->env_valid = 1;
202 else if (flags[0] == OBSOLETE_FLAG && flags[1] == ACTIVE_FLAG)
203 gd->env_valid = 2;
204 else if (flags[0] == 0xFF && flags[1] == 0)
205 gd->env_valid = 2;
206 else if (flags[1] == 0xFF && flags[0] == 0)
207 gd->env_valid = 1;
208 else
209 gd->env_valid = 1;
210 }
211
212 if (gd->env_valid == 2)
213 gd->env_addr = off_env[1] + offsetof(env_t, data);
214 else if (gd->env_valid == 1)
215 gd->env_addr = off_env[0] + offsetof(env_t, data);
216#else
217 gd->env_addr = (ulong)&default_environment[0];
218 gd->env_valid = 1;
219#endif
220 return 0;
221}
222#else
223int env_init(void)
224{
225#ifdef ENV_IS_EMBEDDED
226 ulong crc, len, new;
227 unsigned off;
228 uchar buf[64];
229
230 eeprom_init();
231
232
233 eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR,
234 CONFIG_ENV_OFFSET + offsetof(env_t, crc),
235 (uchar *)&crc, sizeof(ulong));
236
237 new = 0;
238 len = ENV_SIZE;
239 off = offsetof(env_t, data);
240
241 while (len > 0) {
242 int n = (len > sizeof(buf)) ? sizeof(buf) : len;
243
244 eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR,
245 CONFIG_ENV_OFFSET + off, buf, n);
246 new = crc32(new, buf, n);
247 len -= n;
248 off += n;
249 }
250
251 if (crc == new) {
252 gd->env_addr = offsetof(env_t, data);
253 gd->env_valid = 1;
254 } else {
255 gd->env_addr = 0;
256 gd->env_valid = 0;
257 }
258#else
259 gd->env_addr = (ulong)&default_environment[0];
260 gd->env_valid = 1;
261#endif
262 return 0;
263}
264#endif
265
