source: SVN/cambria/redboot/packages/devs/flash/intel/strata/current/src/flash_program_buf.c @ 1

Last change on this file since 1 was 1, checked in by Tim Harvey, 2 years ago

restored latest version of files from server backup

Signed-off-by: Tim Harvey <tharvey@…>

File size: 5.2 KB
Line 
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
63int
64flash_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")));
67int
68flash_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}
Note: See TracBrowser for help on using the repository browser.