]>
Commit | Line | Data |
---|---|---|
dcbfd2e5 PP |
1 | /* Driver for ATMEL DataFlash support |
2 | * Author : Hamid Ikdoumi (Atmel) | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or | |
5 | * modify it under the terms of the GNU General Public License as | |
6 | * published by the Free Software Foundation; either version 2 of | |
7 | * the License, or (at your option) any later version. | |
8 | * | |
9 | * This program is distributed in the hope that it will be useful, | |
10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
12 | * GNU General Public License for more details. | |
13 | * | |
14 | * You should have received a copy of the GNU General Public License | |
15 | * along with this program; if not, write to the Free Software | |
16 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, | |
17 | * MA 02111-1307 USA | |
18 | * | |
19 | */ | |
20 | ||
21 | #include <config.h> | |
22 | #include <common.h> | |
dcbfd2e5 PP |
23 | #include <dataflash.h> |
24 | ||
e54b9701 PP |
25 | /* |
26 | * spi.c API | |
27 | */ | |
6e4bf9b2 PP |
28 | extern unsigned int AT91F_SpiWrite(AT91PS_DataflashDesc pDesc); |
29 | extern void AT91F_SpiEnable(int cs); | |
dcbfd2e5 PP |
30 | |
31 | #define AT91C_TIMEOUT_WRDY 200000 | |
32 | ||
dcbfd2e5 PP |
33 | /*----------------------------------------------------------------------*/ |
34 | /* \fn AT91F_DataFlashSendCommand */ | |
35 | /* \brief Generic function to send a command to the dataflash */ | |
f01dbb54 | 36 | /*----------------------------------------------------------------------*/ |
6e4bf9b2 PP |
37 | AT91S_DataFlashStatus AT91F_DataFlashSendCommand(AT91PS_DataFlash pDataFlash, |
38 | unsigned char OpCode, | |
39 | unsigned int CmdSize, | |
40 | unsigned int DataflashAddress) | |
dcbfd2e5 PP |
41 | { |
42 | unsigned int adr; | |
43 | ||
6e4bf9b2 | 44 | if ((pDataFlash->pDataFlashDesc->state) != IDLE) |
dcbfd2e5 PP |
45 | return DATAFLASH_BUSY; |
46 | ||
47 | /* process the address to obtain page address and byte address */ | |
f01dbb54 | 48 | adr = ((DataflashAddress / (pDataFlash->pDevice->pages_size)) << |
de74b9ee | 49 | pDataFlash->pDevice->page_offset) + |
bd86220f | 50 | (DataflashAddress % (pDataFlash->pDevice->pages_size)); |
dcbfd2e5 | 51 | |
bd86220f | 52 | /* fill the command buffer */ |
dcbfd2e5 PP |
53 | pDataFlash->pDataFlashDesc->command[0] = OpCode; |
54 | if (pDataFlash->pDevice->pages_number >= 16384) { | |
f01dbb54 | 55 | pDataFlash->pDataFlashDesc->command[1] = |
bd86220f | 56 | (unsigned char)((adr & 0x0F000000) >> 24); |
f01dbb54 | 57 | pDataFlash->pDataFlashDesc->command[2] = |
bd86220f | 58 | (unsigned char)((adr & 0x00FF0000) >> 16); |
f01dbb54 | 59 | pDataFlash->pDataFlashDesc->command[3] = |
bd86220f | 60 | (unsigned char)((adr & 0x0000FF00) >> 8); |
f01dbb54 | 61 | pDataFlash->pDataFlashDesc->command[4] = |
bd86220f | 62 | (unsigned char)(adr & 0x000000FF); |
dcbfd2e5 | 63 | } else { |
f01dbb54 | 64 | pDataFlash->pDataFlashDesc->command[1] = |
bd86220f | 65 | (unsigned char)((adr & 0x00FF0000) >> 16); |
f01dbb54 | 66 | pDataFlash->pDataFlashDesc->command[2] = |
bd86220f | 67 | (unsigned char)((adr & 0x0000FF00) >> 8); |
f01dbb54 | 68 | pDataFlash->pDataFlashDesc->command[3] = |
bd86220f | 69 | (unsigned char)(adr & 0x000000FF); |
dcbfd2e5 PP |
70 | pDataFlash->pDataFlashDesc->command[4] = 0; |
71 | } | |
72 | pDataFlash->pDataFlashDesc->command[5] = 0; | |
73 | pDataFlash->pDataFlashDesc->command[6] = 0; | |
74 | pDataFlash->pDataFlashDesc->command[7] = 0; | |
75 | ||
76 | /* Initialize the SpiData structure for the spi write fuction */ | |
6e4bf9b2 | 77 | pDataFlash->pDataFlashDesc->tx_cmd_pt = |
bd86220f | 78 | pDataFlash->pDataFlashDesc->command; |
6e4bf9b2 PP |
79 | pDataFlash->pDataFlashDesc->tx_cmd_size = CmdSize; |
80 | pDataFlash->pDataFlashDesc->rx_cmd_pt = | |
bd86220f | 81 | pDataFlash->pDataFlashDesc->command; |
6e4bf9b2 | 82 | pDataFlash->pDataFlashDesc->rx_cmd_size = CmdSize; |
dcbfd2e5 PP |
83 | |
84 | /* send the command and read the data */ | |
6e4bf9b2 PP |
85 | return AT91F_SpiWrite(pDataFlash->pDataFlashDesc); |
86 | } | |
dcbfd2e5 PP |
87 | |
88 | /*----------------------------------------------------------------------*/ | |
89 | /* \fn AT91F_DataFlashGetStatus */ | |
90 | /* \brief Read the status register of the dataflash */ | |
f01dbb54 WD |
91 | /*----------------------------------------------------------------------*/ |
92 | AT91S_DataFlashStatus AT91F_DataFlashGetStatus(AT91PS_DataflashDesc pDesc) | |
dcbfd2e5 PP |
93 | { |
94 | AT91S_DataFlashStatus status; | |
95 | ||
96 | /* if a transfert is in progress ==> return 0 */ | |
6e4bf9b2 | 97 | if ((pDesc->state) != IDLE) |
dcbfd2e5 PP |
98 | return DATAFLASH_BUSY; |
99 | ||
100 | /* first send the read status command (D7H) */ | |
101 | pDesc->command[0] = DB_STATUS; | |
102 | pDesc->command[1] = 0; | |
103 | ||
6e4bf9b2 PP |
104 | pDesc->DataFlash_state = GET_STATUS; |
105 | pDesc->tx_data_size = 0; /* Transmit the command */ | |
106 | /* and receive response */ | |
107 | pDesc->tx_cmd_pt = pDesc->command; | |
108 | pDesc->rx_cmd_pt = pDesc->command; | |
109 | pDesc->rx_cmd_size = 2; | |
110 | pDesc->tx_cmd_size = 2; | |
111 | status = AT91F_SpiWrite(pDesc); | |
dcbfd2e5 | 112 | |
6e4bf9b2 | 113 | pDesc->DataFlash_state = *((unsigned char *)(pDesc->rx_cmd_pt) + 1); |
dcbfd2e5 PP |
114 | |
115 | return status; | |
116 | } | |
117 | ||
dcbfd2e5 PP |
118 | /*----------------------------------------------------------------------*/ |
119 | /* \fn AT91F_DataFlashWaitReady */ | |
120 | /* \brief wait for dataflash ready (bit7 of the status register == 1) */ | |
f01dbb54 WD |
121 | /*----------------------------------------------------------------------*/ |
122 | AT91S_DataFlashStatus AT91F_DataFlashWaitReady(AT91PS_DataflashDesc | |
bd86220f PP |
123 | pDataFlashDesc, |
124 | unsigned int timeout) | |
dcbfd2e5 PP |
125 | { |
126 | pDataFlashDesc->DataFlash_state = IDLE; | |
127 | ||
128 | do { | |
129 | AT91F_DataFlashGetStatus(pDataFlashDesc); | |
130 | timeout--; | |
6e4bf9b2 PP |
131 | } while (((pDataFlashDesc->DataFlash_state & 0x80) != 0x80) && |
132 | (timeout > 0)); | |
dcbfd2e5 | 133 | |
6e4bf9b2 | 134 | if ((pDataFlashDesc->DataFlash_state & 0x80) != 0x80) |
dcbfd2e5 PP |
135 | return DATAFLASH_ERROR; |
136 | ||
137 | return DATAFLASH_OK; | |
138 | } | |
139 | ||
dcbfd2e5 | 140 | /*--------------------------------------------------------------------------*/ |
53677ef1 WD |
141 | /* Function Name : AT91F_DataFlashContinuousRead */ |
142 | /* Object : Continuous stream Read */ | |
dcbfd2e5 PP |
143 | /* Input Parameters : DataFlash Service */ |
144 | /* : <src> = dataflash address */ | |
145 | /* : <*dataBuffer> = data buffer pointer */ | |
146 | /* : <sizeToRead> = data buffer size */ | |
147 | /* Return value : State of the dataflash */ | |
f01dbb54 | 148 | /*--------------------------------------------------------------------------*/ |
bd86220f PP |
149 | AT91S_DataFlashStatus AT91F_DataFlashContinuousRead( |
150 | AT91PS_DataFlash pDataFlash, | |
151 | int src, | |
152 | unsigned char *dataBuffer, | |
153 | int sizeToRead) | |
dcbfd2e5 PP |
154 | { |
155 | AT91S_DataFlashStatus status; | |
156 | /* Test the size to read in the device */ | |
6e4bf9b2 | 157 | if ((src + sizeToRead) > |
bd86220f PP |
158 | (pDataFlash->pDevice->pages_size * |
159 | (pDataFlash->pDevice->pages_number))) | |
dcbfd2e5 PP |
160 | return DATAFLASH_MEMORY_OVERFLOW; |
161 | ||
162 | pDataFlash->pDataFlashDesc->rx_data_pt = dataBuffer; | |
163 | pDataFlash->pDataFlashDesc->rx_data_size = sizeToRead; | |
164 | pDataFlash->pDataFlashDesc->tx_data_pt = dataBuffer; | |
165 | pDataFlash->pDataFlashDesc->tx_data_size = sizeToRead; | |
166 | ||
bd86220f PP |
167 | status = AT91F_DataFlashSendCommand( |
168 | pDataFlash, DB_CONTINUOUS_ARRAY_READ, 8, src); | |
dcbfd2e5 | 169 | /* Send the command to the dataflash */ |
6e4bf9b2 | 170 | return (status); |
dcbfd2e5 PP |
171 | } |
172 | ||
dcbfd2e5 PP |
173 | /*---------------------------------------------------------------------------*/ |
174 | /* Function Name : AT91F_DataFlashPagePgmBuf */ | |
175 | /* Object : Main memory page program thru buffer 1 or buffer 2 */ | |
176 | /* Input Parameters : DataFlash Service */ | |
177 | /* : <*src> = Source buffer */ | |
178 | /* : <dest> = dataflash destination address */ | |
179 | /* : <SizeToWrite> = data buffer size */ | |
180 | /* Return value : State of the dataflash */ | |
f01dbb54 | 181 | /*---------------------------------------------------------------------------*/ |
6e4bf9b2 PP |
182 | AT91S_DataFlashStatus AT91F_DataFlashPagePgmBuf(AT91PS_DataFlash pDataFlash, |
183 | unsigned char *src, | |
184 | unsigned int dest, | |
185 | unsigned int SizeToWrite) | |
dcbfd2e5 PP |
186 | { |
187 | int cmdsize; | |
188 | pDataFlash->pDataFlashDesc->tx_data_pt = src; | |
189 | pDataFlash->pDataFlashDesc->tx_data_size = SizeToWrite; | |
190 | pDataFlash->pDataFlashDesc->rx_data_pt = src; | |
191 | pDataFlash->pDataFlashDesc->rx_data_size = SizeToWrite; | |
192 | ||
193 | cmdsize = 4; | |
194 | /* Send the command to the dataflash */ | |
195 | if (pDataFlash->pDevice->pages_number >= 16384) | |
196 | cmdsize = 5; | |
bd86220f PP |
197 | return (AT91F_DataFlashSendCommand( |
198 | pDataFlash, DB_PAGE_PGM_BUF1, cmdsize, dest)); | |
6e4bf9b2 | 199 | } |
dcbfd2e5 PP |
200 | |
201 | /*---------------------------------------------------------------------------*/ | |
202 | /* Function Name : AT91F_MainMemoryToBufferTransfert */ | |
203 | /* Object : Read a page in the SRAM Buffer 1 or 2 */ | |
204 | /* Input Parameters : DataFlash Service */ | |
205 | /* : Page concerned */ | |
53677ef1 | 206 | /* : */ |
dcbfd2e5 | 207 | /* Return value : State of the dataflash */ |
f01dbb54 | 208 | /*---------------------------------------------------------------------------*/ |
bd86220f PP |
209 | AT91S_DataFlashStatus AT91F_MainMemoryToBufferTransfert( |
210 | AT91PS_DataFlash | |
211 | pDataFlash, | |
212 | unsigned char | |
213 | BufferCommand, | |
214 | unsigned int page) | |
dcbfd2e5 PP |
215 | { |
216 | int cmdsize; | |
217 | /* Test if the buffer command is legal */ | |
de74b9ee WD |
218 | if ((BufferCommand != DB_PAGE_2_BUF1_TRF) && |
219 | (BufferCommand != DB_PAGE_2_BUF2_TRF)) { | |
dcbfd2e5 | 220 | return DATAFLASH_BAD_COMMAND; |
de74b9ee | 221 | } |
dcbfd2e5 PP |
222 | |
223 | /* no data to transmit or receive */ | |
224 | pDataFlash->pDataFlashDesc->tx_data_size = 0; | |
225 | cmdsize = 4; | |
226 | if (pDataFlash->pDevice->pages_number >= 16384) | |
227 | cmdsize = 5; | |
bd86220f PP |
228 | return (AT91F_DataFlashSendCommand( |
229 | pDataFlash, BufferCommand, cmdsize, | |
230 | page * pDataFlash->pDevice->pages_size)); | |
dcbfd2e5 PP |
231 | } |
232 | ||
dcbfd2e5 PP |
233 | /*-------------------------------------------------------------------------- */ |
234 | /* Function Name : AT91F_DataFlashWriteBuffer */ | |
235 | /* Object : Write data to the internal sram buffer 1 or 2 */ | |
236 | /* Input Parameters : DataFlash Service */ | |
237 | /* : <BufferCommand> = command to write buffer1 or 2 */ | |
238 | /* : <*dataBuffer> = data buffer to write */ | |
239 | /* : <bufferAddress> = address in the internal buffer */ | |
240 | /* : <SizeToWrite> = data buffer size */ | |
241 | /* Return value : State of the dataflash */ | |
242 | /*---------------------------------------------------------------------------*/ | |
bd86220f PP |
243 | AT91S_DataFlashStatus AT91F_DataFlashWriteBuffer( |
244 | AT91PS_DataFlash pDataFlash, | |
245 | unsigned char BufferCommand, | |
246 | unsigned char *dataBuffer, | |
247 | unsigned int bufferAddress, | |
248 | int SizeToWrite) | |
dcbfd2e5 PP |
249 | { |
250 | int cmdsize; | |
251 | /* Test if the buffer command is legal */ | |
de74b9ee WD |
252 | if ((BufferCommand != DB_BUF1_WRITE) && |
253 | (BufferCommand != DB_BUF2_WRITE)) { | |
dcbfd2e5 | 254 | return DATAFLASH_BAD_COMMAND; |
de74b9ee | 255 | } |
dcbfd2e5 PP |
256 | |
257 | /* buffer address must be lower than page size */ | |
258 | if (bufferAddress > pDataFlash->pDevice->pages_size) | |
259 | return DATAFLASH_BAD_ADDRESS; | |
260 | ||
6e4bf9b2 | 261 | if ((pDataFlash->pDataFlashDesc->state) != IDLE) |
dcbfd2e5 PP |
262 | return DATAFLASH_BUSY; |
263 | ||
264 | /* Send first Write Command */ | |
265 | pDataFlash->pDataFlashDesc->command[0] = BufferCommand; | |
266 | pDataFlash->pDataFlashDesc->command[1] = 0; | |
267 | if (pDataFlash->pDevice->pages_number >= 16384) { | |
6e4bf9b2 PP |
268 | pDataFlash->pDataFlashDesc->command[2] = 0; |
269 | pDataFlash->pDataFlashDesc->command[3] = | |
bd86220f PP |
270 | (unsigned char)(((unsigned int)(bufferAddress & |
271 | pDataFlash->pDevice-> | |
272 | byte_mask)) >> 8); | |
6e4bf9b2 | 273 | pDataFlash->pDataFlashDesc->command[4] = |
bd86220f | 274 | (unsigned char)((unsigned int)bufferAddress & 0x00FF); |
dcbfd2e5 PP |
275 | cmdsize = 5; |
276 | } else { | |
6e4bf9b2 | 277 | pDataFlash->pDataFlashDesc->command[2] = |
bd86220f PP |
278 | (unsigned char)(((unsigned int)(bufferAddress & |
279 | pDataFlash->pDevice-> | |
280 | byte_mask)) >> 8); | |
6e4bf9b2 | 281 | pDataFlash->pDataFlashDesc->command[3] = |
bd86220f | 282 | (unsigned char)((unsigned int)bufferAddress & 0x00FF); |
6e4bf9b2 | 283 | pDataFlash->pDataFlashDesc->command[4] = 0; |
dcbfd2e5 PP |
284 | cmdsize = 4; |
285 | } | |
286 | ||
6e4bf9b2 | 287 | pDataFlash->pDataFlashDesc->tx_cmd_pt = |
bd86220f | 288 | pDataFlash->pDataFlashDesc->command; |
dcbfd2e5 | 289 | pDataFlash->pDataFlashDesc->tx_cmd_size = cmdsize; |
6e4bf9b2 | 290 | pDataFlash->pDataFlashDesc->rx_cmd_pt = |
bd86220f | 291 | pDataFlash->pDataFlashDesc->command; |
dcbfd2e5 PP |
292 | pDataFlash->pDataFlashDesc->rx_cmd_size = cmdsize; |
293 | ||
6e4bf9b2 PP |
294 | pDataFlash->pDataFlashDesc->rx_data_pt = dataBuffer; |
295 | pDataFlash->pDataFlashDesc->tx_data_pt = dataBuffer; | |
296 | pDataFlash->pDataFlashDesc->rx_data_size = SizeToWrite; | |
297 | pDataFlash->pDataFlashDesc->tx_data_size = SizeToWrite; | |
dcbfd2e5 PP |
298 | |
299 | return AT91F_SpiWrite(pDataFlash->pDataFlashDesc); | |
300 | } | |
301 | ||
302 | /*---------------------------------------------------------------------------*/ | |
303 | /* Function Name : AT91F_PageErase */ | |
53677ef1 | 304 | /* Object : Erase a page */ |
dcbfd2e5 PP |
305 | /* Input Parameters : DataFlash Service */ |
306 | /* : Page concerned */ | |
53677ef1 | 307 | /* : */ |
dcbfd2e5 PP |
308 | /* Return value : State of the dataflash */ |
309 | /*---------------------------------------------------------------------------*/ | |
bd86220f PP |
310 | AT91S_DataFlashStatus AT91F_PageErase( |
311 | AT91PS_DataFlash pDataFlash, | |
312 | unsigned int page) | |
dcbfd2e5 PP |
313 | { |
314 | int cmdsize; | |
315 | /* Test if the buffer command is legal */ | |
316 | /* no data to transmit or receive */ | |
6e4bf9b2 | 317 | pDataFlash->pDataFlashDesc->tx_data_size = 0; |
dcbfd2e5 PP |
318 | |
319 | cmdsize = 4; | |
320 | if (pDataFlash->pDevice->pages_number >= 16384) | |
321 | cmdsize = 5; | |
de74b9ee | 322 | return (AT91F_DataFlashSendCommand(pDataFlash, |
bd86220f PP |
323 | DB_PAGE_ERASE, cmdsize, |
324 | page * pDataFlash->pDevice->pages_size)); | |
dcbfd2e5 PP |
325 | } |
326 | ||
dcbfd2e5 PP |
327 | /*---------------------------------------------------------------------------*/ |
328 | /* Function Name : AT91F_BlockErase */ | |
53677ef1 | 329 | /* Object : Erase a Block */ |
dcbfd2e5 PP |
330 | /* Input Parameters : DataFlash Service */ |
331 | /* : Page concerned */ | |
53677ef1 | 332 | /* : */ |
dcbfd2e5 | 333 | /* Return value : State of the dataflash */ |
f01dbb54 | 334 | /*---------------------------------------------------------------------------*/ |
bd86220f PP |
335 | AT91S_DataFlashStatus AT91F_BlockErase( |
336 | AT91PS_DataFlash pDataFlash, | |
337 | unsigned int block) | |
dcbfd2e5 PP |
338 | { |
339 | int cmdsize; | |
340 | /* Test if the buffer command is legal */ | |
341 | /* no data to transmit or receive */ | |
6e4bf9b2 | 342 | pDataFlash->pDataFlashDesc->tx_data_size = 0; |
dcbfd2e5 PP |
343 | cmdsize = 4; |
344 | if (pDataFlash->pDevice->pages_number >= 16384) | |
345 | cmdsize = 5; | |
6e4bf9b2 | 346 | return (AT91F_DataFlashSendCommand(pDataFlash, DB_BLOCK_ERASE, cmdsize, |
bd86220f PP |
347 | block * 8 * |
348 | pDataFlash->pDevice->pages_size)); | |
dcbfd2e5 PP |
349 | } |
350 | ||
351 | /*---------------------------------------------------------------------------*/ | |
352 | /* Function Name : AT91F_WriteBufferToMain */ | |
353 | /* Object : Write buffer to the main memory */ | |
354 | /* Input Parameters : DataFlash Service */ | |
355 | /* : <BufferCommand> = command to send to buffer1 or buffer2 */ | |
356 | /* : <dest> = main memory address */ | |
357 | /* Return value : State of the dataflash */ | |
f01dbb54 | 358 | /*---------------------------------------------------------------------------*/ |
6e4bf9b2 | 359 | AT91S_DataFlashStatus AT91F_WriteBufferToMain(AT91PS_DataFlash pDataFlash, |
bd86220f PP |
360 | unsigned char BufferCommand, |
361 | unsigned int dest) | |
dcbfd2e5 PP |
362 | { |
363 | int cmdsize; | |
364 | /* Test if the buffer command is correct */ | |
365 | if ((BufferCommand != DB_BUF1_PAGE_PGM) && | |
bd86220f PP |
366 | (BufferCommand != DB_BUF1_PAGE_ERASE_PGM) && |
367 | (BufferCommand != DB_BUF2_PAGE_PGM) && | |
368 | (BufferCommand != DB_BUF2_PAGE_ERASE_PGM)) | |
dcbfd2e5 PP |
369 | return DATAFLASH_BAD_COMMAND; |
370 | ||
371 | /* no data to transmit or receive */ | |
372 | pDataFlash->pDataFlashDesc->tx_data_size = 0; | |
373 | ||
374 | cmdsize = 4; | |
375 | if (pDataFlash->pDevice->pages_number >= 16384) | |
376 | cmdsize = 5; | |
377 | /* Send the command to the dataflash */ | |
de74b9ee | 378 | return (AT91F_DataFlashSendCommand(pDataFlash, BufferCommand, |
bd86220f | 379 | cmdsize, dest)); |
6e4bf9b2 | 380 | } |
dcbfd2e5 PP |
381 | |
382 | /*---------------------------------------------------------------------------*/ | |
383 | /* Function Name : AT91F_PartialPageWrite */ | |
384 | /* Object : Erase partielly a page */ | |
385 | /* Input Parameters : <page> = page number */ | |
386 | /* : <AdrInpage> = adr to begin the fading */ | |
387 | /* : <length> = Number of bytes to erase */ | |
f01dbb54 | 388 | /*---------------------------------------------------------------------------*/ |
6e4bf9b2 | 389 | AT91S_DataFlashStatus AT91F_PartialPageWrite(AT91PS_DataFlash pDataFlash, |
bd86220f PP |
390 | unsigned char *src, |
391 | unsigned int dest, | |
392 | unsigned int size) | |
dcbfd2e5 PP |
393 | { |
394 | unsigned int page; | |
395 | unsigned int AdrInPage; | |
396 | ||
397 | page = dest / (pDataFlash->pDevice->pages_size); | |
398 | AdrInPage = dest % (pDataFlash->pDevice->pages_size); | |
399 | ||
400 | /* Read the contents of the page in the Sram Buffer */ | |
6e4bf9b2 | 401 | AT91F_MainMemoryToBufferTransfert(pDataFlash, DB_PAGE_2_BUF1_TRF, page); |
f01dbb54 | 402 | AT91F_DataFlashWaitReady(pDataFlash->pDataFlashDesc, |
6e4bf9b2 | 403 | AT91C_TIMEOUT_WRDY); |
dcbfd2e5 | 404 | /*Update the SRAM buffer */ |
f01dbb54 | 405 | AT91F_DataFlashWriteBuffer(pDataFlash, DB_BUF1_WRITE, src, |
bd86220f | 406 | AdrInPage, size); |
dcbfd2e5 | 407 | |
f01dbb54 | 408 | AT91F_DataFlashWaitReady(pDataFlash->pDataFlashDesc, |
bd86220f | 409 | AT91C_TIMEOUT_WRDY); |
dcbfd2e5 PP |
410 | |
411 | /* Erase page if a 128 Mbits device */ | |
412 | if (pDataFlash->pDevice->pages_number >= 16384) { | |
413 | AT91F_PageErase(pDataFlash, page); | |
414 | /* Rewrite the modified Sram Buffer in the main memory */ | |
f01dbb54 | 415 | AT91F_DataFlashWaitReady(pDataFlash->pDataFlashDesc, |
6e4bf9b2 | 416 | AT91C_TIMEOUT_WRDY); |
dcbfd2e5 PP |
417 | } |
418 | ||
419 | /* Rewrite the modified Sram Buffer in the main memory */ | |
6e4bf9b2 PP |
420 | return (AT91F_WriteBufferToMain(pDataFlash, DB_BUF1_PAGE_ERASE_PGM, |
421 | (page * | |
422 | pDataFlash->pDevice->pages_size))); | |
dcbfd2e5 PP |
423 | } |
424 | ||
425 | /*---------------------------------------------------------------------------*/ | |
426 | /* Function Name : AT91F_DataFlashWrite */ | |
427 | /* Object : */ | |
428 | /* Input Parameters : <*src> = Source buffer */ | |
429 | /* : <dest> = dataflash adress */ | |
430 | /* : <size> = data buffer size */ | |
f01dbb54 | 431 | /*---------------------------------------------------------------------------*/ |
6e4bf9b2 | 432 | AT91S_DataFlashStatus AT91F_DataFlashWrite(AT91PS_DataFlash pDataFlash, |
bd86220f PP |
433 | unsigned char *src, |
434 | int dest, int size) | |
dcbfd2e5 PP |
435 | { |
436 | unsigned int length; | |
437 | unsigned int page; | |
438 | unsigned int status; | |
439 | ||
440 | AT91F_SpiEnable(pDataFlash->pDevice->cs); | |
441 | ||
6e4bf9b2 | 442 | if ((dest + size) > (pDataFlash->pDevice->pages_size * |
bd86220f | 443 | (pDataFlash->pDevice->pages_number))) |
dcbfd2e5 PP |
444 | return DATAFLASH_MEMORY_OVERFLOW; |
445 | ||
446 | /* If destination does not fit a page start address */ | |
6e4bf9b2 | 447 | if ((dest % ((unsigned int)(pDataFlash->pDevice->pages_size))) != 0) { |
de74b9ee | 448 | length = |
bd86220f PP |
449 | pDataFlash->pDevice->pages_size - |
450 | (dest % ((unsigned int)(pDataFlash->pDevice->pages_size))); | |
dcbfd2e5 PP |
451 | |
452 | if (size < length) | |
453 | length = size; | |
454 | ||
6e4bf9b2 | 455 | if (!AT91F_PartialPageWrite(pDataFlash, src, dest, length)) |
dcbfd2e5 PP |
456 | return DATAFLASH_ERROR; |
457 | ||
f01dbb54 | 458 | AT91F_DataFlashWaitReady(pDataFlash->pDataFlashDesc, |
6e4bf9b2 | 459 | AT91C_TIMEOUT_WRDY); |
dcbfd2e5 PP |
460 | |
461 | /* Update size, source and destination pointers */ | |
462 | size -= length; | |
463 | dest += length; | |
464 | src += length; | |
465 | } | |
466 | ||
6e4bf9b2 | 467 | while ((size - pDataFlash->pDevice->pages_size) >= 0) { |
dcbfd2e5 PP |
468 | /* program dataflash page */ |
469 | page = (unsigned int)dest / (pDataFlash->pDevice->pages_size); | |
470 | ||
f01dbb54 | 471 | status = AT91F_DataFlashWriteBuffer(pDataFlash, |
bd86220f PP |
472 | DB_BUF1_WRITE, src, 0, |
473 | pDataFlash->pDevice-> | |
474 | pages_size); | |
f01dbb54 | 475 | AT91F_DataFlashWaitReady(pDataFlash->pDataFlashDesc, |
6e4bf9b2 | 476 | AT91C_TIMEOUT_WRDY); |
dcbfd2e5 PP |
477 | |
478 | status = AT91F_PageErase(pDataFlash, page); | |
f01dbb54 | 479 | AT91F_DataFlashWaitReady(pDataFlash->pDataFlashDesc, |
6e4bf9b2 | 480 | AT91C_TIMEOUT_WRDY); |
dcbfd2e5 PP |
481 | if (!status) |
482 | return DATAFLASH_ERROR; | |
483 | ||
6e4bf9b2 | 484 | status = AT91F_WriteBufferToMain(pDataFlash, |
bd86220f | 485 | DB_BUF1_PAGE_PGM, dest); |
6e4bf9b2 | 486 | if (!status) |
dcbfd2e5 PP |
487 | return DATAFLASH_ERROR; |
488 | ||
f01dbb54 | 489 | AT91F_DataFlashWaitReady(pDataFlash->pDataFlashDesc, |
6e4bf9b2 | 490 | AT91C_TIMEOUT_WRDY); |
dcbfd2e5 PP |
491 | |
492 | /* Update size, source and destination pointers */ | |
493 | size -= pDataFlash->pDevice->pages_size; | |
494 | dest += pDataFlash->pDevice->pages_size; | |
6e4bf9b2 | 495 | src += pDataFlash->pDevice->pages_size; |
dcbfd2e5 PP |
496 | } |
497 | ||
498 | /* If still some bytes to read */ | |
6e4bf9b2 | 499 | if (size > 0) { |
dcbfd2e5 | 500 | /* program dataflash page */ |
6e4bf9b2 | 501 | if (!AT91F_PartialPageWrite(pDataFlash, src, dest, size)) |
dcbfd2e5 PP |
502 | return DATAFLASH_ERROR; |
503 | ||
f01dbb54 | 504 | AT91F_DataFlashWaitReady(pDataFlash->pDataFlashDesc, |
6e4bf9b2 | 505 | AT91C_TIMEOUT_WRDY); |
dcbfd2e5 PP |
506 | } |
507 | return DATAFLASH_OK; | |
508 | } | |
509 | ||
dcbfd2e5 | 510 | /*---------------------------------------------------------------------------*/ |
53677ef1 | 511 | /* Function Name : AT91F_DataFlashRead */ |
dcbfd2e5 | 512 | /* Object : Read a block in dataflash */ |
53677ef1 WD |
513 | /* Input Parameters : */ |
514 | /* Return value : */ | |
dcbfd2e5 | 515 | /*---------------------------------------------------------------------------*/ |
6e4bf9b2 PP |
516 | int AT91F_DataFlashRead(AT91PS_DataFlash pDataFlash, |
517 | unsigned long addr, unsigned long size, char *buffer) | |
dcbfd2e5 PP |
518 | { |
519 | unsigned long SizeToRead; | |
520 | ||
521 | AT91F_SpiEnable(pDataFlash->pDevice->cs); | |
522 | ||
6e4bf9b2 | 523 | if (AT91F_DataFlashWaitReady(pDataFlash->pDataFlashDesc, |
bd86220f | 524 | AT91C_TIMEOUT_WRDY) != DATAFLASH_OK) |
dcbfd2e5 PP |
525 | return -1; |
526 | ||
527 | while (size) { | |
6e4bf9b2 | 528 | SizeToRead = (size < 0x8000) ? size : 0x8000; |
dcbfd2e5 | 529 | |
f01dbb54 | 530 | if (AT91F_DataFlashWaitReady(pDataFlash->pDataFlashDesc, |
bd86220f PP |
531 | AT91C_TIMEOUT_WRDY) != |
532 | DATAFLASH_OK) | |
dcbfd2e5 PP |
533 | return -1; |
534 | ||
6e4bf9b2 | 535 | if (AT91F_DataFlashContinuousRead(pDataFlash, addr, |
bd86220f PP |
536 | (uchar *) buffer, |
537 | SizeToRead) != DATAFLASH_OK) | |
dcbfd2e5 PP |
538 | return -1; |
539 | ||
540 | size -= SizeToRead; | |
541 | addr += SizeToRead; | |
542 | buffer += SizeToRead; | |
543 | } | |
544 | ||
545 | return DATAFLASH_OK; | |
546 | } | |
547 | ||
0c42f36f | 548 | /*---------------------------------------------------------------------------*/ |
53677ef1 WD |
549 | /* Function Name : AT91F_DataflashProbe */ |
550 | /* Object : */ | |
551 | /* Input Parameters : */ | |
0c42f36f | 552 | /* Return value : Dataflash status register */ |
f01dbb54 | 553 | /*---------------------------------------------------------------------------*/ |
6e4bf9b2 PP |
554 | int AT91F_DataflashProbe(int cs, AT91PS_DataflashDesc pDesc) |
555 | { | |
0c42f36f PP |
556 | AT91F_SpiEnable(cs); |
557 | AT91F_DataFlashGetStatus(pDesc); | |
6e4bf9b2 | 558 | return ((pDesc->command[1] == 0xFF) ? 0 : pDesc->command[1] & 0x3C); |
0c42f36f | 559 | } |