1 //==========================================================================
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.
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.
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
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.
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.
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.
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####
44 // Contributors: gthomas
49 //####DESCRIPTIONEND####
51 //==========================================================================
55 #include <pkgconf/hal.h>
56 #include <cyg/hal/hal_arch.h>
57 #include <cyg/hal/hal_cache.h>
60 // CAUTION! This code must be copied to RAM before execution. Therefore,
61 // it must not contain any code which might be position dependent!
65 flash_program_buf(volatile unsigned short *addr, unsigned short *data, int len)
67 volatile unsigned short *PAGE, *ROM;
71 unsigned short hold[FLASH_PAGE_SIZE/2];
73 HAL_DCACHE_IS_ENABLED(cache_on);
79 if (len != FLASH_PAGE_SIZE) {
80 return FLASH_LENGTH_ERROR;
83 ROM = (volatile unsigned short *)((unsigned long)addr & 0xFFFF0000);
84 PAGE = (volatile unsigned short *)((unsigned long)addr & FLASH_PAGE_MASK);
86 // Copy current contents (allows for partial updates)
87 for (i = 0; i < FLASH_PAGE_SIZE/2; i++) {
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];
99 // Send lead-in sequence
100 ROM[FLASH_Key_Addr0] = FLASH_Key0;
101 ROM[FLASH_Key_Addr1] = FLASH_Key1;
103 // Send 'write' command
104 ROM[FLASH_Key_Addr0] = FLASH_Program;
106 // Send one page/sector of data
107 for (i = 0; i < FLASH_PAGE_SIZE/2; i++) {
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]) {
119 return FLASH_PROGRAM_ERROR;
126 return FLASH_PROGRAM_OK;