packages/devs/flash/arm/at91/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 //#####DESCRIPTIONBEGIN####
  42 //
  43 // Author(s):    gthomas
  44 // Contributors: gthomas
  45 // Date:         2001-07-17
  46 // Purpose:
  47 // Description:
  48 //
  49 //####DESCRIPTIONEND####
  50 //
  51 //==========================================================================
  52
  53 #include "flash.h"
  54
  55 #include <pkgconf/hal.h>
  56 #include <cyg/hal/hal_arch.h>
  57 #include <cyg/hal/hal_cache.h>
  58
  59 //
  60 // CAUTION!  This code must be copied to RAM before execution.  Therefore,
  61 // it must not contain any code which might be position dependent!
  62 //
  63
  64 int
  65 flash_program_buf(volatile unsigned short *addr, unsigned short *data, int len)
  66 {
  67     volatile unsigned short *PAGE, *ROM;
  68     int timeout = 50000;
  69     int cache_on;
  70     int i, offset;
  71     unsigned short hold[FLASH_PAGE_SIZE/2];
  72
  73     HAL_DCACHE_IS_ENABLED(cache_on);
  74     if (cache_on) {
  75         HAL_DCACHE_SYNC();
  76         HAL_DCACHE_DISABLE();
  77     }
  78
  79     if (len != FLASH_PAGE_SIZE) {
  80         return FLASH_LENGTH_ERROR;
  81     }
  82
  83     ROM = (volatile unsigned short *)((unsigned long)addr & 0xFFFF0000);
  84     PAGE = (volatile unsigned short *)((unsigned long)addr & FLASH_PAGE_MASK);
  85
  86     // Copy current contents (allows for partial updates)
  87     for (i = 0;  i < FLASH_PAGE_SIZE/2;  i++) {
  88         hold[i] = PAGE[i];
  89     }
  90
  91     // Merge data into holding buffer
  92     offset = (unsigned long)addr & FLASH_PAGE_OFFSET;
  93     for (i = 0;  i < (len/2);  i++) {
  94         hold[offset+i] = data[i];
  95     }
  96
  97     // Now write the data
  98
  99     // Send lead-in sequence
 100     ROM[FLASH_Key_Addr0] = FLASH_Key0;
 101     ROM[FLASH_Key_Addr1] = FLASH_Key1;
 102
 103     // Send 'write' command
 104     ROM[FLASH_Key_Addr0] = FLASH_Program;
 105
 106     // Send one page/sector of data
 107     for (i = 0;  i < FLASH_PAGE_SIZE/2;  i++) {
 108         PAGE[i] = hold[i];
 109     }
 110
 111     // Wait for data to be programmed
 112     while (timeout-- > 0) {
 113         if (PAGE[(FLASH_PAGE_SIZE/2)-1] == hold[(FLASH_PAGE_SIZE/2)-1]) {
 114             break;
 115         }
 116     }
 117
 118     if (timeout <= 0) {
 119         return FLASH_PROGRAM_ERROR;
 120     }
 121
 122     if (cache_on) {
 123         HAL_DCACHE_ENABLE();
 124     }
 125
 126     return FLASH_PROGRAM_OK;
 127 }