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 | |
Igor Grinberg | dd2a233 | 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 | 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 |
| 74 | if (gd->env_valid == 2) |
| 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 | |
Igor Grinberg | dd2a233 | 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 | 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]) { |
| 131 | gd->env_valid = 1; |
| 132 | } else if (!crc_ok[0] && crc_ok[1]) { |
| 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; |
| 142 | else if (flags[1] == 0xFF && flags[0] == 0) |
| 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) |
| 149 | gd->env_addr = off_env[1] + offsetof(env_t, data); |
| 150 | else if (gd->env_valid == 1) |
| 151 | gd->env_addr = off_env[0] + offsetof(env_t, data); |
| 152 | |
| 153 | #else /* CONFIG_ENV_OFFSET_REDUND */ |
| 154 | ulong crc, len, new; |
| 155 | uchar rdbuf[64]; |
| 156 | |
Marek Vasut | 354e3ed | 2015-11-10 20:53:31 +0100 | [diff] [blame^] | 157 | eeprom_init(-1); /* prepare for EEPROM read/write */ |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 158 | |
| 159 | /* read old CRC */ |
| 160 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
| 161 | CONFIG_ENV_OFFSET + offsetof(env_t, crc), |
| 162 | (uchar *)&crc, sizeof(ulong)); |
| 163 | |
| 164 | new = 0; |
| 165 | len = ENV_SIZE; |
| 166 | off = offsetof(env_t, data); |
| 167 | while (len > 0) { |
| 168 | int n = (len > sizeof(rdbuf)) ? sizeof(rdbuf) : len; |
| 169 | |
| 170 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
| 171 | CONFIG_ENV_OFFSET + off, rdbuf, n); |
| 172 | new = crc32(new, rdbuf, n); |
| 173 | len -= n; |
| 174 | off += n; |
| 175 | } |
| 176 | |
| 177 | if (crc == new) { |
| 178 | gd->env_addr = offsetof(env_t, data); |
| 179 | gd->env_valid = 1; |
| 180 | } else { |
| 181 | gd->env_addr = 0; |
| 182 | gd->env_valid = 0; |
| 183 | } |
| 184 | #endif /* CONFIG_ENV_OFFSET_REDUND */ |
| 185 | |
| 186 | off = CONFIG_ENV_OFFSET; |
| 187 | #ifdef CONFIG_ENV_OFFSET_REDUND |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 188 | if (gd->env_valid == 2) |
| 189 | off = CONFIG_ENV_OFFSET_REDUND; |
| 190 | #endif |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 191 | |
Ludger Dreier | e3cc5bc | 2015-10-12 13:34:24 +0200 | [diff] [blame] | 192 | eeprom_bus_read(CONFIG_SYS_DEF_EEPROM_ADDR, |
| 193 | off, (uchar *)buf_env, CONFIG_ENV_SIZE); |
| 194 | |
| 195 | env_import(buf_env, 1); |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 196 | } |
| 197 | |
| 198 | int saveenv(void) |
| 199 | { |
Tom Rini | cd0f4fa | 2013-04-05 14:55:21 -0400 | [diff] [blame] | 200 | env_t env_new; |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 201 | int rc; |
| 202 | unsigned int off = CONFIG_ENV_OFFSET; |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 203 | #ifdef CONFIG_ENV_OFFSET_REDUND |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 204 | unsigned int off_red = CONFIG_ENV_OFFSET_REDUND; |
| 205 | char flag_obsolete = OBSOLETE_FLAG; |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 206 | #endif |
| 207 | |
| 208 | BUG_ON(env_ptr != NULL); |
| 209 | |
Marek Vasut | 7ce1526 | 2014-03-05 19:59:50 +0100 | [diff] [blame] | 210 | rc = env_export(&env_new); |
| 211 | if (rc) |
| 212 | return rc; |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 213 | |
| 214 | #ifdef CONFIG_ENV_OFFSET_REDUND |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 215 | if (gd->env_valid == 1) { |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 216 | off = CONFIG_ENV_OFFSET_REDUND; |
| 217 | off_red = CONFIG_ENV_OFFSET; |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 218 | } |
| 219 | |
Tom Rini | cd0f4fa | 2013-04-05 14:55:21 -0400 | [diff] [blame] | 220 | env_new.flags = ACTIVE_FLAG; |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 221 | #endif |
| 222 | |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 223 | rc = eeprom_bus_write(CONFIG_SYS_DEF_EEPROM_ADDR, |
Tom Rini | cd0f4fa | 2013-04-05 14:55:21 -0400 | [diff] [blame] | 224 | off, (uchar *)&env_new, CONFIG_ENV_SIZE); |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 225 | |
| 226 | #ifdef CONFIG_ENV_OFFSET_REDUND |
| 227 | if (rc == 0) { |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 228 | eeprom_bus_write(CONFIG_SYS_DEF_EEPROM_ADDR, |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 229 | off_red + offsetof(env_t, flags), |
| 230 | (uchar *)&flag_obsolete, 1); |
| 231 | |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 232 | if (gd->env_valid == 1) |
| 233 | gd->env_valid = 2; |
| 234 | else |
| 235 | gd->env_valid = 1; |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 236 | } |
| 237 | #endif |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 238 | return rc; |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 239 | } |
| 240 | |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 241 | /* |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 242 | * Initialize Environment use |
| 243 | * |
Wolfgang Denk | ea882ba | 2010-06-20 23:33:59 +0200 | [diff] [blame] | 244 | * We are still running from ROM, so data use is limited. |
wdenk | 0bc4a1a | 2002-09-18 11:09:59 +0000 | [diff] [blame] | 245 | * Use a (moderately small) buffer on the stack |
| 246 | */ |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 247 | int env_init(void) |
| 248 | { |
Siva Durga Prasad Paladugu | ed6a5d4 | 2014-05-26 19:51:22 +0530 | [diff] [blame] | 249 | gd->env_addr = (ulong)&default_environment[0]; |
| 250 | gd->env_valid = 1; |
Igor Grinberg | dd2a233 | 2011-11-07 01:14:07 +0000 | [diff] [blame] | 251 | return 0; |
Heiko Schocher | 1567b59 | 2010-01-07 08:55:44 +0100 | [diff] [blame] | 252 | } |