/* * LowLevel function for DataFlash environment support * Author : Gilles Gastaldi (Atmel) * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License as * published by the Free Software Foundation; either version 2 of * the License, or (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place, Suite 330, Boston, * MA 02111-1307 USA */ #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; env_t *env_ptr = NULL; char * env_name_spec = "dataflash"; extern int read_dataflash(unsigned long addr, unsigned long size, char *result); extern int write_dataflash(unsigned long addr_dest, unsigned long addr_src, unsigned long size); extern int AT91F_DataflashInit(void); extern uchar default_environment[]; uchar env_get_char_spec(int index) { uchar c; read_dataflash(CONFIG_ENV_ADDR + index + offsetof(env_t,data), 1, (char *)&c); return (c); } void env_relocate_spec(void) { char buf[CONFIG_ENV_SIZE]; read_dataflash(CONFIG_ENV_ADDR, CONFIG_ENV_SIZE, buf); env_import(buf, 1); } #ifdef CONFIG_ENV_OFFSET_REDUND #error No support for redundant environment on dataflash yet! #endif int saveenv(void) { env_t env_new; ssize_t len; char *res; res = (char *)&env_new.data; len = hexport_r(&env_htab, '\0', &res, ENV_SIZE); if (len < 0) { error("Cannot export environment: errno = %d\n", errno); return 1; } env_new.crc = crc32(0, env_new.data, ENV_SIZE); return write_dataflash(CONFIG_ENV_ADDR, (unsigned long)&env_new, CONFIG_ENV_SIZE); } /* * Initialize environment use * * We are still running from ROM, so data use is limited. * Use a (moderately small) buffer on the stack */ int env_init(void) { ulong crc, len, new; unsigned off; uchar buf[64]; if (gd->env_valid) return 0; AT91F_DataflashInit(); /* prepare for DATAFLASH read/write */ /* read old CRC */ read_dataflash(CONFIG_ENV_ADDR + offsetof(env_t, crc), sizeof(ulong), (char *)&crc); new = 0; len = ENV_SIZE; off = offsetof(env_t,data); while (len > 0) { int n = (len > sizeof(buf)) ? sizeof(buf) : len; read_dataflash(CONFIG_ENV_ADDR + off, n, (char *)buf); new = crc32 (new, buf, n); len -= n; off += n; } if (crc == new) { gd->env_addr = offsetof(env_t,data); gd->env_valid = 1; } else { gd->env_addr = (ulong)&default_environment[0]; gd->env_valid = 0; } return 0; }