packages/devs/flash/arm/am29/v2_0/src/flash_program_buf.c

   1 //==========================================================================
   2 //
   3 //      flash_program_buf.c
   4 //
   5 //      Flash programming
   6 //
   7 //==========================================================================
   8 //####ECOSGPLCOPYRIGHTBEGIN####
   9 // -------------------------------------------
  10 // This file is part of eCos, the Embedded Configurable Operating System.
  11 // Copyright (C) 1998, 1999, 2000, 2001, 2002 Red Hat, Inc.
  12 //
  13 // eCos is free software; you can redistribute it and/or modify it under
  14 // the terms of the GNU General Public License as published by the Free
  15 // Software Foundation; either version 2 or (at your option) any later version.
  16 //
  17 // eCos is distributed in the hope that it will be useful, but WITHOUT ANY
  18 // WARRANTY; without even the implied warranty of MERCHANTABILITY or
  19 // FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
  20 // for more details.
  21 //
  22 // You should have received a copy of the GNU General Public License along
  23 // with eCos; if not, write to the Free Software Foundation, Inc.,
  24 // 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  25 //
  26 // As a special exception, if other files instantiate templates or use macros
  27 // or inline functions from this file, or you compile this file and link it
  28 // with other works to produce a work based on this file, this file does not
  29 // by itself cause the resulting work to be covered by the GNU General Public
  30 // License. However the source code for this file must still be made available
  31 // in accordance with section (3) of the GNU General Public License.
  32 //
  33 // This exception does not invalidate any other reasons why a work based on
  34 // this file might be covered by the GNU General Public License.
  35 //
  36 // Alternative licenses for eCos may be arranged by contacting Red Hat, Inc.
  37 // at http://sources.redhat.com/ecos/ecos-license/
  38 // -------------------------------------------
  39 //####ECOSGPLCOPYRIGHTEND####
  40 //===========================================================================
  41
  42 #include <cyg/io/flash.h>
  43 #include <pkgconf/hal.h>
  44 #include <cyg/hal/hal_arch.h>
  45
  46 #if defined(CYGPKG_HAL_ARM_MDBMX1)
  47         #include <cyg/hal/hal_mdbmx1.h>         // Hardware definitions
  48 #elif defined(CYGPKG_HAL_ARM_MX21)
  49         #include <cyg/hal/hal_soc.h>            // Hardware definitions
  50 #else
  51     #error MX1 or MX2?
  52 #endif
  53
  54 #include "am29.h"
  55
  56 #ifndef MXCFLASH_SELECT_MULTI
  57 int
  58 flash_program_buf(volatile unsigned long *addr, unsigned long *data, int byteLen)
  59         __attribute__ ((section (".2ram.flash_program_buf")));
  60 #else
  61 int  norflash_program_buf(volatile unsigned long *addr, unsigned long *data, int byteLen);
  62 #endif
  63
  64 int
  65 #ifndef MXCFLASH_SELECT_MULTI
  66 flash_program_buf(volatile unsigned long *addr, unsigned long *data, int byteLen)
  67 #else
  68 norflash_program_buf(volatile unsigned long *addr, unsigned long *data, int byteLen)
  69 #endif
  70 {
  71     unsigned long stat = FLASH_ERR_OK;
  72     int i, j=0;
  73     volatile flash_data_t* tempWriteData = (volatile flash_data_t *)data;
  74     volatile flash_data_t tempReadData = 0;
  75
  76     FLASH_RESET();
  77     FLASH_UB_ENTRY();
  78     for(i=0, j=0; i<byteLen; i+=2*CYGNUM_FLASH_INTERLEAVE, j++)
  79         {
  80         FLASH_UB_PROGRAM(((unsigned long)addr)+i, tempWriteData[j]);
  81
  82         while(((tempReadData = (*FLASH_P2V(((unsigned long)addr)+i))) & KBIT7) != (tempWriteData[j] & KBIT7))
  83             {
  84             if((tempReadData & KBIT5) == KBIT5)
  85                 {
  86                 if(((*FLASH_P2V(((unsigned long)addr)+i)) & KBIT7) == (tempWriteData[j] & KBIT7))
  87                     break;
  88                 else
  89                     {
  90                     FLASH_UB_RESET();
  91                     return FLASH_ERR_PROGRAM;
  92                     }
  93
  94                 }
  95             }
  96         }
  97
  98     FLASH_UB_RESET();
  99     FLASH_RESET();
 100
 101     return stat;
 102 }
 103