Mercurial > ecos
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 |
| 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 } |
