changed to eCos license.
[mw/openocd-lm32.git] / ecosflash / flash.c
1 /*
2 #####ECOSGPLCOPYRIGHTBEGIN####
3 ## -------------------------------------------
4 ## This file is part of eCos, the Embedded Configurable Operating System.
5 ## Copyright (C) 2008 √ėyvind Harboe
6 ##
7 ## eCos is free software; you can redistribute it and/or modify it under
8 ## the terms of the GNU General Public License as published by the Free
9 ## Software Foundation; either version 2 or (at your option) any later version.
10 ##
11 ## eCos is distributed in the hope that it will be useful, but WITHOUT ANY
12 ## WARRANTY; without even the implied warranty of MERCHANTABILITY or
13 ## FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
14 ## for more details.
15 ##
16 ## You should have received a copy of the GNU General Public License along
17 ## with eCos; if not, write to the Free Software Foundation, Inc.,
18 ## 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
19 ##
20 ## As a special exception, if other files instantiate templates or use macros
21 ## or inline functions from this file, or you compile this file and link it
22 ## with other works to produce a work based on this file, this file does not
23 ## by itself cause the resulting work to be covered by the GNU General Public
24 ## License. However the source code for this file must still be made available
25 ## in accordance with section (3) of the GNU General Public License.
26 ##
27 ## This exception does not invalidate any other reasons why a work based on
28 ## this file might be covered by the GNU General Public License.
29 ## -------------------------------------------
30 #####ECOSGPLCOPYRIGHTEND####
31 */
32
33 #include <string.h>
34 #define _FLASH_PRIVATE_
35 #include <cyg/io/flash.h>
36
37
38
39 int myprintf(char *format, ...)
40 {
41   return 0;
42 }
43
44 extern char _start_bss_clear;
45 extern char __bss_end__;
46
47 int init()
48 {
49         // set up runtime environment
50         char *t;
51         for (t=&_start_bss_clear; t<&__bss_end__; t++)
52         {
53                 *t=0;
54         }
55         return flash_init((_printf *)&myprintf);
56         
57 }
58
59
60 int checkFlash(void *addr, int len)
61 {
62     // Return error for illegal addresses
63     if ((addr<flash_info.start)||(addr>flash_info.end))
64         return FLASH_ERR_INVALID;
65     if ((((cyg_uint8 *)addr)+len)>(cyg_uint8 *)flash_info.end)
66         return FLASH_ERR_INVALID;
67     return FLASH_ERR_OK;
68 }
69
70
71 int erase(void *address, int len)       
72 {
73         int retval;
74         void *failAddress;
75         
76         retval=checkFlash(address, len);
77         if (retval!=0)
78                 return retval;
79         
80         retval=init();
81         if (retval!=0)
82                 return retval;
83         return flash_erase(address, len, &failAddress);
84 }
85
86
87
88 extern char _end;
89
90 // Data follows immediately after program, long word aligned.
91 int program(void *buffer, void *address, int len)       
92 {
93         int retval;
94         void *failAddress;
95         retval=checkFlash(address, len);
96         if (retval!=0)
97                 return retval;
98         
99         retval=init();
100         if (retval!=0)
101                 return retval;
102         //int flash_program(void *_addr, void *_data, int len, void **err_addr)
103         return flash_program(address, buffer, len, &failAddress);
104 }