packages/devs/flash/intel/strata/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, 2004 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 //#####DESCRIPTIONBEGIN####
  42 //
  43 // Author(s):    gthomas, hmt
  44 // Contributors: gthomas
  45 // Date:         2001-02-14
  46 // Purpose:
  47 // Description:
  48 //
  49 //####DESCRIPTIONEND####
  50 //
  51 //==========================================================================
  52
  53 #include "strata.h"
  54
  55 #include <pkgconf/hal.h>
  56 #include <cyg/hal/hal_arch.h>
  57
  58 // Platforms may define this for special handling when accessing the write buffer.
  59 #ifndef CYGHWR_FLASH_WRITE_BUF
  60 #define CYGHWR_FLASH_WRITE_BUF(a,b) (*(a) = *(b))
  61 #endif
  62
  63 int
  64 flash_program_buf(volatile flash_t *addr, flash_t *data, int len,
  65                   unsigned long block_mask, int buffer_size)
  66  __attribute__ ((section (".2ram.flash_program_buf")));
  67 int
  68 flash_program_buf(volatile flash_t *addr, flash_t *data, int len,
  69                   unsigned long block_mask, int buffer_size)
  70 {
  71     volatile flash_t *ROM;
  72     volatile flash_t *BA;
  73     flash_t stat = 0;
  74     int timeout = 50000;
  75 #ifdef FLASH_Write_Buffer
  76     int i, wc;
  77 #endif
  78
  79     // Get base address and map addresses to virtual addresses
  80     ROM = FLASH_P2V( CYGNUM_FLASH_BASE_MASK & (unsigned int)addr );
  81     BA = addr = FLASH_P2V(addr);
  82
  83     // Clear any error conditions
  84     ROM[0] = FLASH_Clear_Status;
  85
  86 #ifdef FLASH_Write_Buffer
  87     // Write any big chunks first
  88     while (len >= buffer_size) {
  89         wc = buffer_size;
  90         if (wc > len) wc = len;
  91         len -= wc;
  92         // convert 'wc' in bytes to 'wc' in 'flash_t'
  93         wc = wc / sizeof(flash_t);  // Word count
  94         *BA = FLASH_Write_Buffer;
  95         timeout = 5000000;
  96         while(((stat = ROM[0]) & FLASH_Status_Ready) != FLASH_Status_Ready) {
  97             if (--timeout == 0) {
  98                 goto bad;
  99             }
 100             *BA = FLASH_Write_Buffer;
 101         }
 102         *BA = FLASHWORD(wc-1);  // Count is 0..N-1
 103         for (i = 0;  i < wc;  i++) {
 104 #ifdef CYGHWR_FLASH_WRITE_ELEM
 105             CYGHWR_FLASH_WRITE_ELEM(addr+i, data+i);
 106 #else
 107             CYGHWR_FLASH_WRITE_BUF(addr+i, data+i);
 108 #endif
 109         }
 110         *BA = FLASH_Confirm;
 111
 112         ROM[0] = FLASH_Read_Status;
 113         timeout = 5000000;
 114         while(((stat = ROM[0]) & FLASH_Status_Ready) != FLASH_Status_Ready) {
 115             if (--timeout == 0) {
 116                 goto bad;
 117             }
 118         }
 119         // Jump out if there was an error
 120         if (stat & FLASH_ErrorMask) {
 121             goto bad;
 122         }
 123         // And verify the data - also increments the pointers.
 124         *BA = FLASH_Reset;
 125         for (i = 0;  i < wc;  i++) {
 126             if ( *addr++ != *data++ ) {
 127                 stat = FLASH_ErrorNotVerified;
 128                 goto bad;
 129             }
 130         }
 131     }
 132 #endif
 133
 134     while (len > 0) {
 135         BA[0] = FLASH_Program;
 136 #ifdef CYGHWR_FLASH_WRITE_ELEM
 137         CYGHWR_FLASH_WRITE_ELEM(addr, data);
 138 #else
 139         *addr = *data;
 140 #endif
 141         timeout = 5000000;
 142         while(((stat = BA[0]) & FLASH_Status_Ready) != FLASH_Status_Ready) {
 143             if (--timeout == 0) {
 144                 goto bad;
 145             }
 146         }
 147         if (stat & FLASH_ErrorMask) {
 148             break;
 149         }
 150         BA[0] = FLASH_Reset;
 151         if (*addr++ != *data++) {
 152             stat = FLASH_ErrorNotVerified;
 153             break;
 154         }
 155         len -= sizeof( flash_t );
 156     }
 157
 158     // Restore ROM to "normal" mode
 159  bad:
 160     BA[0] = FLASH_Reset;
 161
 162     return stat;
 163 }