Blame view
env/eeprom.c
5.3 KB
83d290c56
|
1 |
// SPDX-License-Identifier: GPL-2.0+ |
0bc4a1ac8
|
2 |
/* |
ea882baf9
|
3 |
* (C) Copyright 2000-2010 |
0bc4a1ac8
|
4 5 6 7 |
* Wolfgang Denk, DENX Software Engineering, wd@denx.de. * * (C) Copyright 2001 Sysgo Real-Time Solutions, GmbH <www.elinos.com> * Andreas Heppel <aheppel@sysgo.de> |
0bc4a1ac8
|
8 9 10 |
*/ #include <common.h> |
0bc4a1ac8
|
11 12 |
#include <command.h> #include <environment.h> |
0bc4a1ac8
|
13 |
#include <linux/stddef.h> |
548738b4d
|
14 15 16 |
#if defined(CONFIG_I2C_ENV_EEPROM_BUS) #include <i2c.h> #endif |
ea882baf9
|
17 18 19 |
#include <search.h> #include <errno.h> #include <linux/compiler.h> /* for BUG_ON */ |
0bc4a1ac8
|
20 |
|
d87080b72
|
21 |
DECLARE_GLOBAL_DATA_PTR; |
ea882baf9
|
22 |
static int eeprom_bus_read(unsigned dev_addr, unsigned offset, |
dd2a233c9
|
23 |
uchar *buffer, unsigned cnt) |
548738b4d
|
24 25 26 27 |
{ int rcode; #if defined(CONFIG_I2C_ENV_EEPROM_BUS) int old_bus = i2c_get_bus_num(); |
3f4978c71
|
28 29 |
if (old_bus != CONFIG_I2C_ENV_EEPROM_BUS) i2c_set_bus_num(CONFIG_I2C_ENV_EEPROM_BUS); |
548738b4d
|
30 |
#endif |
dd2a233c9
|
31 |
rcode = eeprom_read(dev_addr, offset, buffer, cnt); |
ea882baf9
|
32 |
|
548738b4d
|
33 |
#if defined(CONFIG_I2C_ENV_EEPROM_BUS) |
6d001e7df
|
34 |
i2c_set_bus_num(old_bus); |
548738b4d
|
35 |
#endif |
9a2accb44
|
36 |
|
548738b4d
|
37 38 |
return rcode; } |
ea882baf9
|
39 |
static int eeprom_bus_write(unsigned dev_addr, unsigned offset, |
dd2a233c9
|
40 |
uchar *buffer, unsigned cnt) |
548738b4d
|
41 42 43 44 |
{ int rcode; #if defined(CONFIG_I2C_ENV_EEPROM_BUS) int old_bus = i2c_get_bus_num(); |
3f4978c71
|
45 46 |
if (old_bus != CONFIG_I2C_ENV_EEPROM_BUS) i2c_set_bus_num(CONFIG_I2C_ENV_EEPROM_BUS); |
548738b4d
|
47 |
#endif |
9a2accb44
|
48 |
|
ea882baf9
|
49 |
rcode = eeprom_write(dev_addr, offset, buffer, cnt); |
9a2accb44
|
50 |
|
548738b4d
|
51 52 53 |
#if defined(CONFIG_I2C_ENV_EEPROM_BUS) i2c_set_bus_num(old_bus); #endif |
6d001e7df
|
54 |
|
548738b4d
|
55 56 |
return rcode; } |
0bc4a1ac8
|
57 |
|
b2cdef486
|
58 59 60 61 |
/** Call this function from overridden env_get_char_spec() if you need * this functionality. */ int env_eeprom_get_char(int index) |
0bc4a1ac8
|
62 63 |
{ uchar c; |
dd2a233c9
|
64 |
unsigned int off = CONFIG_ENV_OFFSET; |
ea882baf9
|
65 |
|
1567b596d
|
66 |
#ifdef CONFIG_ENV_OFFSET_REDUND |
203e94f6c
|
67 |
if (gd->env_valid == ENV_REDUND) |
1567b596d
|
68 69 |
off = CONFIG_ENV_OFFSET_REDUND; #endif |
ea882baf9
|
70 |
eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
dd2a233c9
|
71 |
off + index + offsetof(env_t, data), &c, 1); |
0bc4a1ac8
|
72 |
|
dd2a233c9
|
73 |
return c; |
0bc4a1ac8
|
74 |
} |
c59519919
|
75 |
static int env_eeprom_load(void) |
0bc4a1ac8
|
76 |
{ |
e3cc5bc58
|
77 |
char buf_env[CONFIG_ENV_SIZE]; |
1567b596d
|
78 |
unsigned int off = CONFIG_ENV_OFFSET; |
ea882baf9
|
79 |
|
1567b596d
|
80 |
#ifdef CONFIG_ENV_OFFSET_REDUND |
dd2a233c9
|
81 |
ulong len, crc[2], crc_tmp; |
e3cc5bc58
|
82 83 |
unsigned int off_env[2]; uchar rdbuf[64], flags[2]; |
dd2a233c9
|
84 |
int i, crc_ok[2] = {0, 0}; |
1567b596d
|
85 |
|
354e3ed75
|
86 |
eeprom_init(-1); /* prepare for EEPROM read/write */ |
1567b596d
|
87 88 89 90 91 92 |
off_env[0] = CONFIG_ENV_OFFSET; off_env[1] = CONFIG_ENV_OFFSET_REDUND; for (i = 0; i < 2; i++) { /* read CRC */ |
ea882baf9
|
93 |
eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
dd2a233c9
|
94 95 |
off_env[i] + offsetof(env_t, crc), (uchar *)&crc[i], sizeof(ulong)); |
1567b596d
|
96 |
/* read FLAGS */ |
ea882baf9
|
97 |
eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
dd2a233c9
|
98 99 |
off_env[i] + offsetof(env_t, flags), (uchar *)&flags[i], sizeof(uchar)); |
1567b596d
|
100 |
|
ea882baf9
|
101 |
crc_tmp = 0; |
1567b596d
|
102 |
len = ENV_SIZE; |
dd2a233c9
|
103 |
off = off_env[i] + offsetof(env_t, data); |
1567b596d
|
104 |
while (len > 0) { |
e3cc5bc58
|
105 |
int n = (len > sizeof(rdbuf)) ? sizeof(rdbuf) : len; |
1567b596d
|
106 |
|
ea882baf9
|
107 |
eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, off, |
e3cc5bc58
|
108 |
rdbuf, n); |
1567b596d
|
109 |
|
e3cc5bc58
|
110 |
crc_tmp = crc32(crc_tmp, rdbuf, n); |
1567b596d
|
111 112 113 |
len -= n; off += n; } |
dd2a233c9
|
114 |
|
1567b596d
|
115 116 117 118 119 |
if (crc_tmp == crc[i]) crc_ok[i] = 1; } if (!crc_ok[0] && !crc_ok[1]) { |
dd2a233c9
|
120 |
gd->env_addr = 0; |
2d7cb5b42
|
121 |
gd->env_valid = ENV_INVALID; |
1567b596d
|
122 |
} else if (crc_ok[0] && !crc_ok[1]) { |
203e94f6c
|
123 |
gd->env_valid = ENV_VALID; |
dd2a233c9
|
124 |
} else if (!crc_ok[0] && crc_ok[1]) { |
203e94f6c
|
125 |
gd->env_valid = ENV_REDUND; |
1567b596d
|
126 127 128 |
} else { /* both ok - check serial */ if (flags[0] == ACTIVE_FLAG && flags[1] == OBSOLETE_FLAG) |
203e94f6c
|
129 |
gd->env_valid = ENV_VALID; |
1567b596d
|
130 |
else if (flags[0] == OBSOLETE_FLAG && flags[1] == ACTIVE_FLAG) |
203e94f6c
|
131 |
gd->env_valid = ENV_REDUND; |
1567b596d
|
132 |
else if (flags[0] == 0xFF && flags[1] == 0) |
203e94f6c
|
133 |
gd->env_valid = ENV_REDUND; |
dd2a233c9
|
134 |
else if (flags[1] == 0xFF && flags[0] == 0) |
203e94f6c
|
135 |
gd->env_valid = ENV_VALID; |
1567b596d
|
136 |
else /* flags are equal - almost impossible */ |
203e94f6c
|
137 |
gd->env_valid = ENV_VALID; |
1567b596d
|
138 |
} |
e3cc5bc58
|
139 |
#else /* CONFIG_ENV_OFFSET_REDUND */ |
0bc4a1ac8
|
140 |
ulong crc, len, new; |
e3cc5bc58
|
141 |
uchar rdbuf[64]; |
0bc4a1ac8
|
142 |
|
354e3ed75
|
143 |
eeprom_init(-1); /* prepare for EEPROM read/write */ |
0bc4a1ac8
|
144 145 |
/* read old CRC */ |
ea882baf9
|
146 |
eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
dd2a233c9
|
147 148 |
CONFIG_ENV_OFFSET + offsetof(env_t, crc), (uchar *)&crc, sizeof(ulong)); |
0bc4a1ac8
|
149 150 151 |
new = 0; len = ENV_SIZE; |
dd2a233c9
|
152 |
off = offsetof(env_t, data); |
0bc4a1ac8
|
153 |
while (len > 0) { |
e3cc5bc58
|
154 |
int n = (len > sizeof(rdbuf)) ? sizeof(rdbuf) : len; |
0bc4a1ac8
|
155 |
|
ea882baf9
|
156 |
eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
e3cc5bc58
|
157 158 |
CONFIG_ENV_OFFSET + off, rdbuf, n); new = crc32(new, rdbuf, n); |
0bc4a1ac8
|
159 160 161 162 163 |
len -= n; off += n; } if (crc == new) { |
2d7cb5b42
|
164 |
gd->env_valid = ENV_VALID; |
0bc4a1ac8
|
165 |
} else { |
2d7cb5b42
|
166 |
gd->env_valid = ENV_INVALID; |
0bc4a1ac8
|
167 |
} |
e3cc5bc58
|
168 169 170 171 |
#endif /* CONFIG_ENV_OFFSET_REDUND */ off = CONFIG_ENV_OFFSET; #ifdef CONFIG_ENV_OFFSET_REDUND |
203e94f6c
|
172 |
if (gd->env_valid == ENV_REDUND) |
e3cc5bc58
|
173 174 175 176 177 |
off = CONFIG_ENV_OFFSET_REDUND; #endif eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, off, (uchar *)buf_env, CONFIG_ENV_SIZE); |
2166ebf78
|
178 |
return env_import(buf_env, 1); |
e3cc5bc58
|
179 |
} |
e5bce247b
|
180 |
static int env_eeprom_save(void) |
e3cc5bc58
|
181 182 183 184 185 186 187 188 |
{ env_t env_new; int rc; unsigned int off = CONFIG_ENV_OFFSET; #ifdef CONFIG_ENV_OFFSET_REDUND unsigned int off_red = CONFIG_ENV_OFFSET_REDUND; char flag_obsolete = OBSOLETE_FLAG; #endif |
e3cc5bc58
|
189 190 191 192 193 |
rc = env_export(&env_new); if (rc) return rc; #ifdef CONFIG_ENV_OFFSET_REDUND |
203e94f6c
|
194 |
if (gd->env_valid == ENV_VALID) { |
e3cc5bc58
|
195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 |
off = CONFIG_ENV_OFFSET_REDUND; off_red = CONFIG_ENV_OFFSET; } env_new.flags = ACTIVE_FLAG; #endif rc = eeprom_bus_write(CONFIG_SYS_DEF_EEPROM_ADDR, off, (uchar *)&env_new, CONFIG_ENV_SIZE); #ifdef CONFIG_ENV_OFFSET_REDUND if (rc == 0) { eeprom_bus_write(CONFIG_SYS_DEF_EEPROM_ADDR, off_red + offsetof(env_t, flags), (uchar *)&flag_obsolete, 1); |
203e94f6c
|
210 211 |
if (gd->env_valid == ENV_VALID) gd->env_valid = ENV_REDUND; |
e3cc5bc58
|
212 |
else |
203e94f6c
|
213 |
gd->env_valid = ENV_VALID; |
e3cc5bc58
|
214 215 216 217 |
} #endif return rc; } |
4415f1d1f
|
218 219 |
U_BOOT_ENV_LOCATION(eeprom) = { .location = ENVL_EEPROM, |
ac358beb8
|
220 |
ENV_NAME("EEPROM") |
e5bce247b
|
221 222 |
.load = env_eeprom_load, .save = env_save_ptr(env_eeprom_save), |
4415f1d1f
|
223 |
}; |