diff options
Diffstat (limited to 'env/dataflash.c')
-rw-r--r-- | env/dataflash.c | 75 |
1 files changed, 75 insertions, 0 deletions
diff --git a/env/dataflash.c b/env/dataflash.c new file mode 100644 index 0000000000..77bc595e0d --- /dev/null +++ b/env/dataflash.c @@ -0,0 +1,75 @@ +/* + * LowLevel function for DataFlash environment support + * Author : Gilles Gastaldi (Atmel) + * + * SPDX-License-Identifier: GPL-2.0+ + */ +#include <common.h> +#include <command.h> +#include <environment.h> +#include <linux/stddef.h> +#include <dataflash.h> +#include <search.h> +#include <errno.h> + +DECLARE_GLOBAL_DATA_PTR; + +static int env_dataflash_get_char(int index) +{ + uchar c; + + read_dataflash(CONFIG_ENV_ADDR + index + offsetof(env_t, data), + 1, (char *)&c); + return c; +} + +static int env_dataflash_load(void) +{ + ulong crc, new = 0; + unsigned off; + char buf[CONFIG_ENV_SIZE]; + + /* Read old CRC */ + read_dataflash(CONFIG_ENV_ADDR + offsetof(env_t, crc), + sizeof(ulong), (char *)&crc); + + /* Read whole environment */ + read_dataflash(CONFIG_ENV_ADDR, CONFIG_ENV_SIZE, buf); + + /* Calculate the CRC */ + off = offsetof(env_t, data); + new = crc32(new, (unsigned char *)(buf + off), ENV_SIZE); + + if (crc == new) + env_import(buf, 1); + else + set_default_env("!bad CRC"); + + return 0; +} + +#ifdef CONFIG_ENV_OFFSET_REDUND +#error No support for redundant environment on dataflash yet! +#endif + +static int env_dataflash_save(void) +{ + env_t env_new; + int ret; + + ret = env_export(&env_new); + if (ret) + return ret; + + return write_dataflash(CONFIG_ENV_ADDR, + (unsigned long)&env_new, + CONFIG_ENV_SIZE); +} + +U_BOOT_ENV_LOCATION(dataflash) = { + .location = ENVL_DATAFLASH, + ENV_NAME("dataflash") + .get_char = env_dataflash_get_char, + .load = env_dataflash_load, + .save = env_save_ptr(env_dataflash_save), +}; |