| wdenk | 5779d8d | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 1 | /* LowLevel function for DataFlash environment support |
| 2 | * Author : Gilles Gastaldi (Atmel) |
| 3 | * |
| 4 | * This program is free software; you can redistribute it and/or |
| 5 | * modify it under the terms of the GNU General Public License as |
| 6 | * published by the Free Software Foundation; either version 2 of |
| 7 | * the License, or (at your option) any later version. |
| 8 | * |
| 9 | * This program is distributed in the hope that it will be useful, |
| 10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 12 | * GNU General Public License for more details. |
| 13 | * |
| 14 | * You should have received a copy of the GNU General Public License |
| 15 | * along with this program; if not, write to the Free Software |
| 16 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
| 17 | * MA 02111-1307 USA |
| 18 | * |
| 19 | */ |
| 20 | #include <common.h> |
| 21 | |
| 22 | #if defined(CFG_ENV_IS_IN_DATAFLASH) /* Environment is in DataFlash */ |
| 23 | |
| 24 | #include <command.h> |
| 25 | #include <environment.h> |
| 26 | #include <linux/stddef.h> |
| 27 | #include <malloc.h> |
| 28 | #include <dataflash.h> |
| 29 | |
| 30 | env_t *env_ptr = NULL; |
| 31 | |
| 32 | char * env_name_spec = "dataflash"; |
| 33 | |
| 34 | extern int read_dataflash (unsigned long addr, unsigned long size, char |
| 35 | *result); |
| 36 | extern int write_dataflash (unsigned long addr_dest, unsigned long addr_src, |
| 37 | unsigned long size); |
| 38 | extern int AT91F_DataflashInit (void); |
| 39 | extern uchar default_environment[]; |
| 40 | /* extern int default_environment_size; */ |
| 41 | |
| 42 | |
| 43 | uchar env_get_char_spec (int index) |
| 44 | { |
| 45 | uchar c; |
| 46 | read_dataflash (CFG_ENV_ADDR+index+offsetof(env_t,data),1,&c); |
| 47 | return (c); |
| 48 | } |
| 49 | |
| 50 | void env_relocate_spec (void) |
| 51 | { |
| 52 | read_dataflash (CFG_ENV_ADDR,CFG_ENV_SIZE,(uchar *)env_ptr); |
| 53 | } |
| 54 | |
| 55 | int saveenv(void) |
| 56 | { |
| 57 | /* env must be copied to do not alter env structure in memory*/ |
| 58 | unsigned char temp[CFG_ENV_SIZE]; |
| 59 | int i; |
| 60 | memcpy(temp, env_ptr, CFG_ENV_SIZE); |
| 61 | return write_dataflash (CFG_ENV_ADDR, (unsigned long)temp, CFG_ENV_SIZE); |
| 62 | } |
| 63 | |
| 64 | /************************************************************************ |
| 65 | * Initialize Environment use |
| 66 | * |
| 67 | * We are still running from ROM, so data use is limited |
| 68 | * Use a (moderately small) buffer on the stack |
| 69 | */ |
| 70 | int env_init(void) |
| 71 | { |
| 72 | DECLARE_GLOBAL_DATA_PTR; |
| 73 | |
| 74 | ulong crc, len, new; |
| 75 | unsigned off; |
| 76 | uchar buf[64]; |
| 77 | if (gd->env_valid == 0){ |
| 78 | AT91F_DataflashInit(); /* prepare for DATAFLASH read/write */ |
| 79 | |
| 80 | /* read old CRC */ |
| 81 | read_dataflash (CFG_ENV_ADDR+offsetof(env_t,crc),sizeof(ulong),&crc); |
| 82 | new = 0; |
| 83 | len = ENV_SIZE; |
| 84 | off = offsetof(env_t,data); |
| 85 | while (len > 0) { |
| 86 | int n = (len > sizeof(buf)) ? sizeof(buf) : len; |
| 87 | read_dataflash (CFG_ENV_ADDR+off,n , buf); |
| 88 | new = crc32 (new, buf, n); |
| 89 | len -= n; |
| 90 | off += n; |
| 91 | } |
| 92 | if (crc == new) { |
| 93 | gd->env_addr = offsetof(env_t,data); |
| 94 | gd->env_valid = 1; |
| 95 | } else { |
| 96 | gd->env_addr = (ulong)&default_environment[0]; |
| 97 | gd->env_valid = 0; |
| 98 | } |
| 99 | } |
| 100 | |
| 101 | return (0); |
| 102 | } |
| 103 | |
| 104 | #endif /* CFG_ENV_IS_IN_DATAFLASH */ |