Mercurial > flash_v2
annotate packages/io/flash/current/src/flash.c @ 1706:3845779eca10
* src/flash.c: Major rewrite to implement a new API
* src/legacy_api.c: Support the legacy API
* src/legacy_drv.c: Support the legacy driver API
* src/flashiodev.c: Support the new API and multiple devices
* include/flash_priv.h: Interface devices should use
* cdl/io_flash.cdl: Updates for new interface and multiple devices.
| author | asl |
|---|---|
| date | Thu, 05 Aug 2004 13:50:00 +0000 |
| parents | e1d094896914 |
| children | 868c3fa9315f |
| rev | line source |
|---|---|
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
1 //========================================================================== |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
2 // |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
3 // flash.c |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
4 // |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
5 // Flash programming |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
6 // |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
7 //========================================================================== |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
8 //####ECOSGPLCOPYRIGHTBEGIN#### |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
9 // ------------------------------------------- |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
10 // This file is part of eCos, the Embedded Configurable Operating System. |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
11 // Copyright (C) 1998, 1999, 2000, 2001, 2002 Red Hat, Inc. |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
12 // Copyright (C) 2003 Gary Thomas |
| 1706 | 13 // Copyright (C) 2004 Andrew Lunn |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
14 // |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
15 // eCos is free software; you can redistribute it and/or modify it under |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
16 // the terms of the GNU General Public License as published by the Free |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
17 // Software Foundation; either version 2 or (at your option) any later version. |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
18 // |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
19 // eCos is distributed in the hope that it will be useful, but WITHOUT ANY |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
20 // WARRANTY; without even the implied warranty of MERCHANTABILITY or |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
21 // FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
22 // for more details. |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
23 // |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
24 // You should have received a copy of the GNU General Public License along |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
25 // with eCos; if not, write to the Free Software Foundation, Inc., |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
26 // 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
27 // |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
28 // As a special exception, if other files instantiate templates or use macros |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
29 // or inline functions from this file, or you compile this file and link it |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
30 // with other works to produce a work based on this file, this file does not |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
31 // by itself cause the resulting work to be covered by the GNU General Public |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
32 // License. However the source code for this file must still be made available |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
33 // in accordance with section (3) of the GNU General Public License. |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
34 // |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
35 // This exception does not invalidate any other reasons why a work based on |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
36 // this file might be covered by the GNU General Public License. |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
37 // |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
38 // Alternative licenses for eCos may be arranged by contacting Red Hat, Inc. |
|
210
d2c90368aeef
Merge from eCos master repository on 2002-05-23-21:39:14-BST
jlarmour
parents:
208
diff
changeset
|
39 // at http://sources.redhat.com/ecos/ecos-license/ |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
40 // ------------------------------------------- |
|
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
41 //####ECOSGPLCOPYRIGHTEND#### |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
42 //========================================================================== |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
43 //#####DESCRIPTIONBEGIN#### |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
44 // |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
45 // Author(s): gthomas |
| 1706 | 46 // Contributors: gthomas, Andrew Lunn |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
47 // Date: 2000-07-26 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
48 // Purpose: |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
49 // Description: |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
50 // |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
51 //####DESCRIPTIONEND#### |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
52 // |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
53 //========================================================================== |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
54 |
|
119
77cec8369160
Merge from eCos master repository on 2000-09-01-07:47:03-BST
jlarmour
parents:
117
diff
changeset
|
55 #include <pkgconf/system.h> |
|
77cec8369160
Merge from eCos master repository on 2000-09-01-07:47:03-BST
jlarmour
parents:
117
diff
changeset
|
56 #include <pkgconf/io_flash.h> |
| 1706 | 57 #ifdef CYGPKG_KERNEL |
| 58 #include <cyg/kernel/kapi.h> | |
| 59 #endif | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
60 #include <cyg/hal/hal_arch.h> |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
61 #include <cyg/hal/hal_intr.h> |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
62 #include <cyg/hal/hal_cache.h> |
| 1706 | 63 #include <cyg/hal/hal_tables.h> |
| 64 #include <cyg/infra/cyg_ass.h> | |
|
191
678094f34118
Merge from eCos master repository on 2001-10-19-06:43:02-BST
jlarmour
parents:
177
diff
changeset
|
65 #include <string.h> |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
66 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
67 #define _FLASH_PRIVATE_ |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
68 #include <cyg/io/flash.h> |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
69 |
|
143
6b5f480c6929
Merge from eCos master repository on 2000-12-08-02:09:36-GMT
jlarmour
parents:
141
diff
changeset
|
70 // When this flag is set, do not actually jump to the relocated code. |
| 1706 | 71 // This can be used for running the function in place (RAM startup |
| 72 // only), allowing calls to diag_printf() and similar. | |
|
136
a9ac27ec7abc
Merge from eCos master repository on 2000-11-17-18:24:25-GMT
jlarmour
parents:
121
diff
changeset
|
73 #undef RAM_FLASH_DEV_DEBUG |
|
a9ac27ec7abc
Merge from eCos master repository on 2000-11-17-18:24:25-GMT
jlarmour
parents:
121
diff
changeset
|
74 #if !defined(CYG_HAL_STARTUP_RAM) && defined(RAM_FLASH_DEV_DEBUG) |
|
a9ac27ec7abc
Merge from eCos master repository on 2000-11-17-18:24:25-GMT
jlarmour
parents:
121
diff
changeset
|
75 # warning "Can only enable the flash debugging when configured for RAM startup" |
|
a9ac27ec7abc
Merge from eCos master repository on 2000-11-17-18:24:25-GMT
jlarmour
parents:
121
diff
changeset
|
76 #endif |
| 1706 | 77 #ifndef MIN |
| 78 #define MIN(x,y) ((x)<(y) ? (x) : (y)) | |
| 79 #endif | |
| 1400 | 80 |
| 1706 | 81 // Has the FLASH IO library been initialise? |
| 82 static bool init = false; | |
| 83 // We have a linked list of flash drivers. This is the head of the | |
| 84 // list | |
| 85 static struct cyg_flash_dev *flash_head = NULL; | |
| 86 | |
| 87 // This array contains entries for all flash devices that are | |
| 88 // installed in the system. | |
| 89 __externC struct cyg_flash_dev cyg_flashdevtab[]; | |
| 90 CYG_HAL_TABLE_BEGIN(cyg_flashdevtab, cyg_flashdev); | |
| 91 | |
| 92 // end of the flashdev table | |
| 93 __externC struct cyg_flash_dev cyg_flashdevtab_end; | |
| 94 CYG_HAL_TABLE_END(cyg_flashdevtab_end, cyg_flashdev); | |
| 1400 | 95 |
| 1706 | 96 // Sort the linked list into ascending order of flash address. Use a |
| 97 // primitive ripple sort, but since we don't expect to have many | |
| 98 // devices this should be OK. | |
| 99 static void flash_sort(void) | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
100 { |
| 1706 | 101 bool moved; |
| 102 struct cyg_flash_dev *dev, **previous_next; | |
| 103 | |
| 104 // If there is zero or one device, short cut | |
| 105 if (flash_head == NULL || flash_head->next == NULL) | |
| 106 return; | |
| 107 | |
| 108 do { | |
| 109 moved=false; | |
| 110 for (dev=flash_head, previous_next=&flash_head; | |
| 111 dev->next; | |
| 112 previous_next = &dev->next, dev=dev->next ){ | |
| 113 if (dev->start > dev->next->start) { | |
| 114 *previous_next=dev->next; | |
| 115 dev->next = (*previous_next)->next; | |
| 116 (*previous_next)->next = dev; | |
| 117 moved=true; | |
| 118 break; | |
| 119 } | |
| 120 } | |
| 121 } while (moved); | |
| 122 } | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
123 |
| 1706 | 124 // Walk the linked list and see if there are any overlaps in the |
| 125 // addresses the devices claim to use using. | |
| 126 static bool flash_check_overlap(void) | |
| 127 { | |
| 128 struct cyg_flash_dev *dev; | |
| 129 | |
| 130 // If there is zero or one device, short cut | |
| 131 if (flash_head == NULL || flash_head->next == NULL) | |
| 132 return false; | |
| 133 | |
| 134 for (dev=flash_head; dev->next; dev=dev->next){ | |
| 135 if (dev->end >= dev->next->start) | |
| 136 return true; | |
| 137 } | |
| 138 return false; | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
139 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
140 |
| 1706 | 141 // Initialise all registered device. Any device that fails to |
| 142 // initialise we leave dev->init as false. Then sort the devices into | |
| 143 // ascending order of address and put them into a linked list. Lastly | |
| 144 // check if we have any overlap of the addresses. | |
| 145 __externC int | |
| 146 cyg_flash_init(cyg_flash_printf *pf) | |
|
154
e2d866e32dac
Merge from eCos master repository on 2001-02-26-23:18:05-GMT
jlarmour
parents:
151
diff
changeset
|
147 { |
| 1706 | 148 int err; |
| 149 struct cyg_flash_dev * dev; | |
| 150 | |
| 151 if (init) return CYG_FLASH_ERR_OK; | |
| 152 init = true; | |
| 153 | |
| 154 for (dev = &cyg_flashdevtab[0]; dev != &cyg_flashdevtab_end; dev++) { | |
| 155 dev->pf = pf; | |
| 156 #ifdef CYGPKG_KERNEL | |
| 157 cyg_mutex_init(&dev->mutex); | |
| 158 #endif | |
| 159 | |
| 160 err = dev->funs->flash_init(dev); | |
| 161 if (err != CYG_FLASH_ERR_OK) { | |
| 162 continue; | |
| 163 } | |
| 164 CYG_ASSERT(dev->funs, "No flash functions"); | |
| 165 CYG_ASSERT(dev->num_block_infos, "No number of block infoss"); | |
| 166 CYG_ASSERT(dev->block_info, "No block infos"); | |
| 167 CYG_ASSERT(!(((cyg_flashaddr_t)dev->block_info >= dev->start) && | |
| 168 ((cyg_flashaddr_t)dev->block_info < dev->end)), | |
| 169 "Block info is in the flash"); | |
| 170 CYG_ASSERT(dev->funs->flash_erase_block, "No erase function"); | |
| 171 CYG_ASSERT(dev->funs->flash_program, "No program function"); | |
| 172 CYG_ASSERT(dev->funs->flash_hwr_map_error, "No hwr map error function"); | |
| 173 | |
| 174 dev->init = true; | |
| 175 dev->next = flash_head; | |
| 176 flash_head = dev; | |
| 177 } | |
| 178 | |
| 179 flash_sort(); | |
| 180 | |
| 181 if (flash_check_overlap()) { | |
| 182 return CYG_FLASH_ERR_INVALID; | |
| 183 } | |
| 184 return CYG_FLASH_ERR_OK; | |
|
154
e2d866e32dac
Merge from eCos master repository on 2001-02-26-23:18:05-GMT
jlarmour
parents:
151
diff
changeset
|
185 } |
|
e2d866e32dac
Merge from eCos master repository on 2001-02-26-23:18:05-GMT
jlarmour
parents:
151
diff
changeset
|
186 |
| 1706 | 187 // Is the address within one of the flash drivers? |
| 188 __externC int | |
| 189 cyg_flash_verify_addr(const cyg_flashaddr_t address) | |
|
143
6b5f480c6929
Merge from eCos master repository on 2000-12-08-02:09:36-GMT
jlarmour
parents:
141
diff
changeset
|
190 { |
| 1706 | 191 struct cyg_flash_dev * dev; |
| 192 | |
| 193 if (!init) return CYG_FLASH_ERR_NOT_INIT; | |
| 194 | |
| 195 for (dev = flash_head; dev; dev=dev->next) { | |
| 196 if ((dev->start <= address) && (dev->end > address)) | |
| 197 return CYG_FLASH_ERR_OK; | |
| 198 } | |
| 199 return CYG_FLASH_ERR_INVALID; | |
|
143
6b5f480c6929
Merge from eCos master repository on 2000-12-08-02:09:36-GMT
jlarmour
parents:
141
diff
changeset
|
200 } |
|
6b5f480c6929
Merge from eCos master repository on 2000-12-08-02:09:36-GMT
jlarmour
parents:
141
diff
changeset
|
201 |
| 1706 | 202 // See if a range of FLASH addresses overlaps currently running code |
| 203 __externC bool cyg_flash_code_overlaps(const cyg_flashaddr_t start, | |
| 204 const cyg_flashaddr_t end) | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
205 { |
| 1706 | 206 extern char _stext[], _etext[]; |
| 207 | |
| 208 return ((((unsigned long)&_stext >= (unsigned long)start) && | |
| 209 ((unsigned long)&_stext < (unsigned long)end)) || | |
| 210 (((unsigned long)&_etext >= (unsigned long)start) && | |
| 211 ((unsigned long)&_etext < (unsigned long)end))); | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
212 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
213 |
| 1706 | 214 // Get the start and end address of the first driver |
| 215 __externC int | |
| 216 cyg_flash_get_limits(cyg_flashaddr_t *start, cyg_flashaddr_t *end) | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
217 { |
| 1706 | 218 if (!init) { |
| 219 return CYG_FLASH_ERR_NOT_INIT; | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
220 } |
| 1706 | 221 if (flash_head) { |
| 222 *start = flash_head->start; | |
| 223 *end = flash_head->end; | |
| 224 return CYG_FLASH_ERR_OK; | |
| 225 } | |
| 226 return CYG_FLASH_ERR_INVALID; | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
227 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
228 |
| 1706 | 229 // Get the block size and number of blocks for the first driver. For |
| 230 // devices with boot blocks, consolidate the boot blocks into the | |
| 231 // figure. | |
| 232 __externC int | |
| 233 cyg_flash_get_block_info(size_t *block_size, cyg_uint32 *blocks) | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
234 { |
| 1706 | 235 size_t biggest_size=0; |
| 236 cyg_uint32 i; | |
| 237 | |
| 238 | |
| 239 if (!init) { | |
| 240 return CYG_FLASH_ERR_NOT_INIT; | |
| 241 } | |
| 242 if (!flash_head) return CYG_FLASH_ERR_INVALID; | |
| 243 | |
| 244 // Find the biggest size of blocks | |
| 245 for (i=0; i < flash_head->num_block_infos; i++) { | |
| 246 if (flash_head->block_info[i].block_size > biggest_size) { | |
| 247 biggest_size = flash_head->block_info[i].block_size; | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
248 } |
| 1706 | 249 } |
| 250 | |
| 251 // Calculate the number of biggest size blocks | |
| 252 *block_size = biggest_size; | |
| 253 *blocks = 0; | |
| 254 for (i=0; i < flash_head->num_block_infos; i++) { | |
| 255 *blocks += (flash_head->block_info[i].block_size * | |
| 256 flash_head->block_info[i].blocks) / | |
| 257 biggest_size; | |
| 258 } | |
| 259 return CYG_FLASH_ERR_OK; | |
| 260 } | |
| 261 | |
| 262 // Return information about the Nth driver | |
| 263 __externC int | |
| 264 cyg_flash_get_info(cyg_uint32 Nth, cyg_flash_info_t * info) | |
| 265 { | |
| 266 struct cyg_flash_dev * dev; | |
| 267 | |
| 268 if (!init) return CYG_FLASH_ERR_NOT_INIT; | |
| 269 | |
| 270 for (dev = flash_head; dev && Nth; dev=dev->next, Nth--) | |
| 271 ; | |
| 272 if (dev && !Nth) { | |
| 273 info->start = dev->start; | |
| 274 info->end = dev->end; | |
| 275 info->num_block_infos = dev->num_block_infos; | |
| 276 info->block_info = dev->block_info; | |
| 277 return CYG_FLASH_ERR_OK; | |
| 278 } | |
| 279 return CYG_FLASH_ERR_INVALID; | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
280 } |
|
157
b65ec671dd4c
Merge from eCos master repository on 2001-04-06-18:28:36-BST
jlarmour
parents:
156
diff
changeset
|
281 |
| 1706 | 282 // Return information about the flash at the given address |
| 283 __externC int | |
| 284 cyg_flash_get_info_addr(cyg_flashaddr_t flash_base, cyg_flash_info_t * info) | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
285 { |
| 1706 | 286 struct cyg_flash_dev *dev; |
| 287 | |
| 288 if (!init) return CYG_FLASH_ERR_NOT_INIT; | |
| 289 | |
| 290 for (dev = flash_head; dev ; dev=dev->next) { | |
| 291 if ((dev->start <= flash_base) && ( dev->end > flash_base)) { | |
| 292 info->start = dev->start; | |
| 293 info->end = dev->end; | |
| 294 info->num_block_infos = dev->num_block_infos; | |
| 295 info->block_info = dev->block_info; | |
| 296 return CYG_FLASH_ERR_OK; | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
297 } |
| 1706 | 298 } |
| 299 return CYG_FLASH_ERR_INVALID; | |
| 300 } | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
301 |
| 1706 | 302 #ifdef CYGPKG_KERNEL |
| 303 //Lock the mutex's for a range of addresses | |
| 304 __externC int | |
| 305 cyg_flash_mutex_lock(const cyg_flashaddr_t from, const size_t len) | |
| 306 { | |
| 307 struct cyg_flash_dev * dev; | |
| 308 int err; | |
| 309 | |
| 310 if (!init) return CYG_FLASH_ERR_NOT_INIT; | |
| 311 | |
| 312 for (dev = flash_head; dev ; dev=dev->next) { | |
| 313 if ((dev->start <= from) && ( dev->end > from)) { | |
| 314 cyg_mutex_lock(&dev->mutex); | |
| 315 if (dev->end > from+len) { | |
| 316 return CYG_FLASH_ERR_OK; | |
| 317 } else { // Check off by one? | |
| 318 //The region is bigger than this driver. Recurse | |
| 319 err = cyg_flash_mutex_lock(dev->end+1, (len - (dev->end - from))); | |
| 320 if (err != CYG_FLASH_ERR_OK) { | |
| 321 // Something went wrong, unlock what we just locked | |
| 322 cyg_mutex_unlock(&dev->mutex); | |
| 323 } | |
| 324 return err; | |
| 325 } | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
326 } |
| 1706 | 327 } |
| 328 return CYG_FLASH_ERR_INVALID; | |
| 329 } | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
330 |
| 1706 | 331 //Unlock the mutex's for a range of addresses |
| 332 __externC int | |
| 333 cyg_flash_mutex_unlock(const cyg_flashaddr_t from, const size_t len) | |
| 334 { | |
| 335 struct cyg_flash_dev * dev; | |
| 336 int err; | |
| 337 | |
| 338 if (!init) return CYG_FLASH_ERR_NOT_INIT; | |
| 339 | |
| 340 for (dev = flash_head; dev ; dev=dev->next) { | |
| 341 if ((dev->start <= from) && ( dev->end > from)) { | |
| 342 cyg_mutex_unlock(&dev->mutex); | |
| 343 if (dev->end > from+len) { | |
| 344 return CYG_FLASH_ERR_OK; | |
| 345 } else { // Check off by one? | |
| 346 //The region is bigger than this driver. Recurse | |
| 347 err = cyg_flash_mutex_unlock(dev->end+1, (len - (dev->end - from))); | |
| 348 return err; | |
| 349 } | |
| 350 } | |
| 351 } | |
| 352 return CYG_FLASH_ERR_INVALID; | |
| 353 } | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
354 #endif |
|
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
355 |
| 1706 | 356 // Return the size of the block which is at the given address |
| 357 static size_t | |
| 358 flash_block_size(struct cyg_flash_dev *dev, const cyg_flashaddr_t addr) | |
| 359 { | |
| 360 int i; | |
| 361 size_t offset; | |
| 362 | |
| 363 | |
| 364 CYG_ASSERT((addr >= dev->start) && (addr <= dev->end), "Not inside device"); | |
| 365 | |
| 366 offset = addr - dev->start; | |
| 367 for (i=0; i < dev->num_block_infos; i++) { | |
| 368 if (offset < (dev->block_info[i].blocks * dev->block_info[i].block_size)) | |
| 369 return dev->block_info[i].block_size; | |
| 370 offset = offset - | |
| 371 (dev->block_info[i].blocks * dev->block_info[i].block_size); | |
| 372 } | |
| 373 CYG_FAIL("Programming error"); | |
| 374 return 0; | |
| 375 } | |
| 376 | |
| 377 // Return the size of the block which is at the given address | |
| 378 __externC size_t | |
| 379 cyg_flash_block_size(const cyg_flashaddr_t flash_base) | |
| 380 { | |
| 381 struct cyg_flash_dev * dev; | |
| 382 | |
| 383 if (!init) return CYG_FLASH_ERR_NOT_INIT; | |
| 384 | |
| 385 for (dev = flash_head; | |
| 386 dev && !((dev->start <= flash_base) && ( dev->end > flash_base)); | |
| 387 dev=dev->next) | |
| 388 ; | |
| 389 if (!dev) return CYG_FLASH_ERR_INVALID; | |
| 390 | |
| 391 return flash_block_size(dev, flash_base); | |
| 392 } | |
| 393 | |
|
208
e0c0827131d1
Merge from eCos master repository on 2002-05-20-20:11:54-BST
jlarmour
parents:
195
diff
changeset
|
394 |
| 1706 | 395 __externC int |
| 396 cyg_flash_erase(const cyg_flashaddr_t flash_base, | |
| 397 const size_t len, | |
| 398 cyg_flashaddr_t *err_address) | |
| 399 { | |
| 400 cyg_flashaddr_t block, end_addr, addr; | |
| 401 struct cyg_flash_dev * dev; | |
| 402 size_t block_size; | |
| 403 int stat = CYG_FLASH_ERR_OK; | |
| 404 int d_cache, i_cache; | |
| 405 | |
| 406 if (!init) return CYG_FLASH_ERR_NOT_INIT; | |
| 407 | |
| 408 #ifdef CYGSEM_IO_FLASH_SOFT_WRITE_PROTECT | |
| 409 if (plf_flash_query_soft_wp(addr,len)) | |
| 410 return CYG_FLASH_ERR_PROTECT; | |
| 411 #endif | |
| 412 | |
| 413 for (dev = flash_head; | |
| 414 dev && !((dev->start <= flash_base) && ( dev->end > flash_base)); | |
| 415 dev=dev->next) | |
| 416 ; | |
| 417 if (!dev) return CYG_FLASH_ERR_INVALID; | |
| 418 | |
| 419 #ifdef CYGPKG_KERNEL | |
| 420 cyg_mutex_lock(&dev->mutex); | |
| 421 #endif | |
| 422 addr = flash_base; | |
| 423 end_addr = flash_base + len - 1; | |
| 424 if (end_addr > dev->end) { | |
| 425 end_addr = dev->end; | |
| 426 } | |
| 427 | |
| 428 block_size = flash_block_size(dev, addr); | |
| 429 block = (cyg_flashaddr_t)((size_t)addr & ~(block_size - 1)); | |
| 430 | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
431 #ifdef CYGSEM_IO_FLASH_CHATTER |
| 1706 | 432 dev->pf("... Erase from %p-%p: ", (void*)block, (void*)end_addr); |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
433 #endif |
| 1706 | 434 |
| 435 HAL_FLASH_CACHES_OFF(d_cache, i_cache); | |
| 436 FLASH_Enable(block, end_addr); | |
| 437 while (block <= end_addr) { | |
| 438 int i; | |
| 439 unsigned char *dp; | |
| 440 bool erased = true; | |
| 441 | |
| 442 // If there is a read function it probably means the flash | |
| 443 // cannot be read directly. | |
| 444 if (!dev->funs->flash_read) { | |
| 445 dp = (unsigned char *)block; | |
| 446 for (i = 0; i < block_size; i++) { | |
| 447 if (*dp++ != (unsigned char)0xFF) { | |
| 448 erased = false; | |
| 449 break; | |
| 450 } | |
| 451 } | |
| 452 } else { | |
| 453 erased=false; | |
| 454 } | |
| 455 if (!erased) { | |
| 456 stat = dev->funs->flash_erase_block(dev,block); | |
| 457 stat = dev->funs->flash_hwr_map_error(dev,stat); | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
458 } |
| 1706 | 459 if (CYG_FLASH_ERR_OK != stat && err_address) { |
| 460 *err_address = block; | |
| 461 break; | |
| 462 } | |
| 463 block += flash_block_size(dev, block); | |
| 464 #ifdef CYGSEM_IO_FLASH_CHATTER | |
| 465 dev->pf("."); | |
| 466 #endif | |
| 467 } | |
| 468 FLASH_Disable(block, end_addr); | |
| 469 HAL_FLASH_CACHES_ON(d_cache, i_cache); | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
470 #ifdef CYGSEM_IO_FLASH_CHATTER |
| 1706 | 471 dev->pf("\n"); |
| 472 #endif | |
| 473 #ifdef CYGPKG_KERNEL | |
| 474 cyg_mutex_unlock(&dev->mutex); | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
475 #endif |
| 1706 | 476 if (stat != CYG_FLASH_ERR_OK) { |
| 477 return stat; | |
| 478 } | |
| 479 | |
| 480 if (flash_base + len - 1 > dev->end) { | |
| 481 // The region to erase if bigger than this driver handles. Recurse | |
| 482 return cyg_flash_erase(dev->end+1, | |
| 483 len - (dev->end - flash_base) - 1, | |
| 484 err_address); | |
| 485 } | |
| 486 return CYG_FLASH_ERR_OK; | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
487 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
488 |
| 1706 | 489 __externC int |
| 490 cyg_flash_program(const cyg_flashaddr_t flash_base, | |
| 491 void *ram_base, | |
| 492 const size_t len, | |
| 493 cyg_flashaddr_t *err_address) | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
494 { |
| 1706 | 495 struct cyg_flash_dev * dev; |
| 496 cyg_flashaddr_t addr, end_addr; | |
| 497 unsigned char * ram = ram_base; | |
| 498 size_t block_size, size, length, offset; | |
| 499 int stat = CYG_FLASH_ERR_OK; | |
| 500 int d_cache, i_cache; | |
| 501 | |
| 502 if (!init) return CYG_FLASH_ERR_NOT_INIT; | |
| 503 | |
|
174
38892b97b685
Merge from eCos master repository on 2001-07-28-00:17:32-BST
jlarmour
parents:
163
diff
changeset
|
504 #ifdef CYGSEM_IO_FLASH_SOFT_WRITE_PROTECT |
| 1706 | 505 if (plf_flash_query_soft_wp(addr,len)) |
| 506 return CYG_FLASH_ERR_PROTECT; | |
|
174
38892b97b685
Merge from eCos master repository on 2001-07-28-00:17:32-BST
jlarmour
parents:
163
diff
changeset
|
507 #endif |
| 1706 | 508 |
| 509 for (dev = flash_head; | |
| 510 dev && !((dev->start <= flash_base) && ( dev->end > flash_base)); | |
| 511 dev=dev->next) | |
| 512 ; | |
| 513 if (!dev) return CYG_FLASH_ERR_INVALID; | |
| 514 | |
| 515 #ifdef CYGPKG_KERNEL | |
| 516 cyg_mutex_lock(&dev->mutex); | |
| 517 #endif | |
| 518 addr = flash_base; | |
| 519 end_addr = flash_base + len - 1; | |
| 520 if (end_addr > dev->end) { | |
| 521 end_addr = dev->end; | |
| 522 } | |
| 523 length = end_addr - addr + 1; | |
| 524 | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
525 #ifdef CYGSEM_IO_FLASH_CHATTER |
| 1706 | 526 dev->pf("... Program from %p-%p to %p: ", ram_base, |
| 527 ((CYG_ADDRESS)ram_base)+length, addr); | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
528 #endif |
| 1706 | 529 |
| 530 HAL_FLASH_CACHES_OFF(d_cache, i_cache); | |
| 531 FLASH_Enable((unsigned short*)addr, (unsigned short *)(addr+len)); | |
| 532 while (addr <= end_addr) { | |
| 533 block_size = flash_block_size(dev, addr); | |
| 534 size = length; | |
| 535 // Only one block at once | |
| 536 if (size > block_size) size = block_size; | |
| 537 | |
| 538 // Writing from the middle of a block? | |
| 539 offset = (size_t)addr & (block_size-1); | |
| 540 if (offset) | |
| 541 size = MIN(block_size - offset, size); | |
| 542 stat = dev->funs->flash_program(dev, addr, ram, size); | |
| 543 stat = dev->funs->flash_hwr_map_error(dev,stat); | |
|
157
b65ec671dd4c
Merge from eCos master repository on 2001-04-06-18:28:36-BST
jlarmour
parents:
156
diff
changeset
|
544 #ifdef CYGSEM_IO_FLASH_VERIFY_PROGRAM |
| 1706 | 545 if (CYG_FLASH_ERR_OK == stat) // Claims to be OK |
| 546 if (!dev->funs->flash_read && memcmp((void *)addr, ram, size) != 0) { | |
| 547 stat = CYG_FLASH_ERR_DRV_VERIFY; | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
548 #ifdef CYGSEM_IO_FLASH_CHATTER |
| 1706 | 549 dev->pf("V"); |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
550 #endif |
| 1706 | 551 } |
|
157
b65ec671dd4c
Merge from eCos master repository on 2001-04-06-18:28:36-BST
jlarmour
parents:
156
diff
changeset
|
552 #endif |
| 1706 | 553 if (CYG_FLASH_ERR_OK != stat && err_address) { |
| 554 *err_address = addr; | |
| 555 break; | |
| 556 } | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
557 #ifdef CYGSEM_IO_FLASH_CHATTER |
| 1706 | 558 dev->pf("."); |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
559 #endif |
| 1706 | 560 length -= size; |
| 561 addr += size; | |
| 562 ram += size; | |
| 563 } | |
| 564 FLASH_Disable((unsigned short*)addr, (unsigned short *)(addr+len)); | |
| 565 HAL_FLASH_CACHES_ON(d_cache, i_cache); | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
566 #ifdef CYGSEM_IO_FLASH_CHATTER |
| 1706 | 567 dev->pf("\n"); |
| 568 #endif | |
| 569 #ifdef CYGPKG_KERNEL | |
| 570 cyg_mutex_unlock(&dev->mutex); | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
571 #endif |
| 1706 | 572 if (stat != CYG_FLASH_ERR_OK) { |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
573 return (stat); |
| 1706 | 574 } |
| 575 if ( flash_base + len - 1 > dev->end) { | |
| 576 return cyg_flash_program(dev->end+1, ram, | |
| 577 len - (dev->end - flash_base) - 1, | |
| 578 err_address); | |
| 579 } | |
| 580 return CYG_FLASH_ERR_OK; | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
581 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
582 |
| 1706 | 583 __externC int |
| 584 cyg_flash_read(cyg_flashaddr_t flash_base, | |
| 585 const void *ram_base, | |
| 586 const size_t len, | |
| 587 cyg_flashaddr_t *err_address) | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
588 { |
| 1706 | 589 struct cyg_flash_dev * dev; |
| 590 cyg_flashaddr_t addr, end_addr; | |
| 591 unsigned char * ram = (unsigned char *)ram_base; | |
| 592 size_t block_size, size, length, offset; | |
| 593 int stat = CYG_FLASH_ERR_OK; | |
| 594 int d_cache, i_cache; | |
| 595 | |
| 596 if (!init) return CYG_FLASH_ERR_NOT_INIT; | |
| 597 | |
| 598 for (dev = flash_head; | |
| 599 dev && !((dev->start <= flash_base) && ( dev->end > flash_base)); | |
| 600 dev=dev->next) | |
| 601 ; | |
| 602 if (!dev) return CYG_FLASH_ERR_INVALID; | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
603 |
| 1706 | 604 #ifdef CYGPKG_KERNEL |
| 605 cyg_mutex_lock(&dev->mutex); | |
| 606 #endif | |
| 607 addr = flash_base; | |
| 608 end_addr = flash_base + len - 1; | |
| 609 if (end_addr > dev->end) { | |
| 610 end_addr = dev->end; | |
| 611 } | |
| 612 length = end_addr - addr + 1; | |
| 613 | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
614 #ifdef CYGSEM_IO_FLASH_CHATTER |
| 1706 | 615 dev->pf("... Read from %p-%p to %p: ", addr, addr+len, ram_base); |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
616 #endif |
| 1706 | 617 |
| 618 HAL_FLASH_CACHES_OFF(d_cache, i_cache); | |
| 619 FLASH_Enable((unsigned short*)addr, (unsigned short *)(addr+len)); | |
| 620 while (addr <= end_addr) { | |
| 621 block_size = flash_block_size(dev, addr); | |
| 622 size = length; | |
| 623 // Only one block at once | |
| 624 if (size > block_size) size = block_size; | |
| 625 | |
| 626 // Reading from the middle of a block? | |
| 627 offset = (size_t)addr & (block_size-1); | |
| 628 if (offset) | |
| 629 size = MIN(block_size - offset, size); | |
| 630 if (dev->funs->flash_read) { | |
| 631 stat = dev->funs->flash_read(dev, addr, ram, size); | |
| 632 stat = dev->funs->flash_hwr_map_error(dev,stat); | |
| 633 } else { | |
| 634 memcpy(ram, (void *)addr, size); | |
| 635 stat = CYG_FLASH_ERR_OK; | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
636 } |
| 1706 | 637 if (CYG_FLASH_ERR_OK != stat && err_address) { |
| 638 *err_address = addr; | |
| 639 break; | |
| 640 } | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
641 #ifdef CYGSEM_IO_FLASH_CHATTER |
| 1706 | 642 dev->pf("."); |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
643 #endif |
| 1706 | 644 length -= size; |
| 645 addr += size; | |
| 646 ram += size; | |
| 647 } | |
| 648 FLASH_Disable((unsigned short*)addr, (unsigned short *)(addr+len)); | |
| 649 HAL_FLASH_CACHES_ON(d_cache, i_cache); | |
| 650 #ifdef CYGSEM_IO_FLASH_CHATTER | |
| 651 dev->pf("\n"); | |
| 652 #endif | |
| 653 #ifdef CYGPKG_KERNEL | |
| 654 cyg_mutex_unlock(&dev->mutex); | |
| 655 #endif | |
| 656 if (stat != CYG_FLASH_ERR_OK) { | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
657 return (stat); |
| 1706 | 658 } |
| 659 if ( flash_base + len - 1 > dev->end) { | |
| 660 return cyg_flash_read(dev->end+1, ram, | |
| 661 len - (dev->end - flash_base) - 1, | |
| 662 err_address); | |
| 663 } | |
| 664 return CYG_FLASH_ERR_OK; | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
665 } |
|
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
666 |
|
177
4c750ce71ae3
Merge from eCos master repository on 2001-08-10-19:22:57-BST
jlarmour
parents:
174
diff
changeset
|
667 #ifdef CYGHWR_IO_FLASH_BLOCK_LOCKING |
| 1706 | 668 __externC int |
| 669 cyg_flash_lock(const cyg_flashaddr_t flash_base, | |
| 670 const size_t len, | |
| 671 cyg_flashaddr_t *err_address) | |
|
119
77cec8369160
Merge from eCos master repository on 2000-09-01-07:47:03-BST
jlarmour
parents:
117
diff
changeset
|
672 { |
| 1706 | 673 cyg_flashaddr_t block, end_addr, addr; |
| 674 struct cyg_flash_dev * dev; | |
| 675 size_t block_size; | |
| 676 int stat = CYG_FLASH_ERR_OK; | |
| 677 int d_cache, i_cache; | |
| 678 | |
| 679 if (!init) return CYG_FLASH_ERR_NOT_INIT; | |
| 680 | |
|
174
38892b97b685
Merge from eCos master repository on 2001-07-28-00:17:32-BST
jlarmour
parents:
163
diff
changeset
|
681 #ifdef CYGSEM_IO_FLASH_SOFT_WRITE_PROTECT |
| 1706 | 682 if (plf_flash_query_soft_wp(addr,len)) |
| 683 return CYG_FLASH_ERR_PROTECT; | |
|
174
38892b97b685
Merge from eCos master repository on 2001-07-28-00:17:32-BST
jlarmour
parents:
163
diff
changeset
|
684 #endif |
| 1706 | 685 |
| 686 for (dev = flash_head; | |
| 687 dev && !((dev->start <= flash_base) && ( dev->end > flash_base)); | |
| 688 dev=dev->next) | |
| 689 ; | |
| 690 if (!dev) return CYG_FLASH_ERR_INVALID; | |
| 691 if (!dev->funs->flash_block_lock) return CYG_FLASH_ERR_INVALID; | |
|
119
77cec8369160
Merge from eCos master repository on 2000-09-01-07:47:03-BST
jlarmour
parents:
117
diff
changeset
|
692 |
| 1706 | 693 #ifdef CYGPKG_KERNEL |
| 694 cyg_mutex_lock(&dev->mutex); | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
695 #endif |
| 1706 | 696 addr = flash_base; |
| 697 end_addr = flash_base + len - 1; | |
| 698 if (end_addr > dev->end) { | |
| 699 end_addr = dev->end; | |
| 700 } | |
| 701 | |
| 702 block_size = flash_block_size(dev, addr); | |
| 703 block = (cyg_flashaddr_t)((size_t)addr & ~(block_size - 1)); | |
| 704 | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
705 #ifdef CYGSEM_IO_FLASH_CHATTER |
| 1706 | 706 dev->pf("... Locking from %p-%p: ", (void*)block, (void*)end_addr); |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
707 #endif |
| 1706 | 708 |
| 709 HAL_FLASH_CACHES_OFF(d_cache, i_cache); | |
| 710 FLASH_Enable(block, end_addr); | |
| 711 while (block <= end_addr) { | |
| 712 stat = dev->funs->flash_block_lock(dev,block); | |
| 713 stat = dev->funs->flash_hwr_map_error(dev,stat); | |
| 714 | |
| 715 if (CYG_FLASH_ERR_OK != stat && err_address) { | |
| 716 *err_address = (void *)block; | |
| 717 break; | |
|
119
77cec8369160
Merge from eCos master repository on 2000-09-01-07:47:03-BST
jlarmour
parents:
117
diff
changeset
|
718 } |
| 1706 | 719 block += flash_block_size(dev, addr); |
| 720 #ifdef CYGSEM_IO_FLASH_CHATTER | |
| 721 dev->pf("."); | |
| 722 #endif | |
| 723 } | |
| 724 FLASH_Disable(block, end_addr); | |
| 725 HAL_FLASH_CACHES_ON(d_cache, i_cache); | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
726 #ifdef CYGSEM_IO_FLASH_CHATTER |
| 1706 | 727 dev->pf("\n"); |
| 728 #endif | |
| 729 #ifdef CYGPKG_KERNEL | |
| 730 cyg_mutex_unlock(&dev->mutex); | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
731 #endif |
| 1706 | 732 if (stat != CYG_FLASH_ERR_OK) { |
| 733 return stat; | |
| 734 } | |
| 735 | |
| 736 if (flash_base + len - 1 > dev->end) { // Off by one? | |
| 737 // The region to erase if bigger than this driver handles. Recurse | |
| 738 return cyg_flash_lock(dev->end+1, | |
| 739 len - (dev->end - flash_base) - 1, | |
| 740 err_address); | |
| 741 } | |
| 742 return CYG_FLASH_ERR_OK; | |
|
119
77cec8369160
Merge from eCos master repository on 2000-09-01-07:47:03-BST
jlarmour
parents:
117
diff
changeset
|
743 } |
|
77cec8369160
Merge from eCos master repository on 2000-09-01-07:47:03-BST
jlarmour
parents:
117
diff
changeset
|
744 |
| 1706 | 745 __externC int |
| 746 cyg_flash_unlock(const cyg_flashaddr_t flash_base, | |
| 747 const size_t len, | |
| 748 cyg_flashaddr_t *err_address) | |
|
119
77cec8369160
Merge from eCos master repository on 2000-09-01-07:47:03-BST
jlarmour
parents:
117
diff
changeset
|
749 { |
| 1706 | 750 cyg_flashaddr_t block, end_addr, addr; |
| 751 struct cyg_flash_dev * dev; | |
| 752 size_t block_size; | |
| 753 int stat = CYG_FLASH_ERR_OK; | |
| 754 int d_cache, i_cache; | |
| 755 | |
| 756 if (!init) return CYG_FLASH_ERR_NOT_INIT; | |
| 757 | |
|
174
38892b97b685
Merge from eCos master repository on 2001-07-28-00:17:32-BST
jlarmour
parents:
163
diff
changeset
|
758 #ifdef CYGSEM_IO_FLASH_SOFT_WRITE_PROTECT |
| 1706 | 759 if (plf_flash_query_soft_wp(addr,len)) |
| 760 return CYG_FLASH_ERR_PROTECT; | |
|
174
38892b97b685
Merge from eCos master repository on 2001-07-28-00:17:32-BST
jlarmour
parents:
163
diff
changeset
|
761 #endif |
| 1706 | 762 |
| 763 for (dev = flash_head; | |
| 764 dev && !((dev->start <= flash_base) && ( dev->end > flash_base)); | |
| 765 dev=dev->next) | |
| 766 ; | |
| 767 if (!dev) return CYG_FLASH_ERR_INVALID; | |
| 768 if (!dev->funs->flash_block_lock) return CYG_FLASH_ERR_INVALID; | |
| 769 | |
| 770 #ifdef CYGPKG_KERNEL | |
| 771 cyg_mutex_lock(&dev->mutex); | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
772 #endif |
| 1706 | 773 addr = flash_base; |
| 774 end_addr = flash_base + len - 1; | |
| 775 if (end_addr > dev->end) { | |
| 776 end_addr = dev->end; | |
| 777 } | |
| 778 | |
| 779 block_size = flash_block_size(dev, addr); | |
| 780 block = (cyg_flashaddr_t)((size_t)addr & ~(block_size - 1)); | |
| 781 | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
782 #ifdef CYGSEM_IO_FLASH_CHATTER |
| 1706 | 783 dev->pf("... Unlocking from %p-%p: ", (void*)block, (void*)end_addr); |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
784 #endif |
| 1706 | 785 |
| 786 HAL_FLASH_CACHES_OFF(d_cache, i_cache); | |
| 787 FLASH_Enable(block, end_addr); | |
| 788 while (block <= end_addr) { | |
| 789 stat = dev->funs->flash_block_unlock(dev,block); | |
| 790 stat = dev->funs->flash_hwr_map_error(dev,stat); | |
| 791 | |
| 792 if (CYG_FLASH_ERR_OK != stat && err_address) { | |
| 793 *err_address = (void *)block; | |
| 794 break; | |
|
119
77cec8369160
Merge from eCos master repository on 2000-09-01-07:47:03-BST
jlarmour
parents:
117
diff
changeset
|
795 } |
| 1706 | 796 block += flash_block_size(dev, addr); |
| 797 #ifdef CYGSEM_IO_FLASH_CHATTER | |
| 798 dev->pf("."); | |
| 799 #endif | |
| 800 } | |
| 801 FLASH_Disable(block, end_addr); | |
| 802 HAL_FLASH_CACHES_ON(d_cache, i_cache); | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
803 #ifdef CYGSEM_IO_FLASH_CHATTER |
| 1706 | 804 dev->pf("\n"); |
| 805 #endif | |
| 806 #ifdef CYGPKG_KERNEL | |
| 807 cyg_mutex_unlock(&dev->mutex); | |
|
1223
dbcfe4e0dbd2
New platform - TAMS MOAB - and generic changes to support it
gthomas
parents:
210
diff
changeset
|
808 #endif |
| 1706 | 809 if (stat != CYG_FLASH_ERR_OK) { |
| 810 return stat; | |
| 811 } | |
| 812 | |
| 813 if (flash_base + len - 1 > dev->end) { // Off by one? | |
| 814 // The region to erase if bigger than this driver handles. Recurse | |
| 815 return cyg_flash_lock(dev->end+1, | |
| 816 len - (dev->end - flash_base) - 1, | |
| 817 err_address); | |
| 818 } | |
| 819 return CYG_FLASH_ERR_OK; | |
|
119
77cec8369160
Merge from eCos master repository on 2000-09-01-07:47:03-BST
jlarmour
parents:
117
diff
changeset
|
820 } |
|
77cec8369160
Merge from eCos master repository on 2000-09-01-07:47:03-BST
jlarmour
parents:
117
diff
changeset
|
821 #endif |
|
77cec8369160
Merge from eCos master repository on 2000-09-01-07:47:03-BST
jlarmour
parents:
117
diff
changeset
|
822 |
| 1706 | 823 const char * |
| 824 cyg_flash_errmsg(const int err) | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
825 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
826 switch (err) { |
| 1706 | 827 case CYG_FLASH_ERR_OK: |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
828 return "No error - operation complete"; |
| 1706 | 829 case CYG_FLASH_ERR_ERASE_SUSPEND: |
|
136
a9ac27ec7abc
Merge from eCos master repository on 2000-11-17-18:24:25-GMT
jlarmour
parents:
121
diff
changeset
|
830 return "Device is in erase suspend state"; |
| 1706 | 831 case CYG_FLASH_ERR_PROGRAM_SUSPEND: |
|
136
a9ac27ec7abc
Merge from eCos master repository on 2000-11-17-18:24:25-GMT
jlarmour
parents:
121
diff
changeset
|
832 return "Device is in program suspend state"; |
| 1706 | 833 case CYG_FLASH_ERR_INVALID: |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
834 return "Invalid FLASH address"; |
| 1706 | 835 case CYG_FLASH_ERR_ERASE: |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
836 return "Error trying to erase"; |
| 1706 | 837 case CYG_FLASH_ERR_LOCK: |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
838 return "Error trying to lock/unlock"; |
| 1706 | 839 case CYG_FLASH_ERR_PROGRAM: |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
840 return "Error trying to program"; |
| 1706 | 841 case CYG_FLASH_ERR_PROTOCOL: |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
842 return "Generic error"; |
| 1706 | 843 case CYG_FLASH_ERR_PROTECT: |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
844 return "Device/region is write-protected"; |
| 1706 | 845 case CYG_FLASH_ERR_NOT_INIT: |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
846 return "FLASH sub-system not initialized"; |
| 1706 | 847 case CYG_FLASH_ERR_DRV_VERIFY: |
|
143
6b5f480c6929
Merge from eCos master repository on 2000-12-08-02:09:36-GMT
jlarmour
parents:
141
diff
changeset
|
848 return "Data verify failed after operation"; |
| 1706 | 849 case CYG_FLASH_ERR_DRV_TIMEOUT: |
|
154
e2d866e32dac
Merge from eCos master repository on 2001-02-26-23:18:05-GMT
jlarmour
parents:
151
diff
changeset
|
850 return "Driver timed out waiting for device"; |
| 1706 | 851 case CYG_FLASH_ERR_DRV_WRONG_PART: |
|
154
e2d866e32dac
Merge from eCos master repository on 2001-02-26-23:18:05-GMT
jlarmour
parents:
151
diff
changeset
|
852 return "Driver does not support device"; |
| 1706 | 853 case CYG_FLASH_ERR_LOW_VOLTAGE: |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
154
diff
changeset
|
854 return "Device reports low voltage"; |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
855 default: |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
856 return "Unknown error"; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
857 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
diff
changeset
|
858 } |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
143
diff
changeset
|
859 |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
143
diff
changeset
|
860 // EOF io/flash/..../flash.c |