|  | /* | 
|  | * 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; | 
|  |  | 
|  | char *env_name_spec = "dataflash"; | 
|  |  | 
|  | 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, 0, NULL); | 
|  | 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 = ENV_SIZE, new = 0; | 
|  | 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); | 
|  |  | 
|  | 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; | 
|  | } |