author | edouard |
Fri, 10 Sep 2010 13:43:17 +0200 | |
changeset 625 | 5482b98e82a3 |
parent 381 | 854c43cdc24a |
permissions | -rw-r--r-- |
0 | 1 |
/* |
2 |
This file is part of CanFestival, a library implementing CanOpen Stack. |
|
3 |
||
4 |
Copyright (C): Edouard TISSERANT and Francis DUPIN |
|
5 |
||
6 |
See COPYING file for copyrights details. |
|
7 |
||
8 |
This library is free software; you can redistribute it and/or |
|
9 |
modify it under the terms of the GNU Lesser General Public |
|
10 |
License as published by the Free Software Foundation; either |
|
11 |
version 2.1 of the License, or (at your option) any later version. |
|
12 |
||
13 |
This library is distributed in the hope that it will be useful, |
|
14 |
but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
15 |
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
|
16 |
Lesser General Public License for more details. |
|
17 |
||
18 |
You should have received a copy of the GNU Lesser General Public |
|
19 |
License along with this library; if not, write to the Free Software |
|
20 |
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
|
21 |
*/ |
|
22 |
||
23 |
#include "Slave.h" |
|
24 |
#include "Master.h" |
|
25 |
#include "TestMasterSlave.h" |
|
26 |
||
343 | 27 |
extern s_BOARD SlaveBoard; |
0 | 28 |
/*****************************************************************************/ |
378
d2abf6c8c27b
As requested long ago, added CoData* parameter to all this applications callback, let application designer use identical callback for multiple nodes, and reduce source code length.
etisserant
parents:
343
diff
changeset
|
29 |
void TestSlave_heartbeatError(CO_Data* d, UNS8 heartbeatID) |
0 | 30 |
{ |
31 |
eprintf("TestSlave_heartbeatError %d\n", heartbeatID); |
|
32 |
} |
|
33 |
||
378
d2abf6c8c27b
As requested long ago, added CoData* parameter to all this applications callback, let application designer use identical callback for multiple nodes, and reduce source code length.
etisserant
parents:
343
diff
changeset
|
34 |
void TestSlave_initialisation(CO_Data* d) |
0 | 35 |
{ |
36 |
eprintf("TestSlave_initialisation\n"); |
|
37 |
} |
|
38 |
||
378
d2abf6c8c27b
As requested long ago, added CoData* parameter to all this applications callback, let application designer use identical callback for multiple nodes, and reduce source code length.
etisserant
parents:
343
diff
changeset
|
39 |
void TestSlave_preOperational(CO_Data* d) |
0 | 40 |
{ |
41 |
eprintf("TestSlave_preOperational\n"); |
|
42 |
} |
|
43 |
||
378
d2abf6c8c27b
As requested long ago, added CoData* parameter to all this applications callback, let application designer use identical callback for multiple nodes, and reduce source code length.
etisserant
parents:
343
diff
changeset
|
44 |
void TestSlave_operational(CO_Data* d) |
0 | 45 |
{ |
46 |
eprintf("TestSlave_operational\n"); |
|
47 |
} |
|
48 |
||
378
d2abf6c8c27b
As requested long ago, added CoData* parameter to all this applications callback, let application designer use identical callback for multiple nodes, and reduce source code length.
etisserant
parents:
343
diff
changeset
|
49 |
void TestSlave_stopped(CO_Data* d) |
0 | 50 |
{ |
51 |
eprintf("TestSlave_stopped\n"); |
|
52 |
} |
|
53 |
||
378
d2abf6c8c27b
As requested long ago, added CoData* parameter to all this applications callback, let application designer use identical callback for multiple nodes, and reduce source code length.
etisserant
parents:
343
diff
changeset
|
54 |
void TestSlave_post_sync(CO_Data* d) |
0 | 55 |
{ |
56 |
eprintf("TestSlave_post_sync\n"); |
|
201 | 57 |
|
58 |
SlaveMap1=1; |
|
59 |
SlaveMap2=1; |
|
60 |
SlaveMap3=0; |
|
61 |
SlaveMap4=0; |
|
62 |
SlaveMap5=1; |
|
63 |
SlaveMap6=0; |
|
64 |
SlaveMap7=1; |
|
65 |
SlaveMap8=0; |
|
66 |
SlaveMap9=16; |
|
67 |
SlaveMap10 = 0xff00ff00; |
|
68 |
SlaveMap11 = 0xabcd; |
|
236
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
69 |
SlaveMap12 += SlaveMap12 > 0x80 ? 0 : 1; |
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
70 |
eprintf("Slave: %d %d %d %d %d %d %d %d %d %x %x %d %d \n", |
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
71 |
SlaveMap1, |
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
72 |
SlaveMap2, |
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
73 |
SlaveMap3, |
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
74 |
SlaveMap4, |
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
75 |
SlaveMap5, |
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
76 |
SlaveMap6, |
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
77 |
SlaveMap7, |
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
78 |
SlaveMap8, |
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
79 |
SlaveMap9, |
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
80 |
SlaveMap10, |
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
81 |
SlaveMap11, |
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
82 |
SlaveMap12, |
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
83 |
SlaveMap13); |
0 | 84 |
} |
85 |
||
378
d2abf6c8c27b
As requested long ago, added CoData* parameter to all this applications callback, let application designer use identical callback for multiple nodes, and reduce source code length.
etisserant
parents:
343
diff
changeset
|
86 |
void TestSlave_post_TPDO(CO_Data* d) |
0 | 87 |
{ |
236
905677ed00f3
Full preliminary implementation of TPDO transmit type:
etisserant
parents:
201
diff
changeset
|
88 |
SlaveMap13 += 1; |
0 | 89 |
eprintf("TestSlave_post_TPDO\n"); |
284 | 90 |
|
91 |
/* send an error and recover inmediately every 12 cycles */ |
|
92 |
if(SlaveMap13 % 12 == 0) |
|
93 |
{ |
|
296
03f2b8b8cb0b
Solved a small bug in emcy.c (errRegMask was always '1' in EMCY_setError.
luis
parents:
284
diff
changeset
|
94 |
EMCY_setError(&TestSlave_Data, 0x4200, 0x08, 0x0000); |
284 | 95 |
EMCY_errorRecovered(&TestSlave_Data, 0x4200); |
96 |
} |
|
0 | 97 |
} |
161
c4908cc776a9
SetODEntry now call CO_data->storeODSubEntry(Index,SubIndex) for variables to be Stored (when column Save==True in GUI)
etisserant
parents:
149
diff
changeset
|
98 |
|
378
d2abf6c8c27b
As requested long ago, added CoData* parameter to all this applications callback, let application designer use identical callback for multiple nodes, and reduce source code length.
etisserant
parents:
343
diff
changeset
|
99 |
void TestSlave_storeODSubIndex(CO_Data* d, UNS16 wIndex, UNS8 bSubindex) |
161
c4908cc776a9
SetODEntry now call CO_data->storeODSubEntry(Index,SubIndex) for variables to be Stored (when column Save==True in GUI)
etisserant
parents:
149
diff
changeset
|
100 |
{ |
c4908cc776a9
SetODEntry now call CO_data->storeODSubEntry(Index,SubIndex) for variables to be Stored (when column Save==True in GUI)
etisserant
parents:
149
diff
changeset
|
101 |
/*TODO : |
c4908cc776a9
SetODEntry now call CO_data->storeODSubEntry(Index,SubIndex) for variables to be Stored (when column Save==True in GUI)
etisserant
parents:
149
diff
changeset
|
102 |
* - call getODEntry for index and subindex, |
c4908cc776a9
SetODEntry now call CO_data->storeODSubEntry(Index,SubIndex) for variables to be Stored (when column Save==True in GUI)
etisserant
parents:
149
diff
changeset
|
103 |
* - save content to file, database, flash, nvram, ... |
c4908cc776a9
SetODEntry now call CO_data->storeODSubEntry(Index,SubIndex) for variables to be Stored (when column Save==True in GUI)
etisserant
parents:
149
diff
changeset
|
104 |
* |
c4908cc776a9
SetODEntry now call CO_data->storeODSubEntry(Index,SubIndex) for variables to be Stored (when column Save==True in GUI)
etisserant
parents:
149
diff
changeset
|
105 |
* To ease flash organisation, index of variable to store |
c4908cc776a9
SetODEntry now call CO_data->storeODSubEntry(Index,SubIndex) for variables to be Stored (when column Save==True in GUI)
etisserant
parents:
149
diff
changeset
|
106 |
* can be established by scanning d->objdict[d->ObjdictSize] |
c4908cc776a9
SetODEntry now call CO_data->storeODSubEntry(Index,SubIndex) for variables to be Stored (when column Save==True in GUI)
etisserant
parents:
149
diff
changeset
|
107 |
* for variables to store. |
c4908cc776a9
SetODEntry now call CO_data->storeODSubEntry(Index,SubIndex) for variables to be Stored (when column Save==True in GUI)
etisserant
parents:
149
diff
changeset
|
108 |
* |
c4908cc776a9
SetODEntry now call CO_data->storeODSubEntry(Index,SubIndex) for variables to be Stored (when column Save==True in GUI)
etisserant
parents:
149
diff
changeset
|
109 |
* */ |
c4908cc776a9
SetODEntry now call CO_data->storeODSubEntry(Index,SubIndex) for variables to be Stored (when column Save==True in GUI)
etisserant
parents:
149
diff
changeset
|
110 |
eprintf("TestSlave_storeODSubIndex : %4.4x %2.2x\n", wIndex, bSubindex); |
c4908cc776a9
SetODEntry now call CO_data->storeODSubEntry(Index,SubIndex) for variables to be Stored (when column Save==True in GUI)
etisserant
parents:
149
diff
changeset
|
111 |
} |
284 | 112 |
|
378
d2abf6c8c27b
As requested long ago, added CoData* parameter to all this applications callback, let application designer use identical callback for multiple nodes, and reduce source code length.
etisserant
parents:
343
diff
changeset
|
113 |
void TestSlave_post_emcy(CO_Data* d, UNS8 nodeID, UNS16 errCode, UNS8 errReg) |
284 | 114 |
{ |
115 |
eprintf("Slave received EMCY message. Node: %2.2x ErrorCode: %4.4x ErrorRegister: %2.2x\n", nodeID, errCode, errReg); |
|
116 |
} |