annotate packages/devs/flash/arm/at91/current/src/flash_program_buf.c @ 175:e7780801e1a7

Merge from eCos master repository on 2001-07-31-19:15:01-BST
author jlarmour
date Tue, 31 Jul 2001 21:15:36 +0000
parents
children e0c0827131d1
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
175
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
1 //==========================================================================
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
2 //
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
3 // flash_program_buf.c
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
4 //
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
5 // Flash programming
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
6 //
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
7 //==========================================================================
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
8 //####COPYRIGHTBEGIN####
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
9 //
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
10 // -------------------------------------------
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
11 // The contents of this file are subject to the Red Hat eCos Public License
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
12 // Version 1.1 (the "License"); you may not use this file except in
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
13 // compliance with the License. You may obtain a copy of the License at
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
14 // http://www.redhat.com/
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
15 //
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
16 // Software distributed under the License is distributed on an "AS IS"
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
17 // basis, WITHOUT WARRANTY OF ANY KIND, either express or implied. See the
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
18 // License for the specific language governing rights and limitations under
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
19 // the License.
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
20 //
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
21 // The Original Code is eCos - Embedded Configurable Operating System,
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
22 // released September 30, 1998.
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
23 //
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
24 // The Initial Developer of the Original Code is Red Hat.
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
25 // Portions created by Red Hat are
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
26 // Copyright (C) 1998, 1999, 2000, 2001 Red Hat, Inc.
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
27 // All Rights Reserved.
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
28 // -------------------------------------------
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
29 //
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
30 //####COPYRIGHTEND####
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
31 //==========================================================================
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
32 //#####DESCRIPTIONBEGIN####
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
33 //
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
34 // Author(s): gthomas
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
35 // Contributors: gthomas
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
36 // Date: 2001-07-17
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
37 // Purpose:
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
38 // Description:
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
39 //
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
40 //####DESCRIPTIONEND####
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
41 //
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
42 //==========================================================================
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
43
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
44 #include "flash.h"
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
45
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
46 #include <pkgconf/hal.h>
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
47 #include <cyg/hal/hal_arch.h>
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
48 #include <cyg/hal/hal_cache.h>
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
49
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
50 //
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
51 // CAUTION! This code must be copied to RAM before execution. Therefore,
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
52 // it must not contain any code which might be position dependent!
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
53 //
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
54
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
55 int
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
56 flash_program_buf(volatile unsigned short *addr, unsigned short *data, int len)
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
57 {
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
58 volatile unsigned short *PAGE, *ROM;
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
59 int timeout = 50000;
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
60 int cache_on;
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
61 int i, offset;
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
62 unsigned short hold[FLASH_PAGE_SIZE/2];
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
63
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
64 HAL_DCACHE_IS_ENABLED(cache_on);
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
65 if (cache_on) {
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
66 HAL_DCACHE_SYNC();
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
67 HAL_DCACHE_DISABLE();
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
68 }
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
69
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
70 if (len != FLASH_PAGE_SIZE) {
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
71 return FLASH_LENGTH_ERROR;
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
72 }
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
73
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
74 ROM = (volatile unsigned short *)((unsigned long)addr & 0xFFFF0000);
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
75 PAGE = (volatile unsigned short *)((unsigned long)addr & FLASH_PAGE_MASK);
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
76
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
77 // Copy current contents (allows for partial updates)
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
78 for (i = 0; i < FLASH_PAGE_SIZE/2; i++) {
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
79 hold[i] = PAGE[i];
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
80 }
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
81
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
82 // Merge data into holding buffer
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
83 offset = (unsigned long)addr & FLASH_PAGE_OFFSET;
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
84 for (i = 0; i < (len/2); i++) {
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
85 hold[offset+i] = data[i];
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
86 }
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
87
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
88 // Now write the data
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
89
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
90 // Send lead-in sequence
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
91 ROM[FLASH_Key_Addr0] = FLASH_Key0;
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
92 ROM[FLASH_Key_Addr1] = FLASH_Key1;
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
93
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
94 // Send 'write' command
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
95 ROM[FLASH_Key_Addr0] = FLASH_Program;
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
96
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
97 // Send one page/sector of data
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
98 for (i = 0; i < FLASH_PAGE_SIZE/2; i++) {
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
99 PAGE[i] = hold[i];
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
100 }
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
101
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
102 // Wait for data to be programmed
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
103 while (timeout-- > 0) {
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
104 if (PAGE[(FLASH_PAGE_SIZE/2)-1] == hold[(FLASH_PAGE_SIZE/2)-1]) {
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
105 break;
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
106 }
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
107 }
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
108
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
109 if (timeout <= 0) {
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
110 return FLASH_PROGRAM_ERROR;
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
111 }
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
112
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
113 if (cache_on) {
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
114 HAL_DCACHE_ENABLE();
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
115 }
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
116
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
117 return FLASH_PROGRAM_OK;
e7780801e1a7 Merge from eCos master repository on 2001-07-31-19:15:01-BST
jlarmour
parents:
diff changeset
118 }