common/env_dataflash.c

   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 */