]> git.ipfire.org Git - people/ms/u-boot.git/blame - common/env_sf.c
PATI: fix broken SPI access
[people/ms/u-boot.git] / common / env_sf.c
CommitLineData
8c66497e 1/*
ea882baf 2 * (C) Copyright 2000-2010
8c66497e
HS
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>
7 *
8 * (C) Copyright 2008 Atmel Corporation
9 *
402ba1e3 10 * SPDX-License-Identifier: GPL-2.0+
8c66497e
HS
11 */
12#include <common.h>
8c66497e 13#include <environment.h>
5b3375ac 14#include <malloc.h>
8c66497e 15#include <spi_flash.h>
ea882baf
WD
16#include <search.h>
17#include <errno.h>
8c66497e 18
0e8d1586
JCPV
19#ifndef CONFIG_ENV_SPI_BUS
20# define CONFIG_ENV_SPI_BUS 0
8c66497e 21#endif
0e8d1586 22#ifndef CONFIG_ENV_SPI_CS
eb58a7fc 23# define CONFIG_ENV_SPI_CS 0
8c66497e 24#endif
0e8d1586
JCPV
25#ifndef CONFIG_ENV_SPI_MAX_HZ
26# define CONFIG_ENV_SPI_MAX_HZ 1000000
8c66497e 27#endif
0e8d1586
JCPV
28#ifndef CONFIG_ENV_SPI_MODE
29# define CONFIG_ENV_SPI_MODE SPI_MODE_3
8c66497e
HS
30#endif
31
7319bcaf 32#ifdef CONFIG_ENV_OFFSET_REDUND
eb58a7fc
IG
33static ulong env_offset = CONFIG_ENV_OFFSET;
34static ulong env_new_offset = CONFIG_ENV_OFFSET_REDUND;
7319bcaf 35
eb58a7fc
IG
36#define ACTIVE_FLAG 1
37#define OBSOLETE_FLAG 0
a3110f01 38#endif /* CONFIG_ENV_OFFSET_REDUND */
7319bcaf 39
8c66497e
HS
40DECLARE_GLOBAL_DATA_PTR;
41
eb58a7fc 42char *env_name_spec = "SPI Flash";
8c66497e
HS
43
44static struct spi_flash *env_flash;
45
7319bcaf 46#if defined(CONFIG_ENV_OFFSET_REDUND)
7319bcaf
WW
47int saveenv(void)
48{
cd0f4fa1 49 env_t env_new;
7ce1526e 50 char *saved_buffer = NULL, flag = OBSOLETE_FLAG;
eb58a7fc 51 u32 saved_size, saved_offset, sector = 1;
ea882baf 52 int ret;
7319bcaf
WW
53
54 if (!env_flash) {
a3110f01
SB
55 env_flash = spi_flash_probe(CONFIG_ENV_SPI_BUS,
56 CONFIG_ENV_SPI_CS,
57 CONFIG_ENV_SPI_MAX_HZ, CONFIG_ENV_SPI_MODE);
58 if (!env_flash) {
59 set_default_env("!spi_flash_probe() failed");
60 return 1;
61 }
7319bcaf
WW
62 }
63
7ce1526e
MV
64 ret = env_export(&env_new);
65 if (ret)
66 return ret;
cd0f4fa1 67 env_new.flags = ACTIVE_FLAG;
ea882baf 68
a3110f01
SB
69 if (gd->env_valid == 1) {
70 env_new_offset = CONFIG_ENV_OFFSET_REDUND;
71 env_offset = CONFIG_ENV_OFFSET;
72 } else {
73 env_new_offset = CONFIG_ENV_OFFSET;
74 env_offset = CONFIG_ENV_OFFSET_REDUND;
75 }
76
7319bcaf
WW
77 /* Is the sector larger than the env (i.e. embedded) */
78 if (CONFIG_ENV_SECT_SIZE > CONFIG_ENV_SIZE) {
79 saved_size = CONFIG_ENV_SECT_SIZE - CONFIG_ENV_SIZE;
80 saved_offset = env_new_offset + CONFIG_ENV_SIZE;
81 saved_buffer = malloc(saved_size);
82 if (!saved_buffer) {
83 ret = 1;
84 goto done;
85 }
86 ret = spi_flash_read(env_flash, saved_offset,
87 saved_size, saved_buffer);
88 if (ret)
89 goto done;
90 }
91
92 if (CONFIG_ENV_SIZE > CONFIG_ENV_SECT_SIZE) {
93 sector = CONFIG_ENV_SIZE / CONFIG_ENV_SECT_SIZE;
94 if (CONFIG_ENV_SIZE % CONFIG_ENV_SECT_SIZE)
95 sector++;
96 }
97
98 puts("Erasing SPI flash...");
99 ret = spi_flash_erase(env_flash, env_new_offset,
100 sector * CONFIG_ENV_SECT_SIZE);
101 if (ret)
102 goto done;
103
104 puts("Writing to SPI flash...");
7319bcaf 105
a3110f01 106 ret = spi_flash_write(env_flash, env_new_offset,
cd0f4fa1 107 CONFIG_ENV_SIZE, &env_new);
7319bcaf
WW
108 if (ret)
109 goto done;
110
111 if (CONFIG_ENV_SECT_SIZE > CONFIG_ENV_SIZE) {
112 ret = spi_flash_write(env_flash, saved_offset,
113 saved_size, saved_buffer);
114 if (ret)
115 goto done;
116 }
117
eb58a7fc 118 ret = spi_flash_write(env_flash, env_offset + offsetof(env_t, flags),
cd0f4fa1 119 sizeof(env_new.flags), &flag);
a3110f01
SB
120 if (ret)
121 goto done;
7319bcaf 122
7319bcaf
WW
123 puts("done\n");
124
eb58a7fc 125 gd->env_valid = gd->env_valid == 2 ? 1 : 2;
a3110f01 126
2dc55d9e 127 printf("Valid environment: %d\n", (int)gd->env_valid);
a3110f01 128
7319bcaf
WW
129 done:
130 if (saved_buffer)
131 free(saved_buffer);
eb58a7fc 132
7319bcaf
WW
133 return ret;
134}
135
136void env_relocate_spec(void)
137{
138 int ret;
139 int crc1_ok = 0, crc2_ok = 0;
140 env_t *tmp_env1 = NULL;
141 env_t *tmp_env2 = NULL;
a3110f01 142 env_t *ep = NULL;
7319bcaf
WW
143
144 tmp_env1 = (env_t *)malloc(CONFIG_ENV_SIZE);
7319bcaf 145 tmp_env2 = (env_t *)malloc(CONFIG_ENV_SIZE);
ea882baf
WD
146
147 if (!tmp_env1 || !tmp_env2) {
ea882baf 148 set_default_env("!malloc() failed");
2dc55d9e 149 goto out;
7319bcaf
WW
150 }
151
152 env_flash = spi_flash_probe(CONFIG_ENV_SPI_BUS, CONFIG_ENV_SPI_CS,
153 CONFIG_ENV_SPI_MAX_HZ, CONFIG_ENV_SPI_MODE);
ea882baf
WD
154 if (!env_flash) {
155 set_default_env("!spi_flash_probe() failed");
2dc55d9e 156 goto out;
ea882baf 157 }
7319bcaf
WW
158
159 ret = spi_flash_read(env_flash, CONFIG_ENV_OFFSET,
160 CONFIG_ENV_SIZE, tmp_env1);
ea882baf
WD
161 if (ret) {
162 set_default_env("!spi_flash_read() failed");
7319bcaf 163 goto err_read;
ea882baf 164 }
7319bcaf
WW
165
166 if (crc32(0, tmp_env1->data, ENV_SIZE) == tmp_env1->crc)
167 crc1_ok = 1;
7319bcaf
WW
168
169 ret = spi_flash_read(env_flash, CONFIG_ENV_OFFSET_REDUND,
170 CONFIG_ENV_SIZE, tmp_env2);
171 if (!ret) {
172 if (crc32(0, tmp_env2->data, ENV_SIZE) == tmp_env2->crc)
173 crc2_ok = 1;
7319bcaf
WW
174 }
175
a3110f01 176 if (!crc1_ok && !crc2_ok) {
a3110f01 177 set_default_env("!bad CRC");
2dc55d9e 178 goto err_read;
a3110f01 179 } else if (crc1_ok && !crc2_ok) {
7319bcaf 180 gd->env_valid = 1;
7319bcaf 181 } else if (!crc1_ok && crc2_ok) {
2dc55d9e 182 gd->env_valid = 2;
183 } else if (tmp_env1->flags == ACTIVE_FLAG &&
184 tmp_env2->flags == OBSOLETE_FLAG) {
7319bcaf 185 gd->env_valid = 1;
2dc55d9e 186 } else if (tmp_env1->flags == OBSOLETE_FLAG &&
187 tmp_env2->flags == ACTIVE_FLAG) {
a3110f01 188 gd->env_valid = 2;
2dc55d9e 189 } else if (tmp_env1->flags == tmp_env2->flags) {
7319bcaf 190 gd->env_valid = 2;
2dc55d9e 191 } else if (tmp_env1->flags == 0xFF) {
7319bcaf 192 gd->env_valid = 2;
7319bcaf
WW
193 } else {
194 /*
195 * this differs from code in env_flash.c, but I think a sane
196 * default path is desirable.
197 */
198 gd->env_valid = 2;
7319bcaf 199 }
ea882baf 200
a3110f01
SB
201 if (gd->env_valid == 1)
202 ep = tmp_env1;
203 else
204 ep = tmp_env2;
205
206 ret = env_import((char *)ep, 0);
207 if (!ret) {
208 error("Cannot import environment: errno = %d\n", errno);
209 set_default_env("env_import failed");
7319bcaf 210 }
7319bcaf
WW
211
212err_read:
213 spi_flash_free(env_flash);
214 env_flash = NULL;
7319bcaf 215out:
ea882baf
WD
216 free(tmp_env1);
217 free(tmp_env2);
7319bcaf
WW
218}
219#else
8c66497e
HS
220int saveenv(void)
221{
eb58a7fc 222 u32 saved_size, saved_offset, sector = 1;
7ce1526e 223 char *saved_buffer = NULL;
eb58a7fc 224 int ret = 1;
cd0f4fa1 225 env_t env_new;
07efc9e3 226
8c66497e 227 if (!env_flash) {
a3110f01
SB
228 env_flash = spi_flash_probe(CONFIG_ENV_SPI_BUS,
229 CONFIG_ENV_SPI_CS,
230 CONFIG_ENV_SPI_MAX_HZ, CONFIG_ENV_SPI_MODE);
231 if (!env_flash) {
232 set_default_env("!spi_flash_probe() failed");
233 return 1;
234 }
8c66497e
HS
235 }
236
5b3375ac
MF
237 /* Is the sector larger than the env (i.e. embedded) */
238 if (CONFIG_ENV_SECT_SIZE > CONFIG_ENV_SIZE) {
239 saved_size = CONFIG_ENV_SECT_SIZE - CONFIG_ENV_SIZE;
240 saved_offset = CONFIG_ENV_OFFSET + CONFIG_ENV_SIZE;
241 saved_buffer = malloc(saved_size);
eb58a7fc 242 if (!saved_buffer)
5b3375ac 243 goto done;
eb58a7fc 244
a3110f01
SB
245 ret = spi_flash_read(env_flash, saved_offset,
246 saved_size, saved_buffer);
5b3375ac
MF
247 if (ret)
248 goto done;
249 }
250
0e8d1586
JCPV
251 if (CONFIG_ENV_SIZE > CONFIG_ENV_SECT_SIZE) {
252 sector = CONFIG_ENV_SIZE / CONFIG_ENV_SECT_SIZE;
253 if (CONFIG_ENV_SIZE % CONFIG_ENV_SECT_SIZE)
07efc9e3
TL
254 sector++;
255 }
256
7ce1526e
MV
257 ret = env_export(&env_new);
258 if (ret)
a3110f01 259 goto done;
a3110f01 260
8c66497e 261 puts("Erasing SPI flash...");
a3110f01
SB
262 ret = spi_flash_erase(env_flash, CONFIG_ENV_OFFSET,
263 sector * CONFIG_ENV_SECT_SIZE);
5b3375ac
MF
264 if (ret)
265 goto done;
8c66497e
HS
266
267 puts("Writing to SPI flash...");
a3110f01 268 ret = spi_flash_write(env_flash, CONFIG_ENV_OFFSET,
cd0f4fa1 269 CONFIG_ENV_SIZE, &env_new);
5b3375ac
MF
270 if (ret)
271 goto done;
8c66497e 272
5b3375ac 273 if (CONFIG_ENV_SECT_SIZE > CONFIG_ENV_SIZE) {
a3110f01
SB
274 ret = spi_flash_write(env_flash, saved_offset,
275 saved_size, saved_buffer);
5b3375ac
MF
276 if (ret)
277 goto done;
278 }
279
280 ret = 0;
8c66497e 281 puts("done\n");
5b3375ac
MF
282
283 done:
284 if (saved_buffer)
285 free(saved_buffer);
eb58a7fc 286
5b3375ac 287 return ret;
8c66497e
HS
288}
289
290void env_relocate_spec(void)
291{
292 int ret;
5a89fa92 293 char *buf = NULL;
8c66497e 294
5a89fa92 295 buf = (char *)malloc(CONFIG_ENV_SIZE);
0e8d1586
JCPV
296 env_flash = spi_flash_probe(CONFIG_ENV_SPI_BUS, CONFIG_ENV_SPI_CS,
297 CONFIG_ENV_SPI_MAX_HZ, CONFIG_ENV_SPI_MODE);
ea882baf
WD
298 if (!env_flash) {
299 set_default_env("!spi_flash_probe() failed");
5a89fa92
YZ
300 if (buf)
301 free(buf);
ea882baf
WD
302 return;
303 }
8c66497e 304
ea882baf
WD
305 ret = spi_flash_read(env_flash,
306 CONFIG_ENV_OFFSET, CONFIG_ENV_SIZE, buf);
307 if (ret) {
308 set_default_env("!spi_flash_read() failed");
309 goto out;
310 }
8c66497e 311
ea882baf 312 ret = env_import(buf, 1);
ea882baf
WD
313 if (ret)
314 gd->env_valid = 1;
315out:
8c66497e 316 spi_flash_free(env_flash);
5a89fa92
YZ
317 if (buf)
318 free(buf);
8c66497e 319 env_flash = NULL;
8c66497e 320}
7319bcaf 321#endif
8c66497e
HS
322
323int env_init(void)
324{
325 /* SPI flash isn't usable before relocation */
326 gd->env_addr = (ulong)&default_environment[0];
327 gd->env_valid = 1;
328
329 return 0;
330}