packages/devs/flash/intel/strata/v2_0/src/flash_erase_block.c

   1 //==========================================================================
   2 //
   3 //      flash_erase_block.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 //#####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 int flash_erase_block(volatile flash_t *block, unsigned int block_size)
  59         __attribute__ ((section (".2ram.flash_erase_block")));
  60 int flash_erase_block(volatile flash_t *block, unsigned int block_size)
  61 {
  62     volatile flash_t *ROM;
  63     flash_t stat = 0;
  64     int timeout = 50000;
  65     int len, block_len, erase_block_size;
  66     volatile flash_t *eb;
  67
  68     // Get base address and map addresses to virtual addresses
  69     ROM = FLASH_P2V(CYGNUM_FLASH_BASE_MASK & (unsigned int)block);
  70     eb = block = FLASH_P2V(block);
  71     block_len = block_size;
  72
  73 #ifdef CYGOPT_FLASH_IS_BOOTBLOCK
  74 #define BLOCKSIZE (0x10000*CYGNUM_FLASH_DEVICES)
  75 #define ERASE_BLOCKSIZE (0x2000*CYGNUM_FLASH_DEVICES)
  76     if ((eb - ROM) < BLOCKSIZE/(sizeof eb[0])) {
  77         erase_block_size = ERASE_BLOCKSIZE;
  78     } else {
  79         erase_block_size = block_size;
  80     }
  81 #else
  82     erase_block_size = block_size;
  83 #endif
  84
  85     // Clear any error conditions
  86     ROM[0] = FLASH_Clear_Status;
  87
  88     // Erase block
  89     while (block_len > 0) {
  90         eb[0] = FLASH_Block_Erase;
  91         eb[0] = FLASH_Confirm;
  92
  93         timeout = 5000000;
  94         while(((stat = eb[0]) & FLASH_Status_Ready) != FLASH_Status_Ready) {
  95             if (--timeout == 0) break;
  96         }
  97
  98         block_len -= erase_block_size;
  99         eb = FLASH_P2V((unsigned int)eb + erase_block_size);
 100     }
 101
 102     // Restore ROM to "normal" mode
 103     ROM[0] = FLASH_Reset;
 104
 105     // If an error was reported, see if the block erased anyway
 106     if (stat & FLASH_ErrorMask ) {
 107         len = block_size;
 108         while (len > 0) {
 109             if (*block++ != FLASH_BlankValue ) break;
 110             len -= sizeof(*block);
 111         }
 112         if (len == 0) stat = 0;
 113     }
 114
 115     return stat;
 116 }