|
207
|
1 |
<!DOCTYPE HTML PUBLIC "-//W3C//DTD HTML 4.01 Transitional//EN">
|
|
|
2 |
<html><head><meta http-equiv="Content-Type" content="text/html;charset=iso-8859-1">
|
|
215
|
3 |
<title>CanFestival: src/nmtSlave.c Source File</title>
|
|
207
|
4 |
<link href="doxygen.css" rel="stylesheet" type="text/css">
|
|
|
5 |
<link href="tabs.css" rel="stylesheet" type="text/css">
|
|
|
6 |
</head><body>
|
|
|
7 |
<!-- Generated by Doxygen 1.5.1 -->
|
|
|
8 |
<div class="tabs">
|
|
|
9 |
<ul>
|
|
|
10 |
<li><a href="main.html"><span>Main Page</span></a></li>
|
|
215
|
11 |
<li><a href="annotated.html"><span>Data Structures</span></a></li>
|
|
207
|
12 |
<li id="current"><a href="files.html"><span>Files</span></a></li>
|
|
215
|
13 |
<li><a href="dirs.html"><span>Directories</span></a></li>
|
|
207
|
14 |
</ul></div>
|
|
|
15 |
<div class="tabs">
|
|
|
16 |
<ul>
|
|
|
17 |
<li><a href="files.html"><span>File List</span></a></li>
|
|
|
18 |
<li><a href="globals.html"><span>Globals</span></a></li>
|
|
|
19 |
</ul></div>
|
|
215
|
20 |
<div class="nav">
|
|
240
|
21 |
<a class="el" href="dir_0aa10e4f705947227e11e7ccb081fbe4.html">src</a></div>
|
|
215
|
22 |
<h1>nmtSlave.c</h1><a href="nmtSlave_8c.html">Go to the documentation of this file.</a><div class="fragment"><pre class="fragment"><a name="l00001"></a>00001 <span class="comment">/*</span>
|
|
210
|
23 |
<a name="l00002"></a>00002 <span class="comment"> This file is part of CanFestival, a library implementing CanOpen</span>
|
|
|
24 |
<a name="l00003"></a>00003 <span class="comment"> Stack.</span>
|
|
|
25 |
<a name="l00004"></a>00004 <span class="comment"></span>
|
|
|
26 |
<a name="l00005"></a>00005 <span class="comment"> Copyright (C): Edouard TISSERANT and Francis DUPIN</span>
|
|
|
27 |
<a name="l00006"></a>00006 <span class="comment"></span>
|
|
|
28 |
<a name="l00007"></a>00007 <span class="comment"> See COPYING file for copyrights details.</span>
|
|
|
29 |
<a name="l00008"></a>00008 <span class="comment"></span>
|
|
|
30 |
<a name="l00009"></a>00009 <span class="comment"> This library is free software; you can redistribute it and/or</span>
|
|
|
31 |
<a name="l00010"></a>00010 <span class="comment"> modify it under the terms of the GNU Lesser General Public</span>
|
|
|
32 |
<a name="l00011"></a>00011 <span class="comment"> License as published by the Free Software Foundation; either</span>
|
|
|
33 |
<a name="l00012"></a>00012 <span class="comment"> version 2.1 of the License, or (at your option) any later version.</span>
|
|
|
34 |
<a name="l00013"></a>00013 <span class="comment"></span>
|
|
|
35 |
<a name="l00014"></a>00014 <span class="comment"> This library is distributed in the hope that it will be useful,</span>
|
|
|
36 |
<a name="l00015"></a>00015 <span class="comment"> but WITHOUT ANY WARRANTY; without even the implied warranty of</span>
|
|
|
37 |
<a name="l00016"></a>00016 <span class="comment"> MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU</span>
|
|
|
38 |
<a name="l00017"></a>00017 <span class="comment"> Lesser General Public License for more details.</span>
|
|
|
39 |
<a name="l00018"></a>00018 <span class="comment"></span>
|
|
|
40 |
<a name="l00019"></a>00019 <span class="comment"> You should have received a copy of the GNU Lesser General Public</span>
|
|
|
41 |
<a name="l00020"></a>00020 <span class="comment"> License along with this library; if not, write to the Free Software</span>
|
|
|
42 |
<a name="l00021"></a>00021 <span class="comment"> Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307</span>
|
|
|
43 |
<a name="l00022"></a>00022 <span class="comment"> USA</span>
|
|
|
44 |
<a name="l00023"></a>00023 <span class="comment">*/</span>
|
|
215
|
45 |
<a name="l00033"></a>00033 <span class="preprocessor">#include "<a class="code" href="nmtSlave_8h.html">nmtSlave.h</a>"</span>
|
|
|
46 |
<a name="l00034"></a>00034 <span class="preprocessor">#include "<a class="code" href="states_8h.html">states.h</a>"</span>
|
|
|
47 |
<a name="l00035"></a>00035 <span class="preprocessor">#include "<a class="code" href="win32_2canfestival_8h.html">canfestival.h</a>"</span>
|
|
210
|
48 |
<a name="l00036"></a>00036
|
|
240
|
49 |
<a name="l00043"></a><a class="code" href="nmtSlave_8h.html#078a76722e34eb36a14a39ecf16f3a9d">00043</a> <span class="keywordtype">void</span> <a class="code" href="nmtSlave_8c.html#078a76722e34eb36a14a39ecf16f3a9d">proceedNMTstateChange</a>(<a class="code" href="structstruct__CO__Data.html">CO_Data</a>* <a class="code" href="structstruct__s__timer__entry.html#1f47508e63fb89e692b98e178a78268f">d</a>, <a class="code" href="structMessage.html">Message</a> *m)
|
|
210
|
50 |
<a name="l00044"></a>00044 {
|
|
240
|
51 |
<a name="l00045"></a>00045 <span class="keywordflow">if</span>( <a class="code" href="structstruct__s__timer__entry.html#1f47508e63fb89e692b98e178a78268f">d</a>-><a class="code" href="structstruct__CO__Data.html#78dee6c41f9e1240059a427185dd4eed">nodeState</a> == <a class="code" href="states_8h.html#80401a8f6d29787e07427b2baf630538aa3d4da3fd99f3a79599fa514561754a">Pre_operational</a> ||
|
|
|
52 |
<a name="l00046"></a>00046 <a class="code" href="structstruct__s__timer__entry.html#1f47508e63fb89e692b98e178a78268f">d</a>-><a class="code" href="structstruct__CO__Data.html#78dee6c41f9e1240059a427185dd4eed">nodeState</a> == <a class="code" href="states_8h.html#80401a8f6d29787e07427b2baf63053824952153680b2c826995af50d0b16aea">Operational</a> ||
|
|
|
53 |
<a name="l00047"></a>00047 <a class="code" href="structstruct__s__timer__entry.html#1f47508e63fb89e692b98e178a78268f">d</a>-><a class="code" href="structstruct__CO__Data.html#78dee6c41f9e1240059a427185dd4eed">nodeState</a> == <a class="code" href="states_8h.html#80401a8f6d29787e07427b2baf63053853c74ac440bbf6af2cb67759d3cd8f0a">Stopped</a> ) {
|
|
210
|
54 |
<a name="l00048"></a>00048
|
|
240
|
55 |
<a name="l00049"></a>00049 <a class="code" href="hcs12_2applicfg_8h.html#d5dffc889e623fbc4f635e69276cdf20">MSG_WAR</a>(0x3400, <span class="stringliteral">"NMT received. for node : "</span>, (*m).data[1]);
|
|
210
|
56 |
<a name="l00050"></a>00050
|
|
215
|
57 |
<a name="l00051"></a>00051 <span class="comment">/* Check if this NMT-message is for this node */</span>
|
|
|
58 |
<a name="l00052"></a>00052 <span class="comment">/* byte 1 = 0 : all the nodes are concerned (broadcast) */</span>
|
|
|
59 |
<a name="l00053"></a>00053
|
|
240
|
60 |
<a name="l00054"></a>00054 <span class="keywordflow">if</span>( ( (*m).data[1] == 0 ) || ( (*m).data[1] == *<a class="code" href="structstruct__s__timer__entry.html#1f47508e63fb89e692b98e178a78268f">d</a>-><a class="code" href="structstruct__CO__Data.html#fac5e8371034640ad38d6833262d94df">bDeviceNodeId</a> ) ){
|
|
210
|
61 |
<a name="l00055"></a>00055
|
|
215
|
62 |
<a name="l00056"></a>00056 <span class="keywordflow">switch</span>( (*m).data[0]){ <span class="comment">/* command specifier (cs) */</span>
|
|
240
|
63 |
<a name="l00057"></a>00057 <span class="keywordflow">case</span> <a class="code" href="def_8h.html#4467d5b0f948367d4ecf26aa2a98c221">NMT_Start_Node</a>:
|
|
|
64 |
<a name="l00058"></a>00058 <span class="keywordflow">if</span> ( (<a class="code" href="structstruct__s__timer__entry.html#1f47508e63fb89e692b98e178a78268f">d</a>-><a class="code" href="structstruct__CO__Data.html#78dee6c41f9e1240059a427185dd4eed">nodeState</a> == <a class="code" href="states_8h.html#80401a8f6d29787e07427b2baf630538aa3d4da3fd99f3a79599fa514561754a">Pre_operational</a>) || (<a class="code" href="structstruct__s__timer__entry.html#1f47508e63fb89e692b98e178a78268f">d</a>-><a class="code" href="structstruct__CO__Data.html#78dee6c41f9e1240059a427185dd4eed">nodeState</a> == <a class="code" href="states_8h.html#80401a8f6d29787e07427b2baf63053853c74ac440bbf6af2cb67759d3cd8f0a">Stopped</a>) )
|
|
|
65 |
<a name="l00059"></a>00059 <a class="code" href="states_8c.html#cfb53d66c2360cd55b1d968f0e5c270f">setState</a>(<a class="code" href="structstruct__s__timer__entry.html#1f47508e63fb89e692b98e178a78268f">d</a>,<a class="code" href="states_8h.html#80401a8f6d29787e07427b2baf63053824952153680b2c826995af50d0b16aea">Operational</a>);
|
|
210
|
66 |
<a name="l00060"></a>00060 <span class="keywordflow">break</span>;
|
|
|
67 |
<a name="l00061"></a>00061
|
|
240
|
68 |
<a name="l00062"></a>00062 <span class="keywordflow">case</span> <a class="code" href="def_8h.html#0d1997bb9a500ca3e400bf4ca6428044">NMT_Stop_Node</a>:
|
|
|
69 |
<a name="l00063"></a>00063 <span class="keywordflow">if</span> ( d->nodeState == <a class="code" href="states_8h.html#80401a8f6d29787e07427b2baf630538aa3d4da3fd99f3a79599fa514561754a">Pre_operational</a> ||
|
|
|
70 |
<a name="l00064"></a>00064 d->nodeState == <a class="code" href="states_8h.html#80401a8f6d29787e07427b2baf63053824952153680b2c826995af50d0b16aea">Operational</a> )
|
|
|
71 |
<a name="l00065"></a>00065 <a class="code" href="states_8c.html#cfb53d66c2360cd55b1d968f0e5c270f">setState</a>(d,<a class="code" href="states_8h.html#80401a8f6d29787e07427b2baf63053853c74ac440bbf6af2cb67759d3cd8f0a">Stopped</a>);
|
|
207
|
72 |
<a name="l00066"></a>00066 <span class="keywordflow">break</span>;
|
|
210
|
73 |
<a name="l00067"></a>00067
|
|
240
|
74 |
<a name="l00068"></a>00068 <span class="keywordflow">case</span> <a class="code" href="def_8h.html#9a0e4ffea03086317e76fc1c80206197">NMT_Enter_PreOperational</a>:
|
|
|
75 |
<a name="l00069"></a>00069 <span class="keywordflow">if</span> ( d->nodeState == <a class="code" href="states_8h.html#80401a8f6d29787e07427b2baf63053824952153680b2c826995af50d0b16aea">Operational</a> ||
|
|
|
76 |
<a name="l00070"></a>00070 d->nodeState == <a class="code" href="states_8h.html#80401a8f6d29787e07427b2baf63053853c74ac440bbf6af2cb67759d3cd8f0a">Stopped</a> )
|
|
|
77 |
<a name="l00071"></a>00071 <a class="code" href="states_8c.html#cfb53d66c2360cd55b1d968f0e5c270f">setState</a>(d,<a class="code" href="states_8h.html#80401a8f6d29787e07427b2baf630538aa3d4da3fd99f3a79599fa514561754a">Pre_operational</a>);
|
|
210
|
78 |
<a name="l00072"></a>00072 <span class="keywordflow">break</span>;
|
|
207
|
79 |
<a name="l00073"></a>00073
|
|
240
|
80 |
<a name="l00074"></a>00074 <span class="keywordflow">case</span> <a class="code" href="def_8h.html#a74bd7065a5e72d9fefb3b24c239bcab">NMT_Reset_Node</a>:
|
|
|
81 |
<a name="l00075"></a>00075 <a class="code" href="states_8c.html#cfb53d66c2360cd55b1d968f0e5c270f">setState</a>(d,<a class="code" href="states_8h.html#80401a8f6d29787e07427b2baf630538de69e6bdd47a9d7dae023237acdaad5e">Initialisation</a>);
|
|
210
|
82 |
<a name="l00076"></a>00076 <span class="keywordflow">break</span>;
|
|
|
83 |
<a name="l00077"></a>00077
|
|
240
|
84 |
<a name="l00078"></a>00078 <span class="keywordflow">case</span> <a class="code" href="def_8h.html#fa643307076987b713c73a755296142e">NMT_Reset_Comunication</a>:
|
|
|
85 |
<a name="l00079"></a>00079 <a class="code" href="states_8c.html#cfb53d66c2360cd55b1d968f0e5c270f">setState</a>(d,<a class="code" href="states_8h.html#80401a8f6d29787e07427b2baf630538de69e6bdd47a9d7dae023237acdaad5e">Initialisation</a>);
|
|
210
|
86 |
<a name="l00080"></a>00080 <span class="keywordflow">break</span>;
|
|
|
87 |
<a name="l00081"></a>00081
|
|
215
|
88 |
<a name="l00082"></a>00082 }<span class="comment">/* end switch */</span>
|
|
|
89 |
<a name="l00083"></a>00083
|
|
|
90 |
<a name="l00084"></a>00084 }<span class="comment">/* end if( ( (*m).data[1] == 0 ) || ( (*m).data[1] ==</span>
|
|
|
91 |
<a name="l00085"></a>00085 <span class="comment"> bDeviceNodeId ) ) */</span>
|
|
210
|
92 |
<a name="l00086"></a>00086 }
|
|
|
93 |
<a name="l00087"></a>00087 }
|
|
|
94 |
<a name="l00088"></a>00088
|
|
|
95 |
<a name="l00089"></a>00089
|
|
240
|
96 |
<a name="l00097"></a><a class="code" href="nmtSlave_8h.html#29f6eed8d34859710f7e603a1fc0d9d1">00097</a> <a class="code" href="hcs12_2applicfg_8h.html#c2e754635928189b98cf3f5b7e6dbffb">UNS8</a> <a class="code" href="nmtSlave_8c.html#29f6eed8d34859710f7e603a1fc0d9d1">slaveSendBootUp</a>(<a class="code" href="structstruct__CO__Data.html">CO_Data</a>* <a class="code" href="structstruct__s__timer__entry.html#1f47508e63fb89e692b98e178a78268f">d</a>)
|
|
210
|
97 |
<a name="l00098"></a>00098 {
|
|
215
|
98 |
<a name="l00099"></a>00099 <a class="code" href="structMessage.html">Message</a> m;
|
|
210
|
99 |
<a name="l00100"></a>00100
|
|
240
|
100 |
<a name="l00101"></a>00101 <a class="code" href="hcs12_2applicfg_8h.html#d5dffc889e623fbc4f635e69276cdf20">MSG_WAR</a>(0x3407, <span class="stringliteral">"Send a Boot-Up msg "</span>, 0);
|
|
210
|
101 |
<a name="l00102"></a>00102
|
|
215
|
102 |
<a name="l00103"></a>00103 <span class="comment">/* message configuration */</span>
|
|
240
|
103 |
<a name="l00104"></a>00104 m.<a class="code" href="structMessage.html#21cda7edcf0800d296151c83e7f9948e">cob_id</a>.<a class="code" href="structSHORT__CAN.html#e77854035fa72dc0769724a2d056bc9d">w</a> = <a class="code" href="def_8h.html#e7e02f70bb48a2747c6496fdcf0f1b95">NODE_GUARD</a> << 7 | *<a class="code" href="structstruct__s__timer__entry.html#1f47508e63fb89e692b98e178a78268f">d</a>-><a class="code" href="structstruct__CO__Data.html#fac5e8371034640ad38d6833262d94df">bDeviceNodeId</a>;
|
|
|
104 |
<a name="l00105"></a>00105 m.<a class="code" href="structMessage.html#4fea58e2ceec365228be253ba3d8bdba">rtr</a> = <a class="code" href="def_8h.html#b6a4c86a352c3ac564dae3767c7524f3">NOT_A_REQUEST</a>;
|
|
|
105 |
<a name="l00106"></a>00106 m.<a class="code" href="structMessage.html#a8c32de83f67079897508203c8e2198c">len</a> = 1;
|
|
|
106 |
<a name="l00107"></a>00107 m.<a class="code" href="structMessage.html#9f53ff2fea190c14dd66e2c92a32ec45">data</a>[0] = 0x00;
|
|
210
|
107 |
<a name="l00108"></a>00108
|
|
240
|
108 |
<a name="l00109"></a>00109 <span class="keywordflow">return</span> <a class="code" href="canOpenDriver_8c.html#fab789b9b2ee0ab6c6f27e67d6c03661">canSend</a>(<a class="code" href="structstruct__s__timer__entry.html#1f47508e63fb89e692b98e178a78268f">d</a>-><a class="code" href="structstruct__CO__Data.html#05c8d7a0518b95971818a9c612f8b9c0">canHandle</a>,&m);
|
|
210
|
109 |
<a name="l00110"></a>00110 }
|
|
|
110 |
<a name="l00111"></a>00111
|
|
240
|
111 |
</pre></div><hr size="1"><address style="align: right;"><small>Generated on Mon Jul 2 19:10:16 2007 for CanFestival by
|
|
207
|
112 |
<a href="http://www.doxygen.org/index.html">
|
|
|
113 |
<img src="doxygen.png" alt="doxygen" align="middle" border="0"></a> 1.5.1 </small></address>
|
|
|
114 |
</body>
|
|
|
115 |
</html>
|