wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 1 | /* |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 2 | * (C) Copyright 2000-2010 |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 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> |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 7 | * |
Wolfgang Denk | 3765b3e | 2013-10-07 13:07:26 +0200 | [diff] [blame] | 8 | * SPDX-License-Identifier: GPL-2.0+ |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 9 | */ |
| 10 | |
| 11 | #include <common.h> |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 12 | #include <command.h> |
| 13 | #include <environment.h> |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 14 | #include <linux/stddef.h> |
Heiko Schocher | 548738b | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 15 | #if defined(CONFIG_I2C_ENV_EEPROM_BUS) |
| 16 | #include <i2c.h> |
| 17 | #endif |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 18 | #include <search.h> |
| 19 | #include <errno.h> |
| 20 | #include <linux/compiler.h> /* for BUG_ON */ |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 21 | |
Wolfgang Denk | d87080b | 2006-03-31 18:32:53 +0200 | [diff] [blame] | 22 | DECLARE_GLOBAL_DATA_PTR; |
| 23 | |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 24 | env_t *env_ptr; |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 25 | |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 26 | char *env_name_spec = "EEPROM"; |
Heiko Schocher | 548738b | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 27 | |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 28 | static int eeprom_bus_read(unsigned dev_addr, unsigned offset, |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 29 | uchar *buffer, unsigned cnt) |
Heiko Schocher | 548738b | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 30 | { |
| 31 | int rcode; |
| 32 | #if defined(CONFIG_I2C_ENV_EEPROM_BUS) |
| 33 | int old_bus = i2c_get_bus_num(); |
| 34 | |
Heiko Schocher | 3f4978c | 2012-01-16 21:12:24 +0000 | [diff] [blame] | 35 | if (old_bus != CONFIG_I2C_ENV_EEPROM_BUS) |
| 36 | i2c_set_bus_num(CONFIG_I2C_ENV_EEPROM_BUS); |
Heiko Schocher | 548738b | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 37 | #endif |
| 38 | |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 39 | rcode = eeprom_read(dev_addr, offset, buffer, cnt); |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 40 | |
Heiko Schocher | 548738b | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 41 | #if defined(CONFIG_I2C_ENV_EEPROM_BUS) |
Alexey Brodkin | 6d001e7 | 2013-12-11 18:04:40 +0400 | [diff] [blame] | 42 | i2c_set_bus_num(old_bus); |
Heiko Schocher | 548738b | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 43 | #endif |
Heiko Schocher | 9a2accb | 2012-10-25 10:32:14 +0200 | [diff] [blame] | 44 | |
Heiko Schocher | 548738b | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 45 | return rcode; |
| 46 | } |
| 47 | |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 48 | static int eeprom_bus_write(unsigned dev_addr, unsigned offset, |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 49 | uchar *buffer, unsigned cnt) |
Heiko Schocher | 548738b | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 50 | { |
| 51 | int rcode; |
| 52 | #if defined(CONFIG_I2C_ENV_EEPROM_BUS) |
| 53 | int old_bus = i2c_get_bus_num(); |
| 54 | |
Heiko Schocher | 3f4978c | 2012-01-16 21:12:24 +0000 | [diff] [blame] | 55 | if (old_bus != CONFIG_I2C_ENV_EEPROM_BUS) |
| 56 | i2c_set_bus_num(CONFIG_I2C_ENV_EEPROM_BUS); |
Heiko Schocher | 548738b | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 57 | #endif |
Heiko Schocher | 9a2accb | 2012-10-25 10:32:14 +0200 | [diff] [blame] | 58 | |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 59 | rcode = eeprom_write(dev_addr, offset, buffer, cnt); |
Heiko Schocher | 9a2accb | 2012-10-25 10:32:14 +0200 | [diff] [blame] | 60 | |
Heiko Schocher | 548738b | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 61 | #if defined(CONFIG_I2C_ENV_EEPROM_BUS) |
| 62 | i2c_set_bus_num(old_bus); |
| 63 | #endif |
Alexey Brodkin | 6d001e7 | 2013-12-11 18:04:40 +0400 | [diff] [blame] | 64 | |
Heiko Schocher | 548738b | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 65 | return rcode; |
| 66 | } |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 67 | |
Simon Glass | e5bce24 | 2017-08-03 12:22:01 -0600 | [diff] [blame] | 68 | static uchar env_eeprom_get_char(int index) |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 69 | { |
| 70 | uchar c; |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 71 | unsigned int off = CONFIG_ENV_OFFSET; |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 72 | |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 73 | #ifdef CONFIG_ENV_OFFSET_REDUND |
Simon Glass | 203e94f | 2017-08-03 12:21:56 -0600 | [diff] [blame] | 74 | if (gd->env_valid == ENV_REDUND) |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 75 | off = CONFIG_ENV_OFFSET_REDUND; |
| 76 | #endif |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 77 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 78 | off + index + offsetof(env_t, data), &c, 1); |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 79 | |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 80 | return c; |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 81 | } |
| 82 | |
Simon Glass | e5bce24 | 2017-08-03 12:22:01 -0600 | [diff] [blame] | 83 | static void env_eeprom_load(void) |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 84 | { |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 85 | char buf_env[CONFIG_ENV_SIZE]; |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 86 | unsigned int off = CONFIG_ENV_OFFSET; |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 87 | |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 88 | #ifdef CONFIG_ENV_OFFSET_REDUND |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 89 | ulong len, crc[2], crc_tmp; |
| 90 | unsigned int off_env[2]; |
| 91 | uchar rdbuf[64], flags[2]; |
| 92 | int i, crc_ok[2] = {0, 0}; |
| 93 | |
Marek Vasut | 354e3ed | 2015-11-10 20:53:31 +0100 | [diff] [blame] | 94 | eeprom_init(-1); /* prepare for EEPROM read/write */ |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 95 | |
| 96 | off_env[0] = CONFIG_ENV_OFFSET; |
| 97 | off_env[1] = CONFIG_ENV_OFFSET_REDUND; |
| 98 | |
| 99 | for (i = 0; i < 2; i++) { |
| 100 | /* read CRC */ |
| 101 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
| 102 | off_env[i] + offsetof(env_t, crc), |
| 103 | (uchar *)&crc[i], sizeof(ulong)); |
| 104 | /* read FLAGS */ |
| 105 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
| 106 | off_env[i] + offsetof(env_t, flags), |
| 107 | (uchar *)&flags[i], sizeof(uchar)); |
| 108 | |
| 109 | crc_tmp = 0; |
| 110 | len = ENV_SIZE; |
| 111 | off = off_env[i] + offsetof(env_t, data); |
| 112 | while (len > 0) { |
| 113 | int n = (len > sizeof(rdbuf)) ? sizeof(rdbuf) : len; |
| 114 | |
| 115 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, off, |
| 116 | rdbuf, n); |
| 117 | |
| 118 | crc_tmp = crc32(crc_tmp, rdbuf, n); |
| 119 | len -= n; |
| 120 | off += n; |
| 121 | } |
| 122 | |
| 123 | if (crc_tmp == crc[i]) |
| 124 | crc_ok[i] = 1; |
| 125 | } |
| 126 | |
| 127 | if (!crc_ok[0] && !crc_ok[1]) { |
| 128 | gd->env_addr = 0; |
| 129 | gd->env_valid = 0; |
| 130 | } else if (crc_ok[0] && !crc_ok[1]) { |
Simon Glass | 203e94f | 2017-08-03 12:21:56 -0600 | [diff] [blame] | 131 | gd->env_valid = ENV_VALID; |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 132 | } else if (!crc_ok[0] && crc_ok[1]) { |
Simon Glass | 203e94f | 2017-08-03 12:21:56 -0600 | [diff] [blame] | 133 | gd->env_valid = ENV_REDUND; |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 134 | } else { |
| 135 | /* both ok - check serial */ |
| 136 | if (flags[0] == ACTIVE_FLAG && flags[1] == OBSOLETE_FLAG) |
Simon Glass | 203e94f | 2017-08-03 12:21:56 -0600 | [diff] [blame] | 137 | gd->env_valid = ENV_VALID; |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 138 | else if (flags[0] == OBSOLETE_FLAG && flags[1] == ACTIVE_FLAG) |
Simon Glass | 203e94f | 2017-08-03 12:21:56 -0600 | [diff] [blame] | 139 | gd->env_valid = ENV_REDUND; |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 140 | else if (flags[0] == 0xFF && flags[1] == 0) |
Simon Glass | 203e94f | 2017-08-03 12:21:56 -0600 | [diff] [blame] | 141 | gd->env_valid = ENV_REDUND; |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 142 | else if (flags[1] == 0xFF && flags[0] == 0) |
Simon Glass | 203e94f | 2017-08-03 12:21:56 -0600 | [diff] [blame] | 143 | gd->env_valid = ENV_VALID; |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 144 | else /* flags are equal - almost impossible */ |
Simon Glass | 203e94f | 2017-08-03 12:21:56 -0600 | [diff] [blame] | 145 | gd->env_valid = ENV_VALID; |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 146 | } |
| 147 | |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 148 | #else /* CONFIG_ENV_OFFSET_REDUND */ |
| 149 | ulong crc, len, new; |
| 150 | uchar rdbuf[64]; |
| 151 | |
Marek Vasut | 354e3ed | 2015-11-10 20:53:31 +0100 | [diff] [blame] | 152 | eeprom_init(-1); /* prepare for EEPROM read/write */ |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 153 | |
| 154 | /* read old CRC */ |
| 155 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
| 156 | CONFIG_ENV_OFFSET + offsetof(env_t, crc), |
| 157 | (uchar *)&crc, sizeof(ulong)); |
| 158 | |
| 159 | new = 0; |
| 160 | len = ENV_SIZE; |
| 161 | off = offsetof(env_t, data); |
| 162 | while (len > 0) { |
| 163 | int n = (len > sizeof(rdbuf)) ? sizeof(rdbuf) : len; |
| 164 | |
| 165 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
| 166 | CONFIG_ENV_OFFSET + off, rdbuf, n); |
| 167 | new = crc32(new, rdbuf, n); |
| 168 | len -= n; |
| 169 | off += n; |
| 170 | } |
| 171 | |
| 172 | if (crc == new) { |
Simon Glass | 203e94f | 2017-08-03 12:21:56 -0600 | [diff] [blame] | 173 | gd->env_valid = ENV_VALID; |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 174 | } else { |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 175 | gd->env_valid = 0; |
| 176 | } |
| 177 | #endif /* CONFIG_ENV_OFFSET_REDUND */ |
| 178 | |
| 179 | off = CONFIG_ENV_OFFSET; |
| 180 | #ifdef CONFIG_ENV_OFFSET_REDUND |
Simon Glass | 203e94f | 2017-08-03 12:21:56 -0600 | [diff] [blame] | 181 | if (gd->env_valid == ENV_REDUND) |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 182 | off = CONFIG_ENV_OFFSET_REDUND; |
| 183 | #endif |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 184 | |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 185 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
| 186 | off, (uchar *)buf_env, CONFIG_ENV_SIZE); |
| 187 | |
| 188 | env_import(buf_env, 1); |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 189 | } |
| 190 | |
Simon Glass | e5bce24 | 2017-08-03 12:22:01 -0600 | [diff] [blame] | 191 | static int env_eeprom_save(void) |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 192 | { |
Tom Rini | cd0f4fa | 2013-04-05 14:55:21 -0400 | [diff] [blame] | 193 | env_t env_new; |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 194 | int rc; |
| 195 | unsigned int off = CONFIG_ENV_OFFSET; |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 196 | #ifdef CONFIG_ENV_OFFSET_REDUND |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 197 | unsigned int off_red = CONFIG_ENV_OFFSET_REDUND; |
| 198 | char flag_obsolete = OBSOLETE_FLAG; |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 199 | #endif |
| 200 | |
| 201 | BUG_ON(env_ptr != NULL); |
| 202 | |
Marek Vasut | 7ce1526 | 2014-03-05 19:59:50 +0100 | [diff] [blame] | 203 | rc = env_export(&env_new); |
| 204 | if (rc) |
| 205 | return rc; |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 206 | |
| 207 | #ifdef CONFIG_ENV_OFFSET_REDUND |
Simon Glass | 203e94f | 2017-08-03 12:21:56 -0600 | [diff] [blame] | 208 | if (gd->env_valid == ENV_VALID) { |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 209 | off = CONFIG_ENV_OFFSET_REDUND; |
| 210 | off_red = CONFIG_ENV_OFFSET; |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 211 | } |
| 212 | |
Tom Rini | cd0f4fa | 2013-04-05 14:55:21 -0400 | [diff] [blame] | 213 | env_new.flags = ACTIVE_FLAG; |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 214 | #endif |
| 215 | |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 216 | rc = eeprom_bus_write(CONFIG_SYS_DEF_EEPROM_ADDR, |
Tom Rini | cd0f4fa | 2013-04-05 14:55:21 -0400 | [diff] [blame] | 217 | off, (uchar *)&env_new, CONFIG_ENV_SIZE); |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 218 | |
| 219 | #ifdef CONFIG_ENV_OFFSET_REDUND |
| 220 | if (rc == 0) { |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 221 | eeprom_bus_write(CONFIG_SYS_DEF_EEPROM_ADDR, |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 222 | off_red + offsetof(env_t, flags), |
| 223 | (uchar *)&flag_obsolete, 1); |
| 224 | |
Simon Glass | 203e94f | 2017-08-03 12:21:56 -0600 | [diff] [blame] | 225 | if (gd->env_valid == ENV_VALID) |
| 226 | gd->env_valid = ENV_REDUND; |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 227 | else |
Simon Glass | 203e94f | 2017-08-03 12:21:56 -0600 | [diff] [blame] | 228 | gd->env_valid = ENV_VALID; |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 229 | } |
| 230 | #endif |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 231 | return rc; |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 232 | } |
| 233 | |
Simon Glass | 4415f1d | 2017-08-03 12:21:58 -0600 | [diff] [blame] | 234 | U_BOOT_ENV_LOCATION(eeprom) = { |
| 235 | .location = ENVL_EEPROM, |
Simon Glass | e5bce24 | 2017-08-03 12:22:01 -0600 | [diff] [blame] | 236 | .get_char = env_eeprom_get_char, |
| 237 | .load = env_eeprom_load, |
| 238 | .save = env_save_ptr(env_eeprom_save), |
Simon Glass | 4415f1d | 2017-08-03 12:21:58 -0600 | [diff] [blame] | 239 | }; |