author | frdupin |
Tue, 19 Dec 2006 16:30:57 +0100 | |
changeset 60 | a8723422e0dd |
parent 18 | 2fc8aa46980b |
permissions | -rw-r--r-- |
3 | 1 |
/* |
2 |
canfestival@canopencanada.ca |
|
3 |
||
4 |
See COPYING file for copyrights details. |
|
5 |
||
6 |
This library is free software; you can redistribute it and/or |
|
7 |
modify it under the terms of the GNU Lesser General Public |
|
8 |
License as published by the Free Software Foundation; either |
|
9 |
version 2.1 of the License, or (at your option) any later version. |
|
10 |
||
11 |
This library is distributed in the hope that it will be useful, |
|
12 |
but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
13 |
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
|
14 |
Lesser General Public License for more details. |
|
15 |
||
16 |
You should have received a copy of the GNU Lesser General Public |
|
17 |
License along with this library; if not, write to the Free Software |
|
18 |
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
|
19 |
||
20 |
flash.c |
|
21 |
save to / retrieve from the non-volatile memory |
|
22 |
to be tested |
|
23 |
- can we write/read into an address without working with the whole page (256bytes) |
|
24 |
*/ |
|
25 |
||
26 |
||
27 |
#include <stdio.h> |
|
28 |
#include <stdlib.h> |
|
29 |
||
30 |
#include "applicfg.h" |
|
31 |
#include "data.h" |
|
32 |
#include "objdictdef.h" |
|
33 |
||
34 |
#include "lpc2138_defs.h" /* LPC21xx definitions */ |
|
35 |
||
36 |
#define IAP_LOCATION 0x7ffffff1 |
|
37 |
||
38 |
||
39 |
// define a page of data of NVRAM_BLOCK_SIZE bytes |
|
40 |
// |
|
41 |
short data_len; /* 0 to NVRAM_BLOCK_SIZE bytes */ |
|
42 |
short data_num_pages; |
|
43 |
unsigned int *data_page = NULL; |
|
44 |
unsigned int data_addr; |
|
45 |
||
46 |
unsigned int *regs_page = NULL; |
|
47 |
||
48 |
// local definitons |
|
49 |
void ee_erase(unsigned int ,unsigned int[]); //function erases EEPROM |
|
50 |
void ee_write_page(unsigned int); //function adds a record in EEPROM |
|
51 |
void ee_read_page(unsigned int); //function reads the latest valid record in EEPROM |
|
52 |
||
53 |
typedef void (*IAP)(unsigned int [],unsigned int[]); |
|
54 |
IAP iap_entry; |
|
55 |
||
56 |
||
18
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
57 |
int iat_init() |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
58 |
{ |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
59 |
int n = NVRAM_BLOCK_SIZE / sizeof(unsigned int); |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
60 |
|
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
61 |
/* some actions to initialise the flash */ |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
62 |
data_len = 0; |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
63 |
data_num_pages = 0; |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
64 |
|
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
65 |
data_page = (unsigned int *)malloc(sizeof(unsigned int) * n); |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
66 |
memset(data_page, 0, sizeof(unsigned int)*n); |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
67 |
|
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
68 |
if (data_page == NULL) |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
69 |
return -1; |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
70 |
|
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
71 |
regs_page = (unsigned int *)malloc(sizeof(unsigned int) * n); |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
72 |
memset(regs_page, 0, sizeof(unsigned int)*n); |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
73 |
if (regs_page == NULL) |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
74 |
return -2; |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
75 |
|
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
76 |
iat_flash_read_regs(); |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
77 |
|
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
78 |
/* start the data at the location specified in the registers */ |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
79 |
if (0) /* for now it is 0, but put here a test to know whether |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
80 |
or not the NVRAM has been written before */ |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
81 |
data_addr = regs_page[1]; |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
82 |
else |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
83 |
data_addr = NVRAM_BLOCK_SIZE; /* let start at block 1 */ |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
84 |
|
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
85 |
return 0; |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
86 |
} |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
87 |
|
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
88 |
|
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
89 |
void iat_end() |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
90 |
{ |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
91 |
/* write the last page before closing */ |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
92 |
iat_flash_write_page(data_addr); |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
93 |
|
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
94 |
/* some actions to end accessing the flash */ |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
95 |
free(data_page); |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
96 |
|
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
97 |
regs_page[4] = data_num_pages; |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
98 |
/* write the registers to the NVRAM before closing */ |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
99 |
iat_flash_write_regs(); |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
100 |
free(regs_page); |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
101 |
} |
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
102 |
|
2fc8aa46980b
First version of NVRAM implemented on the file system for can_virtual
oremeq
parents:
3
diff
changeset
|
103 |
|
3 | 104 |
|
105 |
/************************************************************************/ |
|
106 |
/* */ |
|
107 |
/* function: */ |
|
108 |
/* void ee_erase(unsigned int command_ee,unsigned int result_ee[]) */ |
|
109 |
/* */ |
|
110 |
/* type: void */ |
|
111 |
/* */ |
|
112 |
/* parameters: */ |
|
113 |
/* command_ee - Not used. */ |
|
114 |
/* result_ee[0] - Returns a response to the last IAP command used. */ |
|
115 |
/* 0 - EEPROM successfully erased. */ |
|
116 |
/* For all other response values, see microcontroller */ |
|
117 |
/* User Manual, IAP Commands and Status Codes Summary. */ |
|
118 |
/* result_ee[1] - Not used. */ |
|
119 |
/* */ |
|
120 |
/* version: 1.1 (01/27/2006) */ |
|
121 |
/* */ |
|
122 |
/* constants defined in LPC2k_ee.h used in this function: */ |
|
123 |
/* EE_SEC_L - microcontroller's Flash sector where EEPROM begins */ |
|
124 |
/* EE_SEC_H - microcontroller's Flash sector where EEPROM ends */ |
|
125 |
/* EE_CCLK - microcontroller's system clock (cclk) */ |
|
126 |
/* */ |
|
127 |
/* description: */ |
|
128 |
/* This function erases LPC2000 on-chip Flash sectors selected to act */ |
|
129 |
/* as an EEPROM. All Flash sectors between EE_SEC_L abd EE_SEC_H */ |
|
130 |
/* (including these sectors) will be erased using the In Application */ |
|
131 |
/* Programming (IAP) routines (see User Manual for more details). */ |
|
132 |
/* Also, this function disables all interrupts while erasing the */ |
|
133 |
/* EEPROM. If this is not needed, three lines of the ee_erase */ |
|
134 |
/* subroutine can simply be commented-out without affecting the */ |
|
135 |
/* routine performance at all. */ |
|
136 |
/* */ |
|
137 |
/* revision history: */ |
|
138 |
/* - Rev. 1.1 adds interrupt disable feature. */ |
|
139 |
/* */ |
|
140 |
/************************************************************************/ |
|
141 |
void ee_erase(unsigned int command_ee,unsigned int result_ee[]) |
|
142 |
{ |
|
143 |
unsigned int command_iap[5]; |
|
144 |
unsigned int result_iap[3]; |
|
145 |
unsigned long int enabled_interrupts; |
|
146 |
||
147 |
enabled_interrupts = VICIntEnable; //disable all interrupts |
|
148 |
VICIntEnClr = enabled_interrupts; |
|
149 |
||
150 |
command_iap[0]=50; // prepare sectors from EE_SEC_L to EE_SEC_H for erase |
|
151 |
command_iap[1]=EE_SEC_L; |
|
152 |
command_iap[2]=EE_SEC_H; |
|
153 |
iap_entry=(IAP) IAP_LOCATION; |
|
154 |
iap_entry(command_iap,result_iap); |
|
155 |
||
156 |
command_iap[0]=52; // erase sectors from EE_SEC_L to EE_SEC_H |
|
157 |
command_iap[1]=EE_SEC_L; |
|
158 |
command_iap[2]=EE_SEC_H; |
|
159 |
command_iap[3]=EE_CCLK; |
|
160 |
iap_entry=(IAP) IAP_LOCATION; |
|
161 |
iap_entry(command_iap,result_iap); |
|
162 |
||
163 |
command_iap[0]=53; // blankcheck sectors from EE_SEC_L to EE_SEC_H |
|
164 |
command_iap[1]=EE_SEC_L; |
|
165 |
command_iap[2]=EE_SEC_H; |
|
166 |
iap_entry=(IAP) IAP_LOCATION; |
|
167 |
iap_entry(command_iap,result_iap); |
|
168 |
||
169 |
VICIntEnable = enabled_interrupts; //restore interrupt enable register |
|
170 |
||
171 |
result_ee[0]=result_iap[0]; |
|
172 |
return; |
|
173 |
} |
|
174 |
||
175 |
/************************************************************************/ |
|
176 |
/* */ |
|
177 |
/* function: */ |
|
178 |
/* void ee_write(unsigned int command_ee,unsigned int result_ee[]) */ |
|
179 |
/* */ |
|
180 |
/* type: void */ |
|
181 |
/* */ |
|
182 |
/* parameters: */ |
|
183 |
/* command_ee - An address of a content of ee_data type that has */ |
|
184 |
/* to be programmed into EEPROM. */ |
|
185 |
/* result_ee[0] - Returns a response to the last IAP command used. */ |
|
186 |
/* 0 - data successfully programmed in EEPROM. */ |
|
187 |
/* 501 - no space in EEPROM to program data. */ |
|
188 |
/* For all other response values, see microcontroller */ |
|
189 |
/* User Manual, IAP Commands and Status Codes Summary. */ |
|
190 |
/* result_ee[1] - Not used. */ |
|
191 |
/* */ |
|
192 |
/* version: 1.1 (01/27/2006) */ |
|
193 |
/* */ |
|
194 |
/* constants defined in LPC2k_ee.h used in this function: */ |
|
195 |
/* EE_BUFFER_SIZE - IAP buffer size; must be 256 or 512 */ |
|
196 |
/* NO_SPACE_IN_EEPROM - EEPROM is full and no data can be programmed */ |
|
197 |
/* EE_BUFFER_MASK - parameter used for interfacing with IAP */ |
|
198 |
/* EE_REC_SIZE - ee_data structure size in bytes */ |
|
199 |
/* EE_SEC_L - micro's Flash sector where EEPROM begins */ |
|
200 |
/* EE_SEC_H - micro's Flash sector where EEPROM ends */ |
|
201 |
/* EE_CCLK - micro's system clock (cclk) */ |
|
202 |
/* */ |
|
203 |
/* description: */ |
|
204 |
/* This function writes a single structure of ee_data type into the */ |
|
205 |
/* EEPROM using an In Application Programming (IAP) routines (see */ |
|
206 |
/* User Manual for more details). command_ee contains an address of */ |
|
207 |
/* this structure. EEPROM is scanned for the last (if any) record */ |
|
208 |
/* identifier (EE_REC_ID), and a new record is added next to it. */ |
|
209 |
/* Also, this function disables all interrupts while erasing the */ |
|
210 |
/* EEPROM. If this is not needed, three lines of the ee_write */ |
|
211 |
/* subroutine can simply be commented-out without affecting the */ |
|
212 |
/* routine performance at all. */ |
|
213 |
/* */ |
|
214 |
/* revision history: */ |
|
215 |
/* - Rev. 1.1 fixes a bug related to verifying a content written into */ |
|
216 |
/* the EEPROM. 1.0 was reporting missmatch even when there were no */ |
|
217 |
/* problems at all. */ |
|
218 |
/* Rev. 1.1 adds interrupt disable feature. */ |
|
219 |
/* */ |
|
220 |
/************************************************************************/ |
|
221 |
||
222 |
void ee_write_page(unsigned int addr) |
|
223 |
{ |
|
224 |
unsigned long int enabled_interrupts; |
|
225 |
// unsigned char ee_buffer[16]; |
|
226 |
unsigned int command_iap[5], result_iap[3]; |
|
227 |
||
228 |
enabled_interrupts = VICIntEnable; //disable all interrupts |
|
229 |
VICIntEnClr = enabled_interrupts; |
|
230 |
||
231 |
iap_entry = (IAP) IAP_LOCATION; |
|
232 |
||
233 |
// prepare sectors from EE_SEC_L to EE_SEC_H for erase |
|
234 |
command_iap[0] = 50; |
|
235 |
command_iap[1] = EE_SEC_L; |
|
236 |
command_iap[2] = EE_SEC_H; |
|
237 |
iap_entry(command_iap, result_iap); |
|
238 |
||
239 |
// copy RAM to flash/eeprom |
|
240 |
command_iap[0] = 51; |
|
241 |
command_iap[1] = (unsigned int) (addr & EE_START_MASK); // 256 kb boundary |
|
242 |
command_iap[2] = (unsigned int) (data_page); // should be on a word boundary |
|
243 |
command_iap[3] = 256; |
|
244 |
command_iap[4] = EE_CCLK; |
|
245 |
iap_entry(command_iap, result_iap); |
|
246 |
||
247 |
#if 0 |
|
248 |
// compare RAM and flash/eeprom |
|
249 |
command_iap[0] = 56; |
|
250 |
command_iap[1] = (unsigned int) data; |
|
251 |
command_iap[2] = addr; |
|
252 |
command_iap[3] = dlen; |
|
253 |
iap_entry(command_iap, result_iap); |
|
254 |
#endif |
|
255 |
||
256 |
VICIntEnable = enabled_interrupts; //restore interrupt enable register |
|
257 |
} |
|
258 |
||
259 |
||
260 |
/************************************************************************/ |
|
261 |
/* */ |
|
262 |
/* function: */ |
|
263 |
/* void ee_read(unsigned int command_ee,unsigned int result_ee[]) */ |
|
264 |
/* */ |
|
265 |
/* type: void */ |
|
266 |
/* */ |
|
267 |
/* parameters: */ |
|
268 |
/* command_ee - Not used. */ |
|
269 |
/* result_ee[0] - Returns a response. */ |
|
270 |
/* 0 - data successfully found in EEPROM. */ |
|
271 |
/* 500 - no data/records available in EEPROM. */ |
|
272 |
/* result_ee[1] - an address of the last record of ee_data type */ |
|
273 |
/* in EEPROM. */ |
|
274 |
/* */ |
|
275 |
/* version: 1.1 (01/27/2006) */ |
|
276 |
/* */ |
|
277 |
/* constants defined in LPC2k_ee.h used in this function: */ |
|
278 |
/* NO_RECORDS_AVAILABLE - EEPROM is empty/no records identifiable */ |
|
279 |
/* with a record identifier (EE_REC_ID) found */ |
|
280 |
/* EE_ADR_L - micro's Flash address from where EEPROM begins */ |
|
281 |
/* EE_REC_SIZE - size (in bytes) of a ee_data structure */ |
|
282 |
/* */ |
|
283 |
/* description: */ |
|
284 |
/* This function scans an EEPROM content looking for the last record */ |
|
285 |
/* that can be identified with a record identifier (EE_REC_ID). When */ |
|
286 |
/* such data is found, its address is passed as result_ee[1]. */ |
|
287 |
/* */ |
|
288 |
/* revision history: */ |
|
289 |
/* - Rev. 1.0 had problems with accessing the last record in a fully */ |
|
290 |
/* occupied EEPROM. Rev. 1.1 fixes this. */ |
|
291 |
/* */ |
|
292 |
/************************************************************************/ |
|
293 |
void ee_read_page(unsigned int addr) |
|
294 |
{ |
|
295 |
memcpy(data_page, (unsigned int *)addr, sizeof(unsigned int)*64); |
|
296 |
} |
|
297 |
||
298 |
||
299 |
////////////////////////////////////////////////////////////////////////////////////////// |
|
300 |
////////////////////////////////////////////////////////////////////////////////////////// |
|
301 |
||
302 |
||
303 |
/* |
|
304 |
CAN FESTIVAL interface functions |
|
305 |
*/ |
|
306 |
||
307 |
||
308 |
int _get_data_len(int type) |
|
309 |
{ |
|
310 |
int len = 0; /* number of bytes */ |
|
311 |
switch(type) |
|
312 |
{ |
|
313 |
case boolean: |
|
314 |
len = 1; |
|
315 |
break; |
|
316 |
||
317 |
case int8: |
|
318 |
case uint8: |
|
319 |
len = 1; |
|
320 |
break; |
|
321 |
case int16: |
|
322 |
case uint16: |
|
323 |
len = 2; |
|
324 |
break; |
|
325 |
case int24: |
|
326 |
case uint24: |
|
327 |
len = 3; |
|
328 |
break; |
|
329 |
case int32: |
|
330 |
case uint32: |
|
331 |
case real32: |
|
332 |
len = 4; |
|
333 |
break; |
|
334 |
case int40: |
|
335 |
case uint40: |
|
336 |
len = 5; |
|
337 |
break; |
|
338 |
case int48: |
|
339 |
case uint48: |
|
340 |
len = 6; |
|
341 |
break; |
|
342 |
case int56: |
|
343 |
case uint56: |
|
344 |
len = 7; |
|
345 |
break; |
|
346 |
case int64: |
|
347 |
case uint64: |
|
348 |
case real64: |
|
349 |
len = 8; |
|
350 |
break; |
|
351 |
#if 0 |
|
352 |
/* TO DO */ |
|
353 |
case visible_string: |
|
354 |
case octet_string: |
|
355 |
case unicode_string: |
|
356 |
case time_of_day: |
|
357 |
case time_difference: |
|
358 |
#endif |
|
359 |
} |
|
360 |
||
361 |
return len; |
|
362 |
} |
|
363 |
||
364 |
||
365 |