wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 1 | /* |
Wolfgang Denk | 460a9ff | 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 | 460a9ff | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 7 | * |
Wolfgang Denk | bd8ec7e | 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 | 9bb0dd5 | 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 | 460a9ff | 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 | 6405a15 | 2006-03-31 18:32:53 +0200 | [diff] [blame] | 22 | DECLARE_GLOBAL_DATA_PTR; |
| 23 | |
Igor Grinberg | 13f851f | 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 | 460a9ff | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 26 | char *env_name_spec = "EEPROM"; |
Heiko Schocher | 9bb0dd5 | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 27 | |
Wolfgang Denk | 460a9ff | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 28 | static int eeprom_bus_read(unsigned dev_addr, unsigned offset, |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 29 | uchar *buffer, unsigned cnt) |
Heiko Schocher | 9bb0dd5 | 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 | e0e55bc | 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 | 9bb0dd5 | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 37 | #endif |
| 38 | |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 39 | rcode = eeprom_read(dev_addr, offset, buffer, cnt); |
Wolfgang Denk | 460a9ff | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 40 | |
Heiko Schocher | 9bb0dd5 | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 41 | #if defined(CONFIG_I2C_ENV_EEPROM_BUS) |
Alexey Brodkin | f234b1e | 2013-12-11 18:04:40 +0400 | [diff] [blame] | 42 | i2c_set_bus_num(old_bus); |
Heiko Schocher | 9bb0dd5 | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 43 | #endif |
Heiko Schocher | a4ea445 | 2012-10-25 10:32:14 +0200 | [diff] [blame] | 44 | |
Heiko Schocher | 9bb0dd5 | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 45 | return rcode; |
| 46 | } |
| 47 | |
Wolfgang Denk | 460a9ff | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 48 | static int eeprom_bus_write(unsigned dev_addr, unsigned offset, |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 49 | uchar *buffer, unsigned cnt) |
Heiko Schocher | 9bb0dd5 | 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 | e0e55bc | 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 | 9bb0dd5 | 2010-01-07 08:55:40 +0100 | [diff] [blame] | 57 | #endif |
Heiko Schocher | a4ea445 | 2012-10-25 10:32:14 +0200 | [diff] [blame] | 58 | |
Wolfgang Denk | 460a9ff | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 59 | rcode = eeprom_write(dev_addr, offset, buffer, cnt); |
Heiko Schocher | a4ea445 | 2012-10-25 10:32:14 +0200 | [diff] [blame] | 60 | |
Heiko Schocher | 9bb0dd5 | 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 | f234b1e | 2013-12-11 18:04:40 +0400 | [diff] [blame] | 64 | |
Heiko Schocher | 9bb0dd5 | 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 | |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 68 | uchar env_get_char_spec(int index) |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 69 | { |
| 70 | uchar c; |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 71 | unsigned int off = CONFIG_ENV_OFFSET; |
Wolfgang Denk | 460a9ff | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 72 | |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 73 | #ifdef CONFIG_ENV_OFFSET_REDUND |
| 74 | if (gd->env_valid == 2) |
| 75 | off = CONFIG_ENV_OFFSET_REDUND; |
| 76 | #endif |
Wolfgang Denk | 460a9ff | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 77 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
Igor Grinberg | 13f851f | 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 | 13f851f | 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 | |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 83 | void env_relocate_spec(void) |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 84 | { |
Ludger Dreier | bf84e64 | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 85 | char buf_env[CONFIG_ENV_SIZE]; |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 86 | unsigned int off = CONFIG_ENV_OFFSET; |
Wolfgang Denk | 460a9ff | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 87 | |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 88 | #ifdef CONFIG_ENV_OFFSET_REDUND |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 89 | ulong len, crc[2], crc_tmp; |
Ludger Dreier | bf84e64 | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 90 | unsigned int off_env[2]; |
| 91 | uchar rdbuf[64], flags[2]; |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 92 | int i, crc_ok[2] = {0, 0}; |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 93 | |
Marek Vasut | f422ae7 | 2015-11-10 20:53:31 +0100 | [diff] [blame] | 94 | eeprom_init(-1); /* prepare for EEPROM read/write */ |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [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 */ |
Wolfgang Denk | 460a9ff | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 101 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 102 | off_env[i] + offsetof(env_t, crc), |
| 103 | (uchar *)&crc[i], sizeof(ulong)); |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 104 | /* read FLAGS */ |
Wolfgang Denk | 460a9ff | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 105 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 106 | off_env[i] + offsetof(env_t, flags), |
| 107 | (uchar *)&flags[i], sizeof(uchar)); |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 108 | |
Wolfgang Denk | 460a9ff | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 109 | crc_tmp = 0; |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 110 | len = ENV_SIZE; |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 111 | off = off_env[i] + offsetof(env_t, data); |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 112 | while (len > 0) { |
Ludger Dreier | bf84e64 | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 113 | int n = (len > sizeof(rdbuf)) ? sizeof(rdbuf) : len; |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 114 | |
Wolfgang Denk | 460a9ff | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 115 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, off, |
Ludger Dreier | bf84e64 | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 116 | rdbuf, n); |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 117 | |
Ludger Dreier | bf84e64 | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 118 | crc_tmp = crc32(crc_tmp, rdbuf, n); |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 119 | len -= n; |
| 120 | off += n; |
| 121 | } |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 122 | |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 123 | if (crc_tmp == crc[i]) |
| 124 | crc_ok[i] = 1; |
| 125 | } |
| 126 | |
| 127 | if (!crc_ok[0] && !crc_ok[1]) { |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 128 | gd->env_addr = 0; |
| 129 | gd->env_valid = 0; |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 130 | } else if (crc_ok[0] && !crc_ok[1]) { |
| 131 | gd->env_valid = 1; |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 132 | } else if (!crc_ok[0] && crc_ok[1]) { |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 133 | gd->env_valid = 2; |
| 134 | } else { |
| 135 | /* both ok - check serial */ |
| 136 | if (flags[0] == ACTIVE_FLAG && flags[1] == OBSOLETE_FLAG) |
| 137 | gd->env_valid = 1; |
| 138 | else if (flags[0] == OBSOLETE_FLAG && flags[1] == ACTIVE_FLAG) |
| 139 | gd->env_valid = 2; |
| 140 | else if (flags[0] == 0xFF && flags[1] == 0) |
| 141 | gd->env_valid = 2; |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 142 | else if (flags[1] == 0xFF && flags[0] == 0) |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 143 | gd->env_valid = 1; |
| 144 | else /* flags are equal - almost impossible */ |
| 145 | gd->env_valid = 1; |
| 146 | } |
| 147 | |
| 148 | if (gd->env_valid == 2) |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 149 | gd->env_addr = off_env[1] + offsetof(env_t, data); |
Heiko Schocher | e719363 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 150 | else if (gd->env_valid == 1) |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 151 | gd->env_addr = off_env[0] + offsetof(env_t, data); |
Ludger Dreier | bf84e64 | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 152 | |
| 153 | #else /* CONFIG_ENV_OFFSET_REDUND */ |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 154 | ulong crc, len, new; |
Ludger Dreier | bf84e64 | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 155 | uchar rdbuf[64]; |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 156 | |
Marek Vasut | f422ae7 | 2015-11-10 20:53:31 +0100 | [diff] [blame] | 157 | eeprom_init(-1); /* prepare for EEPROM read/write */ |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 158 | |
| 159 | /* read old CRC */ |
Wolfgang Denk | 460a9ff | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 160 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 161 | CONFIG_ENV_OFFSET + offsetof(env_t, crc), |
| 162 | (uchar *)&crc, sizeof(ulong)); |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 163 | |
| 164 | new = 0; |
| 165 | len = ENV_SIZE; |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 166 | off = offsetof(env_t, data); |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 167 | while (len > 0) { |
Ludger Dreier | bf84e64 | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 168 | int n = (len > sizeof(rdbuf)) ? sizeof(rdbuf) : len; |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 169 | |
Wolfgang Denk | 460a9ff | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 170 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
Ludger Dreier | bf84e64 | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 171 | CONFIG_ENV_OFFSET + off, rdbuf, n); |
| 172 | new = crc32(new, rdbuf, n); |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 173 | len -= n; |
| 174 | off += n; |
| 175 | } |
| 176 | |
| 177 | if (crc == new) { |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 178 | gd->env_addr = offsetof(env_t, data); |
| 179 | gd->env_valid = 1; |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 180 | } else { |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 181 | gd->env_addr = 0; |
| 182 | gd->env_valid = 0; |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 183 | } |
Ludger Dreier | bf84e64 | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 184 | #endif /* CONFIG_ENV_OFFSET_REDUND */ |
| 185 | |
| 186 | off = CONFIG_ENV_OFFSET; |
| 187 | #ifdef CONFIG_ENV_OFFSET_REDUND |
| 188 | if (gd->env_valid == 2) |
| 189 | off = CONFIG_ENV_OFFSET_REDUND; |
| 190 | #endif |
| 191 | |
| 192 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
| 193 | off, (uchar *)buf_env, CONFIG_ENV_SIZE); |
| 194 | |
| 195 | env_import(buf_env, 1); |
| 196 | } |
| 197 | |
| 198 | int saveenv(void) |
| 199 | { |
| 200 | env_t env_new; |
| 201 | int rc; |
| 202 | unsigned int off = CONFIG_ENV_OFFSET; |
| 203 | #ifdef CONFIG_ENV_OFFSET_REDUND |
| 204 | unsigned int off_red = CONFIG_ENV_OFFSET_REDUND; |
| 205 | char flag_obsolete = OBSOLETE_FLAG; |
| 206 | #endif |
| 207 | |
| 208 | BUG_ON(env_ptr != NULL); |
| 209 | |
| 210 | rc = env_export(&env_new); |
| 211 | if (rc) |
| 212 | return rc; |
| 213 | |
| 214 | #ifdef CONFIG_ENV_OFFSET_REDUND |
| 215 | if (gd->env_valid == 1) { |
| 216 | off = CONFIG_ENV_OFFSET_REDUND; |
| 217 | off_red = CONFIG_ENV_OFFSET; |
| 218 | } |
| 219 | |
| 220 | env_new.flags = ACTIVE_FLAG; |
| 221 | #endif |
| 222 | |
| 223 | rc = eeprom_bus_write(CONFIG_SYS_DEF_EEPROM_ADDR, |
| 224 | off, (uchar *)&env_new, CONFIG_ENV_SIZE); |
| 225 | |
| 226 | #ifdef CONFIG_ENV_OFFSET_REDUND |
| 227 | if (rc == 0) { |
| 228 | eeprom_bus_write(CONFIG_SYS_DEF_EEPROM_ADDR, |
| 229 | off_red + offsetof(env_t, flags), |
| 230 | (uchar *)&flag_obsolete, 1); |
| 231 | |
| 232 | if (gd->env_valid == 1) |
| 233 | gd->env_valid = 2; |
| 234 | else |
| 235 | gd->env_valid = 1; |
| 236 | } |
| 237 | #endif |
| 238 | return rc; |
| 239 | } |
| 240 | |
| 241 | /* |
| 242 | * Initialize Environment use |
| 243 | * |
| 244 | * We are still running from ROM, so data use is limited. |
| 245 | * Use a (moderately small) buffer on the stack |
| 246 | */ |
| 247 | int env_init(void) |
| 248 | { |
Siva Durga Prasad Paladugu | 904d430 | 2014-05-26 19:51:22 +0530 | [diff] [blame] | 249 | gd->env_addr = (ulong)&default_environment[0]; |
| 250 | gd->env_valid = 1; |
Igor Grinberg | 13f851f | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 251 | return 0; |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 252 | } |