]>
Commit | Line | Data |
---|---|---|
9d7164cf DK |
1 | /**************************************************************************** |
2 | ||
3 | (c) SYSTEC electronic GmbH, D-07973 Greiz, August-Bebel-Str. 29 | |
4 | www.systec-electronic.com | |
5 | ||
6 | Project: openPOWERLINK | |
7 | ||
8 | Description: source file for generic EPL API module | |
9 | ||
10 | License: | |
11 | ||
12 | Redistribution and use in source and binary forms, with or without | |
13 | modification, are permitted provided that the following conditions | |
14 | are met: | |
15 | ||
16 | 1. Redistributions of source code must retain the above copyright | |
17 | notice, this list of conditions and the following disclaimer. | |
18 | ||
19 | 2. Redistributions in binary form must reproduce the above copyright | |
20 | notice, this list of conditions and the following disclaimer in the | |
21 | documentation and/or other materials provided with the distribution. | |
22 | ||
23 | 3. Neither the name of SYSTEC electronic GmbH nor the names of its | |
24 | contributors may be used to endorse or promote products derived | |
25 | from this software without prior written permission. For written | |
26 | permission, please contact info@systec-electronic.com. | |
27 | ||
28 | THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS | |
29 | "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT | |
30 | LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS | |
31 | FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE | |
32 | COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, | |
33 | INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, | |
34 | BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; | |
35 | LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER | |
36 | CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT | |
37 | LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN | |
38 | ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE | |
39 | POSSIBILITY OF SUCH DAMAGE. | |
40 | ||
41 | Severability Clause: | |
42 | ||
43 | If a provision of this License is or becomes illegal, invalid or | |
44 | unenforceable in any jurisdiction, that shall not affect: | |
45 | 1. the validity or enforceability in that jurisdiction of any other | |
46 | provision of this License; or | |
47 | 2. the validity or enforceability in other jurisdictions of that or | |
48 | any other provision of this License. | |
49 | ||
50 | ------------------------------------------------------------------------- | |
51 | ||
52 | $RCSfile: EplApiGeneric.c,v $ | |
53 | ||
54 | $Author: D.Krueger $ | |
55 | ||
56 | $Revision: 1.21 $ $Date: 2008/11/21 09:00:38 $ | |
57 | ||
58 | $State: Exp $ | |
59 | ||
60 | Build Environment: | |
61 | GCC V3.4 | |
62 | ||
63 | ------------------------------------------------------------------------- | |
64 | ||
65 | Revision History: | |
66 | ||
67 | 2006/09/05 d.k.: start of the implementation, version 1.00 | |
68 | ||
69 | ****************************************************************************/ | |
70 | ||
71 | #include "Epl.h" | |
72 | #include "kernel/EplDllk.h" | |
73 | #include "kernel/EplErrorHandlerk.h" | |
74 | #include "kernel/EplEventk.h" | |
75 | #include "kernel/EplNmtk.h" | |
76 | #include "kernel/EplObdk.h" | |
77 | #include "kernel/EplTimerk.h" | |
78 | #include "kernel/EplDllkCal.h" | |
79 | #include "kernel/EplPdokCal.h" | |
80 | #include "user/EplDlluCal.h" | |
81 | #include "user/EplLedu.h" | |
82 | #include "user/EplNmtCnu.h" | |
83 | #include "user/EplNmtMnu.h" | |
84 | #include "user/EplSdoComu.h" | |
85 | #include "user/EplIdentu.h" | |
86 | #include "user/EplStatusu.h" | |
87 | ||
88 | #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_PDOK)) != 0) | |
89 | #include "kernel/EplPdok.h" | |
90 | #endif | |
91 | ||
92 | #include "SharedBuff.h" | |
93 | ||
9d7164cf DK |
94 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_OBDK)) == 0) |
95 | #error "EPL API layer needs EPL module OBDK!" | |
96 | #endif | |
97 | ||
9d7164cf DK |
98 | /***************************************************************************/ |
99 | /* */ | |
100 | /* */ | |
101 | /* G L O B A L D E F I N I T I O N S */ | |
102 | /* */ | |
103 | /* */ | |
104 | /***************************************************************************/ | |
105 | ||
106 | //--------------------------------------------------------------------------- | |
107 | // const defines | |
108 | //--------------------------------------------------------------------------- | |
109 | ||
110 | //--------------------------------------------------------------------------- | |
111 | // local types | |
112 | //--------------------------------------------------------------------------- | |
113 | ||
114 | //--------------------------------------------------------------------------- | |
115 | // modul globale vars | |
116 | //--------------------------------------------------------------------------- | |
117 | ||
118 | //--------------------------------------------------------------------------- | |
119 | // local function prototypes | |
120 | //--------------------------------------------------------------------------- | |
121 | ||
9d7164cf DK |
122 | /***************************************************************************/ |
123 | /* */ | |
124 | /* */ | |
125 | /* C L A S S EplApi */ | |
126 | /* */ | |
127 | /* */ | |
128 | /***************************************************************************/ | |
129 | // | |
130 | // Description: | |
131 | // | |
132 | // | |
133 | /***************************************************************************/ | |
134 | ||
9d7164cf DK |
135 | //=========================================================================// |
136 | // // | |
137 | // P R I V A T E D E F I N I T I O N S // | |
138 | // // | |
139 | //=========================================================================// | |
140 | ||
141 | //--------------------------------------------------------------------------- | |
142 | // const defines | |
143 | //--------------------------------------------------------------------------- | |
144 | ||
145 | //--------------------------------------------------------------------------- | |
146 | // local types | |
147 | //--------------------------------------------------------------------------- | |
148 | ||
833dfbe7 GKH |
149 | typedef struct { |
150 | tEplApiInitParam m_InitParam; | |
9d7164cf DK |
151 | |
152 | } tEplApiInstance; | |
153 | ||
154 | //--------------------------------------------------------------------------- | |
155 | // local vars | |
156 | //--------------------------------------------------------------------------- | |
157 | ||
833dfbe7 | 158 | static tEplApiInstance EplApiInstance_g; |
9d7164cf DK |
159 | |
160 | //--------------------------------------------------------------------------- | |
161 | // local function prototypes | |
162 | //--------------------------------------------------------------------------- | |
163 | ||
164 | // NMT state change event callback function | |
d10f4699 | 165 | static tEplKernel EplApiCbNmtStateChange(tEplEventNmtStateChange NmtStateChange_p); |
9d7164cf DK |
166 | |
167 | // update DLL configuration from OD | |
d10f4699 | 168 | static tEplKernel EplApiUpdateDllConfig(BOOL fUpdateIdentity_p); |
9d7164cf DK |
169 | |
170 | // update OD from init param | |
d10f4699 | 171 | static tEplKernel EplApiUpdateObd(void); |
9d7164cf DK |
172 | |
173 | // process events from user event queue | |
d10f4699 | 174 | static tEplKernel EplApiProcessEvent(tEplEvent *pEplEvent_p); |
9d7164cf DK |
175 | |
176 | #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOC)) != 0) | |
177 | // callback function of SDO module | |
d10f4699 | 178 | static tEplKernel EplApiCbSdoCon(tEplSdoComFinished *pSdoComFinished_p); |
9d7164cf DK |
179 | #endif |
180 | ||
181 | #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) | |
182 | // callback functions of NmtMnu module | |
d10f4699 GKH |
183 | static tEplKernel EplApiCbNodeEvent(unsigned int uiNodeId_p, |
184 | tEplNmtNodeEvent NodeEvent_p, | |
185 | tEplNmtState NmtState_p, | |
186 | WORD wErrorCode_p, BOOL fMandatory_p); | |
187 | ||
188 | static tEplKernel EplApiCbBootEvent(tEplNmtBootEvent BootEvent_p, | |
189 | tEplNmtState NmtState_p, | |
190 | WORD wErrorCode_p); | |
9d7164cf DK |
191 | #endif |
192 | ||
193 | #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_LEDU)) != 0) | |
194 | // callback function of Ledu module | |
d10f4699 | 195 | static tEplKernel EplApiCbLedStateChange(tEplLedType LedType_p, BOOL fOn_p); |
9d7164cf DK |
196 | #endif |
197 | ||
198 | // OD initialization function (implemented in Objdict.c) | |
d10f4699 | 199 | tEplKernel EplObdInitRam(tEplObdInitParam MEM *pInitParam_p); |
9d7164cf DK |
200 | |
201 | //=========================================================================// | |
202 | // // | |
203 | // P U B L I C F U N C T I O N S // | |
204 | // // | |
205 | //=========================================================================// | |
206 | ||
207 | //--------------------------------------------------------------------------- | |
208 | // | |
209 | // Function: EplApiInitialize() | |
210 | // | |
211 | // Description: add and initialize new instance of EPL stack. | |
212 | // After return from this function the application must start | |
213 | // the NMT state machine via | |
214 | // EplApiExecNmtCommand(kEplNmtEventSwReset) | |
215 | // and thereby the whole EPL stack :-) | |
216 | // | |
217 | // Parameters: pInitParam_p = initialisation parameters | |
218 | // | |
219 | // Returns: tEplKernel = error code | |
220 | // | |
221 | // | |
222 | // State: | |
223 | // | |
224 | //--------------------------------------------------------------------------- | |
225 | ||
d10f4699 | 226 | tEplKernel EplApiInitialize(tEplApiInitParam *pInitParam_p) |
9d7164cf | 227 | { |
833dfbe7 GKH |
228 | tEplKernel Ret = kEplSuccessful; |
229 | tEplObdInitParam ObdInitParam; | |
230 | tEplDllkInitParam DllkInitParam; | |
9d7164cf | 231 | #ifndef EPL_NO_FIFO |
833dfbe7 | 232 | tShbError ShbError; |
9d7164cf DK |
233 | #endif |
234 | ||
833dfbe7 GKH |
235 | // reset instance structure |
236 | EPL_MEMSET(&EplApiInstance_g, 0, sizeof(EplApiInstance_g)); | |
9d7164cf | 237 | |
833dfbe7 GKH |
238 | EPL_MEMCPY(&EplApiInstance_g.m_InitParam, pInitParam_p, |
239 | min(sizeof(tEplApiInitParam), | |
240 | pInitParam_p->m_uiSizeOfStruct)); | |
9d7164cf | 241 | |
833dfbe7 GKH |
242 | // check event callback function pointer |
243 | if (EplApiInstance_g.m_InitParam.m_pfnCbEvent == NULL) { // application must always have an event callback function | |
244 | Ret = kEplApiInvalidParam; | |
245 | goto Exit; | |
246 | } | |
9d7164cf | 247 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_OBDK)) != 0) |
833dfbe7 | 248 | // init OD |
9d7164cf DK |
249 | // FIXME |
250 | // Ret = EplObdInitRam(&ObdInitParam); | |
251 | // if (Ret != kEplSuccessful) | |
252 | // { | |
253 | // goto Exit; | |
254 | // } | |
255 | ||
833dfbe7 GKH |
256 | // initialize EplObd module |
257 | Ret = EplObdInit(&ObdInitParam); | |
258 | if (Ret != kEplSuccessful) { | |
259 | goto Exit; | |
260 | } | |
9d7164cf DK |
261 | #endif |
262 | ||
263 | #ifndef EPL_NO_FIFO | |
833dfbe7 GKH |
264 | ShbError = ShbInit(); |
265 | if (ShbError != kShbOk) { | |
266 | Ret = kEplNoResource; | |
267 | goto Exit; | |
268 | } | |
9d7164cf DK |
269 | #endif |
270 | ||
833dfbe7 GKH |
271 | // initialize EplEventk module |
272 | Ret = EplEventkInit(EplApiInstance_g.m_InitParam.m_pfnCbSync); | |
273 | if (Ret != kEplSuccessful) { | |
274 | goto Exit; | |
275 | } | |
276 | // initialize EplEventu module | |
277 | Ret = EplEventuInit(EplApiProcessEvent); | |
278 | if (Ret != kEplSuccessful) { | |
279 | goto Exit; | |
280 | } | |
281 | // init EplTimerk module | |
282 | Ret = EplTimerkInit(); | |
283 | if (Ret != kEplSuccessful) { | |
284 | goto Exit; | |
285 | } | |
286 | // initialize EplNmtk module before DLL | |
9d7164cf | 287 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTK)) != 0) |
833dfbe7 GKH |
288 | Ret = EplNmtkInit(); |
289 | if (Ret != kEplSuccessful) { | |
290 | goto Exit; | |
291 | } | |
9d7164cf DK |
292 | #endif |
293 | ||
833dfbe7 | 294 | // initialize EplDllk module |
9d7164cf | 295 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLK)) != 0) |
833dfbe7 GKH |
296 | EPL_MEMCPY(DllkInitParam.m_be_abSrcMac, |
297 | EplApiInstance_g.m_InitParam.m_abMacAddress, 6); | |
298 | Ret = EplDllkAddInstance(&DllkInitParam); | |
299 | if (Ret != kEplSuccessful) { | |
300 | goto Exit; | |
301 | } | |
302 | // initialize EplErrorHandlerk module | |
303 | Ret = EplErrorHandlerkInit(); | |
304 | if (Ret != kEplSuccessful) { | |
305 | goto Exit; | |
306 | } | |
307 | // initialize EplDllkCal module | |
308 | Ret = EplDllkCalAddInstance(); | |
309 | if (Ret != kEplSuccessful) { | |
310 | goto Exit; | |
311 | } | |
9d7164cf DK |
312 | #endif |
313 | ||
833dfbe7 | 314 | // initialize EplDlluCal module |
9d7164cf | 315 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLU)) != 0) |
833dfbe7 GKH |
316 | Ret = EplDlluCalAddInstance(); |
317 | if (Ret != kEplSuccessful) { | |
318 | goto Exit; | |
319 | } | |
9d7164cf DK |
320 | #endif |
321 | ||
833dfbe7 | 322 | // initialize EplPdok module |
9d7164cf | 323 | #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_PDOK)) != 0) |
833dfbe7 GKH |
324 | Ret = EplPdokAddInstance(); |
325 | if (Ret != kEplSuccessful) { | |
326 | goto Exit; | |
327 | } | |
328 | ||
329 | Ret = EplPdokCalAddInstance(); | |
330 | if (Ret != kEplSuccessful) { | |
331 | goto Exit; | |
332 | } | |
9d7164cf DK |
333 | #endif |
334 | ||
833dfbe7 | 335 | // initialize EplNmtCnu module |
9d7164cf | 336 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_CN)) != 0) |
833dfbe7 GKH |
337 | Ret = EplNmtCnuAddInstance(EplApiInstance_g.m_InitParam.m_uiNodeId); |
338 | if (Ret != kEplSuccessful) { | |
339 | goto Exit; | |
340 | } | |
9d7164cf DK |
341 | #endif |
342 | ||
833dfbe7 | 343 | // initialize EplNmtu module |
9d7164cf | 344 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTU)) != 0) |
833dfbe7 GKH |
345 | Ret = EplNmtuInit(); |
346 | if (Ret != kEplSuccessful) { | |
347 | goto Exit; | |
348 | } | |
349 | // register NMT event callback function | |
350 | Ret = EplNmtuRegisterStateChangeCb(EplApiCbNmtStateChange); | |
351 | if (Ret != kEplSuccessful) { | |
352 | goto Exit; | |
353 | } | |
9d7164cf DK |
354 | #endif |
355 | ||
356 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) | |
833dfbe7 GKH |
357 | // initialize EplNmtMnu module |
358 | Ret = EplNmtMnuInit(EplApiCbNodeEvent, EplApiCbBootEvent); | |
359 | if (Ret != kEplSuccessful) { | |
360 | goto Exit; | |
361 | } | |
362 | // initialize EplIdentu module | |
363 | Ret = EplIdentuInit(); | |
364 | if (Ret != kEplSuccessful) { | |
365 | goto Exit; | |
366 | } | |
367 | // initialize EplStatusu module | |
368 | Ret = EplStatusuInit(); | |
369 | if (Ret != kEplSuccessful) { | |
370 | goto Exit; | |
371 | } | |
9d7164cf DK |
372 | #endif |
373 | ||
833dfbe7 | 374 | // initialize EplLedu module |
9d7164cf | 375 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_LEDU)) != 0) |
833dfbe7 GKH |
376 | Ret = EplLeduInit(EplApiCbLedStateChange); |
377 | if (Ret != kEplSuccessful) { | |
378 | goto Exit; | |
379 | } | |
9d7164cf DK |
380 | #endif |
381 | ||
833dfbe7 | 382 | // init SDO module |
9d7164cf DK |
383 | #if ((((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOS)) != 0) || \ |
384 | (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOC)) != 0)) | |
833dfbe7 GKH |
385 | // init sdo command layer |
386 | Ret = EplSdoComInit(); | |
387 | if (Ret != kEplSuccessful) { | |
388 | goto Exit; | |
389 | } | |
9d7164cf DK |
390 | #endif |
391 | ||
833dfbe7 GKH |
392 | // the application must start NMT state machine |
393 | // via EplApiExecNmtCommand(kEplNmtEventSwReset) | |
394 | // and thereby the whole EPL stack | |
9d7164cf | 395 | |
833dfbe7 GKH |
396 | Exit: |
397 | return Ret; | |
9d7164cf DK |
398 | } |
399 | ||
400 | //--------------------------------------------------------------------------- | |
401 | // | |
402 | // Function: EplApiShutdown() | |
403 | // | |
404 | // Description: deletes an instance of EPL stack | |
405 | // | |
406 | // Parameters: (none) | |
407 | // | |
408 | // Returns: tEplKernel = error code | |
409 | // | |
410 | // | |
411 | // State: | |
412 | // | |
413 | //--------------------------------------------------------------------------- | |
414 | ||
d10f4699 | 415 | tEplKernel EplApiShutdown(void) |
9d7164cf | 416 | { |
833dfbe7 | 417 | tEplKernel Ret = kEplSuccessful; |
9d7164cf | 418 | |
833dfbe7 | 419 | // $$$ d.k.: check if NMT state is NMT_GS_OFF |
9d7164cf | 420 | |
833dfbe7 GKH |
421 | // $$$ d.k.: maybe delete event queues at first, but this implies that |
422 | // no other module must not use the event queues for communication | |
423 | // during shutdown. | |
9d7164cf | 424 | |
833dfbe7 | 425 | // delete instance for all modules |
9d7164cf | 426 | |
833dfbe7 | 427 | // deinitialize EplSdoCom module |
9d7164cf DK |
428 | #if ((((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOS)) != 0) || \ |
429 | (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOC)) != 0)) | |
833dfbe7 | 430 | Ret = EplSdoComDelInstance(); |
9d7164cf DK |
431 | // PRINTF1("EplSdoComDelInstance(): 0x%X\n", Ret); |
432 | #endif | |
433 | ||
833dfbe7 | 434 | // deinitialize EplLedu module |
9d7164cf | 435 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_LEDU)) != 0) |
833dfbe7 | 436 | Ret = EplLeduDelInstance(); |
9d7164cf DK |
437 | // PRINTF1("EplLeduDelInstance(): 0x%X\n", Ret); |
438 | #endif | |
439 | ||
440 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) | |
833dfbe7 GKH |
441 | // deinitialize EplNmtMnu module |
442 | Ret = EplNmtMnuDelInstance(); | |
9d7164cf DK |
443 | // PRINTF1("EplNmtMnuDelInstance(): 0x%X\n", Ret); |
444 | ||
833dfbe7 GKH |
445 | // deinitialize EplIdentu module |
446 | Ret = EplIdentuDelInstance(); | |
9d7164cf DK |
447 | // PRINTF1("EplIdentuDelInstance(): 0x%X\n", Ret); |
448 | ||
833dfbe7 GKH |
449 | // deinitialize EplStatusu module |
450 | Ret = EplStatusuDelInstance(); | |
9d7164cf DK |
451 | // PRINTF1("EplStatusuDelInstance(): 0x%X\n", Ret); |
452 | #endif | |
453 | ||
833dfbe7 | 454 | // deinitialize EplNmtCnu module |
9d7164cf | 455 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_CN)) != 0) |
833dfbe7 | 456 | Ret = EplNmtCnuDelInstance(); |
9d7164cf DK |
457 | // PRINTF1("EplNmtCnuDelInstance(): 0x%X\n", Ret); |
458 | #endif | |
459 | ||
833dfbe7 | 460 | // deinitialize EplNmtu module |
9d7164cf | 461 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTU)) != 0) |
833dfbe7 | 462 | Ret = EplNmtuDelInstance(); |
9d7164cf DK |
463 | // PRINTF1("EplNmtuDelInstance(): 0x%X\n", Ret); |
464 | #endif | |
465 | ||
833dfbe7 | 466 | // deinitialize EplDlluCal module |
9d7164cf | 467 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLU)) != 0) |
833dfbe7 | 468 | Ret = EplDlluCalDelInstance(); |
9d7164cf DK |
469 | // PRINTF1("EplDlluCalDelInstance(): 0x%X\n", Ret); |
470 | ||
471 | #endif | |
472 | ||
833dfbe7 GKH |
473 | // deinitialize EplEventu module |
474 | Ret = EplEventuDelInstance(); | |
9d7164cf DK |
475 | // PRINTF1("EplEventuDelInstance(): 0x%X\n", Ret); |
476 | ||
833dfbe7 | 477 | // deinitialize EplNmtk module |
9d7164cf | 478 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTK)) != 0) |
833dfbe7 | 479 | Ret = EplNmtkDelInstance(); |
9d7164cf DK |
480 | // PRINTF1("EplNmtkDelInstance(): 0x%X\n", Ret); |
481 | #endif | |
482 | ||
833dfbe7 | 483 | // deinitialize EplDllk module |
9d7164cf | 484 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLK)) != 0) |
833dfbe7 | 485 | Ret = EplDllkDelInstance(); |
9d7164cf DK |
486 | // PRINTF1("EplDllkDelInstance(): 0x%X\n", Ret); |
487 | ||
833dfbe7 GKH |
488 | // deinitialize EplDllkCal module |
489 | Ret = EplDllkCalDelInstance(); | |
9d7164cf DK |
490 | // PRINTF1("EplDllkCalDelInstance(): 0x%X\n", Ret); |
491 | #endif | |
492 | ||
833dfbe7 GKH |
493 | // deinitialize EplEventk module |
494 | Ret = EplEventkDelInstance(); | |
9d7164cf DK |
495 | // PRINTF1("EplEventkDelInstance(): 0x%X\n", Ret); |
496 | ||
833dfbe7 GKH |
497 | // deinitialize EplTimerk module |
498 | Ret = EplTimerkDelInstance(); | |
9d7164cf DK |
499 | // PRINTF1("EplTimerkDelInstance(): 0x%X\n", Ret); |
500 | ||
501 | #ifndef EPL_NO_FIFO | |
833dfbe7 | 502 | ShbExit(); |
9d7164cf DK |
503 | #endif |
504 | ||
833dfbe7 | 505 | return Ret; |
9d7164cf DK |
506 | } |
507 | ||
9d7164cf DK |
508 | //---------------------------------------------------------------------------- |
509 | // Function: EplApiExecNmtCommand() | |
510 | // | |
511 | // Description: executes a NMT command, i.e. post the NMT command/event to the | |
512 | // NMTk module. NMT commands which are not appropriate in the current | |
513 | // NMT state are silently ignored. Please keep in mind that the | |
514 | // NMT state may change until the NMT command is actually executed. | |
515 | // | |
516 | // Parameters: NmtEvent_p = NMT command/event | |
517 | // | |
518 | // Returns: tEplKernel = error code | |
519 | // | |
520 | // State: | |
521 | //---------------------------------------------------------------------------- | |
522 | ||
d10f4699 | 523 | tEplKernel EplApiExecNmtCommand(tEplNmtEvent NmtEvent_p) |
9d7164cf | 524 | { |
833dfbe7 | 525 | tEplKernel Ret = kEplSuccessful; |
9d7164cf DK |
526 | |
527 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTU)) != 0) | |
833dfbe7 | 528 | Ret = EplNmtuNmtEvent(NmtEvent_p); |
9d7164cf DK |
529 | #endif |
530 | ||
833dfbe7 | 531 | return Ret; |
9d7164cf DK |
532 | } |
533 | ||
9d7164cf DK |
534 | //---------------------------------------------------------------------------- |
535 | // Function: EplApiLinkObject() | |
536 | // | |
537 | // Description: Function maps array of application variables onto specified object in OD | |
538 | // | |
539 | // Parameters: uiObjIndex_p = Function maps variables for this object index | |
540 | // pVar_p = Pointer to data memory area for the specified object | |
541 | // puiVarEntries_p = IN: pointer to number of entries to map | |
542 | // OUT: pointer to number of actually used entries | |
543 | // pEntrySize_p = IN: pointer to size of one entry; | |
544 | // if size is zero, the actual size will be read from OD | |
545 | // OUT: pointer to entire size of all entries mapped | |
546 | // uiFirstSubindex_p = This is the first subindex to be mapped. | |
547 | // | |
548 | // Returns: tEplKernel = error code | |
549 | // | |
550 | // State: | |
551 | //---------------------------------------------------------------------------- | |
552 | ||
d10f4699 GKH |
553 | tEplKernel EplApiLinkObject(unsigned int uiObjIndex_p, |
554 | void *pVar_p, | |
555 | unsigned int *puiVarEntries_p, | |
556 | tEplObdSize *pEntrySize_p, | |
557 | unsigned int uiFirstSubindex_p) | |
9d7164cf | 558 | { |
833dfbe7 GKH |
559 | BYTE bVarEntries; |
560 | BYTE bIndexEntries; | |
561 | BYTE MEM *pbData; | |
562 | unsigned int uiSubindex; | |
563 | tEplVarParam VarParam; | |
564 | tEplObdSize EntrySize; | |
565 | tEplObdSize UsedSize; | |
566 | ||
567 | tEplKernel RetCode = kEplSuccessful; | |
568 | ||
569 | if ((pVar_p == NULL) | |
570 | || (puiVarEntries_p == NULL) | |
571 | || (*puiVarEntries_p == 0) | |
572 | || (pEntrySize_p == NULL)) { | |
573 | RetCode = kEplApiInvalidParam; | |
574 | goto Exit; | |
575 | } | |
576 | ||
577 | pbData = (BYTE MEM *) pVar_p; | |
578 | bVarEntries = (BYTE) * puiVarEntries_p; | |
579 | UsedSize = 0; | |
580 | ||
581 | // init VarParam structure with default values | |
582 | VarParam.m_uiIndex = uiObjIndex_p; | |
583 | VarParam.m_ValidFlag = kVarValidAll; | |
584 | ||
585 | if (uiFirstSubindex_p != 0) { // check if object exists by reading subindex 0x00, | |
586 | // because user wants to link a variable to a subindex unequal 0x00 | |
587 | // read number of entries | |
588 | EntrySize = (tEplObdSize) sizeof(bIndexEntries); | |
589 | RetCode = EplObdReadEntry(uiObjIndex_p, | |
590 | 0x00, | |
591 | (void GENERIC *)&bIndexEntries, | |
592 | &EntrySize); | |
593 | ||
594 | if ((RetCode != kEplSuccessful) || (bIndexEntries == 0x00)) { | |
595 | // Object doesn't exist or invalid entry number | |
596 | RetCode = kEplObdIndexNotExist; | |
597 | goto Exit; | |
598 | } | |
599 | } else { // user wants to link a variable to subindex 0x00 | |
600 | // that's OK | |
601 | bIndexEntries = 0; | |
602 | } | |
603 | ||
604 | // Correct number of entries if number read from OD is greater | |
605 | // than the specified number. | |
606 | // This is done, so that we do not set more entries than subindexes the | |
607 | // object actually has. | |
608 | if ((bIndexEntries > (bVarEntries + uiFirstSubindex_p - 1)) && | |
609 | (bVarEntries != 0x00)) { | |
610 | bIndexEntries = (BYTE) (bVarEntries + uiFirstSubindex_p - 1); | |
611 | } | |
612 | // map entries | |
613 | for (uiSubindex = uiFirstSubindex_p; uiSubindex <= bIndexEntries; | |
614 | uiSubindex++) { | |
615 | // if passed entry size is 0, then get size from OD | |
616 | if (*pEntrySize_p == 0x00) { | |
617 | // read entry size | |
618 | EntrySize = EplObdGetDataSize(uiObjIndex_p, uiSubindex); | |
619 | ||
620 | if (EntrySize == 0x00) { | |
621 | // invalid entry size (maybe object doesn't exist or entry of type DOMAIN is empty) | |
622 | RetCode = kEplObdSubindexNotExist; | |
623 | break; | |
624 | } | |
625 | } else { // use passed entry size | |
626 | EntrySize = *pEntrySize_p; | |
627 | } | |
628 | ||
629 | VarParam.m_uiSubindex = uiSubindex; | |
630 | ||
631 | // set pointer to user var | |
632 | VarParam.m_Size = EntrySize; | |
633 | VarParam.m_pData = pbData; | |
634 | ||
635 | UsedSize += EntrySize; | |
636 | pbData += EntrySize; | |
637 | ||
638 | RetCode = EplObdDefineVar(&VarParam); | |
639 | if (RetCode != kEplSuccessful) { | |
640 | break; | |
641 | } | |
642 | } | |
643 | ||
644 | // set number of mapped entries and entry size | |
645 | *puiVarEntries_p = ((bIndexEntries - uiFirstSubindex_p) + 1); | |
646 | *pEntrySize_p = UsedSize; | |
647 | ||
648 | Exit: | |
649 | ||
650 | return (RetCode); | |
9d7164cf DK |
651 | |
652 | } | |
653 | ||
9d7164cf DK |
654 | // ---------------------------------------------------------------------------- |
655 | // | |
656 | // Function: EplApiReadObject() | |
657 | // | |
658 | // Description: reads the specified entry from the OD of the specified node. | |
659 | // If this node is a remote node, it performs a SDO transfer, which | |
660 | // means this function returns kEplApiTaskDeferred and the application | |
661 | // is informed via the event callback function when the task is completed. | |
662 | // | |
663 | // Parameters: pSdoComConHdl_p = INOUT: pointer to SDO connection handle (may be NULL in case of local OD access) | |
664 | // uiNodeId_p = IN: node ID (0 = itself) | |
665 | // uiIndex_p = IN: index of object in OD | |
666 | // uiSubindex_p = IN: sub-index of object in OD | |
667 | // pDstData_le_p = OUT: pointer to data in little endian | |
668 | // puiSize_p = INOUT: pointer to size of data | |
669 | // SdoType_p = IN: type of SDO transfer | |
670 | // pUserArg_p = IN: user-definable argument pointer, | |
671 | // which will be passed to the event callback function | |
672 | // | |
673 | // Return: tEplKernel = error code | |
674 | // | |
675 | // ---------------------------------------------------------------------------- | |
676 | ||
d10f4699 GKH |
677 | tEplKernel EplApiReadObject(tEplSdoComConHdl *pSdoComConHdl_p, |
678 | unsigned int uiNodeId_p, | |
679 | unsigned int uiIndex_p, | |
680 | unsigned int uiSubindex_p, | |
681 | void *pDstData_le_p, | |
682 | unsigned int *puiSize_p, | |
683 | tEplSdoType SdoType_p, void *pUserArg_p) | |
9d7164cf | 684 | { |
833dfbe7 GKH |
685 | tEplKernel Ret = kEplSuccessful; |
686 | ||
687 | if ((uiIndex_p == 0) || (pDstData_le_p == NULL) || (puiSize_p == NULL) | |
688 | || (*puiSize_p == 0)) { | |
689 | Ret = kEplApiInvalidParam; | |
690 | goto Exit; | |
691 | } | |
692 | ||
693 | if (uiNodeId_p == 0 || uiNodeId_p == EplObdGetNodeId()) { // local OD access can be performed | |
694 | tEplObdSize ObdSize; | |
695 | ||
696 | ObdSize = (tEplObdSize) * puiSize_p; | |
697 | Ret = | |
698 | EplObdReadEntryToLe(uiIndex_p, uiSubindex_p, pDstData_le_p, | |
699 | &ObdSize); | |
700 | *puiSize_p = (unsigned int)ObdSize; | |
701 | } else { // perform SDO transfer | |
9d7164cf | 702 | #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOC)) != 0) |
833dfbe7 | 703 | tEplSdoComTransParamByIndex TransParamByIndex; |
9d7164cf DK |
704 | // tEplSdoComConHdl SdoComConHdl; |
705 | ||
833dfbe7 GKH |
706 | // check if application provides space for handle |
707 | if (pSdoComConHdl_p == NULL) { | |
708 | Ret = kEplApiInvalidParam; | |
709 | goto Exit; | |
9d7164cf | 710 | // pSdoComConHdl_p = &SdoComConHdl; |
833dfbe7 GKH |
711 | } |
712 | // init command layer connection | |
713 | Ret = EplSdoComDefineCon(pSdoComConHdl_p, uiNodeId_p, // target node id | |
714 | SdoType_p); // SDO type | |
715 | if ((Ret != kEplSuccessful) && (Ret != kEplSdoComHandleExists)) { | |
716 | goto Exit; | |
717 | } | |
718 | TransParamByIndex.m_pData = pDstData_le_p; | |
719 | TransParamByIndex.m_SdoAccessType = kEplSdoAccessTypeRead; | |
720 | TransParamByIndex.m_SdoComConHdl = *pSdoComConHdl_p; | |
721 | TransParamByIndex.m_uiDataSize = *puiSize_p; | |
722 | TransParamByIndex.m_uiIndex = uiIndex_p; | |
723 | TransParamByIndex.m_uiSubindex = uiSubindex_p; | |
724 | TransParamByIndex.m_pfnSdoFinishedCb = EplApiCbSdoCon; | |
725 | TransParamByIndex.m_pUserArg = pUserArg_p; | |
726 | ||
727 | Ret = EplSdoComInitTransferByIndex(&TransParamByIndex); | |
728 | if (Ret != kEplSuccessful) { | |
729 | goto Exit; | |
730 | } | |
731 | Ret = kEplApiTaskDeferred; | |
9d7164cf DK |
732 | |
733 | #else | |
833dfbe7 | 734 | Ret = kEplApiInvalidParam; |
9d7164cf | 735 | #endif |
833dfbe7 | 736 | } |
9d7164cf | 737 | |
833dfbe7 GKH |
738 | Exit: |
739 | return Ret; | |
9d7164cf DK |
740 | } |
741 | ||
9d7164cf DK |
742 | // ---------------------------------------------------------------------------- |
743 | // | |
744 | // Function: EplApiWriteObject() | |
745 | // | |
746 | // Description: writes the specified entry to the OD of the specified node. | |
747 | // If this node is a remote node, it performs a SDO transfer, which | |
748 | // means this function returns kEplApiTaskDeferred and the application | |
749 | // is informed via the event callback function when the task is completed. | |
750 | // | |
751 | // Parameters: pSdoComConHdl_p = INOUT: pointer to SDO connection handle (may be NULL in case of local OD access) | |
752 | // uiNodeId_p = IN: node ID (0 = itself) | |
753 | // uiIndex_p = IN: index of object in OD | |
754 | // uiSubindex_p = IN: sub-index of object in OD | |
755 | // pSrcData_le_p = IN: pointer to data in little endian | |
756 | // uiSize_p = IN: size of data in bytes | |
757 | // SdoType_p = IN: type of SDO transfer | |
758 | // pUserArg_p = IN: user-definable argument pointer, | |
759 | // which will be passed to the event callback function | |
760 | // | |
761 | // Return: tEplKernel = error code | |
762 | // | |
763 | // ---------------------------------------------------------------------------- | |
764 | ||
d10f4699 GKH |
765 | tEplKernel EplApiWriteObject(tEplSdoComConHdl *pSdoComConHdl_p, |
766 | unsigned int uiNodeId_p, | |
767 | unsigned int uiIndex_p, | |
768 | unsigned int uiSubindex_p, | |
769 | void *pSrcData_le_p, | |
770 | unsigned int uiSize_p, | |
771 | tEplSdoType SdoType_p, void *pUserArg_p) | |
9d7164cf | 772 | { |
833dfbe7 | 773 | tEplKernel Ret = kEplSuccessful; |
9d7164cf | 774 | |
833dfbe7 GKH |
775 | if ((uiIndex_p == 0) || (pSrcData_le_p == NULL) || (uiSize_p == 0)) { |
776 | Ret = kEplApiInvalidParam; | |
777 | goto Exit; | |
778 | } | |
9d7164cf | 779 | |
833dfbe7 | 780 | if (uiNodeId_p == 0 || uiNodeId_p == EplObdGetNodeId()) { // local OD access can be performed |
9d7164cf | 781 | |
833dfbe7 GKH |
782 | Ret = |
783 | EplObdWriteEntryFromLe(uiIndex_p, uiSubindex_p, | |
784 | pSrcData_le_p, uiSize_p); | |
785 | } else { // perform SDO transfer | |
9d7164cf | 786 | #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOC)) != 0) |
833dfbe7 | 787 | tEplSdoComTransParamByIndex TransParamByIndex; |
9d7164cf DK |
788 | // tEplSdoComConHdl SdoComConHdl; |
789 | ||
833dfbe7 GKH |
790 | // check if application provides space for handle |
791 | if (pSdoComConHdl_p == NULL) { | |
792 | Ret = kEplApiInvalidParam; | |
793 | goto Exit; | |
9d7164cf | 794 | // pSdoComConHdl_p = &SdoComConHdl; |
833dfbe7 GKH |
795 | } |
796 | // d.k.: How to recycle command layer connection? | |
797 | // Try to redefine it, which will return kEplSdoComHandleExists | |
798 | // and the existing command layer handle. | |
799 | // If the returned handle is busy, EplSdoComInitTransferByIndex() | |
800 | // will return with error. | |
801 | // $$$ d.k.: Collisions may occur with Configuration Manager, if both the application and | |
802 | // Configuration Manager, are trying to communicate with the very same node. | |
803 | // possible solution: disallow communication by application if Configuration Manager is busy | |
804 | ||
805 | // init command layer connection | |
806 | Ret = EplSdoComDefineCon(pSdoComConHdl_p, uiNodeId_p, // target node id | |
807 | SdoType_p); // SDO type | |
808 | if ((Ret != kEplSuccessful) && (Ret != kEplSdoComHandleExists)) { | |
809 | goto Exit; | |
810 | } | |
811 | TransParamByIndex.m_pData = pSrcData_le_p; | |
812 | TransParamByIndex.m_SdoAccessType = kEplSdoAccessTypeWrite; | |
813 | TransParamByIndex.m_SdoComConHdl = *pSdoComConHdl_p; | |
814 | TransParamByIndex.m_uiDataSize = uiSize_p; | |
815 | TransParamByIndex.m_uiIndex = uiIndex_p; | |
816 | TransParamByIndex.m_uiSubindex = uiSubindex_p; | |
817 | TransParamByIndex.m_pfnSdoFinishedCb = EplApiCbSdoCon; | |
818 | TransParamByIndex.m_pUserArg = pUserArg_p; | |
819 | ||
820 | Ret = EplSdoComInitTransferByIndex(&TransParamByIndex); | |
821 | if (Ret != kEplSuccessful) { | |
822 | goto Exit; | |
823 | } | |
824 | Ret = kEplApiTaskDeferred; | |
9d7164cf DK |
825 | |
826 | #else | |
833dfbe7 | 827 | Ret = kEplApiInvalidParam; |
9d7164cf | 828 | #endif |
833dfbe7 | 829 | } |
9d7164cf | 830 | |
833dfbe7 GKH |
831 | Exit: |
832 | return Ret; | |
9d7164cf DK |
833 | } |
834 | ||
9d7164cf DK |
835 | // ---------------------------------------------------------------------------- |
836 | // | |
837 | // Function: EplApiFreeSdoChannel() | |
838 | // | |
839 | // Description: frees the specified SDO channel. | |
840 | // This function must be called after each call to EplApiReadObject()/EplApiWriteObject() | |
841 | // which returns kEplApiTaskDeferred and the application | |
842 | // is informed via the event callback function when the task is completed. | |
843 | // | |
844 | // Parameters: SdoComConHdl_p = IN: SDO connection handle | |
845 | // | |
846 | // Return: tEplKernel = error code | |
847 | // | |
848 | // ---------------------------------------------------------------------------- | |
849 | ||
d10f4699 | 850 | tEplKernel EplApiFreeSdoChannel(tEplSdoComConHdl SdoComConHdl_p) |
9d7164cf | 851 | { |
833dfbe7 | 852 | tEplKernel Ret = kEplSuccessful; |
9d7164cf DK |
853 | |
854 | #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOC)) != 0) | |
855 | ||
833dfbe7 GKH |
856 | // init command layer connection |
857 | Ret = EplSdoComUndefineCon(SdoComConHdl_p); | |
9d7164cf DK |
858 | |
859 | #else | |
833dfbe7 | 860 | Ret = kEplApiInvalidParam; |
9d7164cf DK |
861 | #endif |
862 | ||
833dfbe7 | 863 | return Ret; |
9d7164cf DK |
864 | } |
865 | ||
9d7164cf DK |
866 | // ---------------------------------------------------------------------------- |
867 | // | |
868 | // Function: EplApiReadLocalObject() | |
869 | // | |
870 | // Description: reads the specified entry from the local OD. | |
871 | // | |
872 | // Parameters: uiIndex_p = IN: index of object in OD | |
873 | // uiSubindex_p = IN: sub-index of object in OD | |
874 | // pDstData_p = OUT: pointer to data in platform byte order | |
875 | // puiSize_p = INOUT: pointer to size of data | |
876 | // | |
877 | // Return: tEplKernel = error code | |
878 | // | |
879 | // ---------------------------------------------------------------------------- | |
880 | ||
d10f4699 GKH |
881 | tEplKernel EplApiReadLocalObject(unsigned int uiIndex_p, |
882 | unsigned int uiSubindex_p, | |
883 | void *pDstData_p, unsigned int *puiSize_p) | |
9d7164cf | 884 | { |
833dfbe7 GKH |
885 | tEplKernel Ret = kEplSuccessful; |
886 | tEplObdSize ObdSize; | |
9d7164cf | 887 | |
833dfbe7 GKH |
888 | ObdSize = (tEplObdSize) * puiSize_p; |
889 | Ret = EplObdReadEntry(uiIndex_p, uiSubindex_p, pDstData_p, &ObdSize); | |
890 | *puiSize_p = (unsigned int)ObdSize; | |
9d7164cf | 891 | |
833dfbe7 | 892 | return Ret; |
9d7164cf DK |
893 | } |
894 | ||
9d7164cf DK |
895 | // ---------------------------------------------------------------------------- |
896 | // | |
897 | // Function: EplApiWriteLocalObject() | |
898 | // | |
899 | // Description: writes the specified entry to the local OD. | |
900 | // | |
901 | // Parameters: uiIndex_p = IN: index of object in OD | |
902 | // uiSubindex_p = IN: sub-index of object in OD | |
903 | // pSrcData_p = IN: pointer to data in platform byte order | |
904 | // uiSize_p = IN: size of data in bytes | |
905 | // | |
906 | // Return: tEplKernel = error code | |
907 | // | |
908 | // ---------------------------------------------------------------------------- | |
909 | ||
d10f4699 GKH |
910 | tEplKernel EplApiWriteLocalObject(unsigned int uiIndex_p, |
911 | unsigned int uiSubindex_p, | |
912 | void *pSrcData_p, | |
913 | unsigned int uiSize_p) | |
9d7164cf | 914 | { |
833dfbe7 | 915 | tEplKernel Ret = kEplSuccessful; |
9d7164cf | 916 | |
833dfbe7 GKH |
917 | Ret = |
918 | EplObdWriteEntry(uiIndex_p, uiSubindex_p, pSrcData_p, | |
919 | (tEplObdSize) uiSize_p); | |
9d7164cf | 920 | |
833dfbe7 | 921 | return Ret; |
9d7164cf DK |
922 | } |
923 | ||
9d7164cf DK |
924 | #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) |
925 | // ---------------------------------------------------------------------------- | |
926 | // | |
927 | // Function: EplApiMnTriggerStateChange() | |
928 | // | |
929 | // Description: triggers the specified node command for the specified node. | |
930 | // | |
931 | // Parameters: uiNodeId_p = node ID for which the node command will be executed | |
932 | // NodeCommand_p = node command | |
933 | // | |
934 | // Return: tEplKernel = error code | |
935 | // | |
936 | // ---------------------------------------------------------------------------- | |
937 | ||
d10f4699 GKH |
938 | tEplKernel EplApiMnTriggerStateChange(unsigned int uiNodeId_p, |
939 | tEplNmtNodeCommand NodeCommand_p) | |
9d7164cf | 940 | { |
833dfbe7 | 941 | tEplKernel Ret = kEplSuccessful; |
9d7164cf | 942 | |
833dfbe7 | 943 | Ret = EplNmtMnuTriggerStateChange(uiNodeId_p, NodeCommand_p); |
9d7164cf | 944 | |
833dfbe7 | 945 | return Ret; |
9d7164cf DK |
946 | } |
947 | ||
948 | #endif // (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) | |
949 | ||
950 | //--------------------------------------------------------------------------- | |
951 | // | |
952 | // Function: EplApiCbObdAccess | |
953 | // | |
954 | // Description: callback function for OD accesses | |
955 | // | |
956 | // Parameters: pParam_p = OBD parameter | |
957 | // | |
958 | // Returns: tEplKernel = error code | |
959 | // | |
960 | // | |
961 | // State: | |
962 | // | |
963 | //--------------------------------------------------------------------------- | |
964 | ||
d10f4699 | 965 | tEplKernel EplApiCbObdAccess(tEplObdCbParam MEM *pParam_p) |
9d7164cf | 966 | { |
833dfbe7 | 967 | tEplKernel Ret = kEplSuccessful; |
9d7164cf DK |
968 | |
969 | #if (EPL_API_OBD_FORWARD_EVENT != FALSE) | |
833dfbe7 GKH |
970 | tEplApiEventArg EventArg; |
971 | ||
972 | // call user callback | |
973 | // must be disabled for EplApiLinuxKernel.c, because of reentrancy problem | |
974 | // for local OD access. This is not so bad as user callback function in | |
975 | // application does not use OD callbacks at the moment. | |
976 | EventArg.m_ObdCbParam = *pParam_p; | |
977 | Ret = EplApiInstance_g.m_InitParam.m_pfnCbEvent(kEplApiEventObdAccess, | |
978 | &EventArg, | |
979 | EplApiInstance_g. | |
980 | m_InitParam. | |
981 | m_pEventUserArg); | |
9d7164cf DK |
982 | #endif |
983 | ||
833dfbe7 GKH |
984 | switch (pParam_p->m_uiIndex) { |
985 | //case 0x1006: // NMT_CycleLen_U32 (valid on reset) | |
986 | case 0x1C14: // DLL_LossOfFrameTolerance_U32 | |
987 | //case 0x1F98: // NMT_CycleTiming_REC (valid on reset) | |
988 | { | |
989 | if (pParam_p->m_ObdEvent == kEplObdEvPostWrite) { | |
990 | // update DLL configuration | |
991 | Ret = EplApiUpdateDllConfig(FALSE); | |
992 | } | |
993 | break; | |
994 | } | |
995 | ||
996 | case 0x1020: // CFM_VerifyConfiguration_REC.ConfId_U32 != 0 | |
997 | { | |
998 | if ((pParam_p->m_ObdEvent == kEplObdEvPostWrite) | |
999 | && (pParam_p->m_uiSubIndex == 3) | |
1000 | && (*((DWORD *) pParam_p->m_pArg) != 0)) { | |
1001 | DWORD dwVerifyConfInvalid = 0; | |
1002 | // set CFM_VerifyConfiguration_REC.VerifyConfInvalid_U32 to 0 | |
1003 | Ret = | |
1004 | EplObdWriteEntry(0x1020, 4, | |
1005 | &dwVerifyConfInvalid, 4); | |
1006 | // ignore any error because this objekt is optional | |
1007 | Ret = kEplSuccessful; | |
1008 | } | |
1009 | break; | |
1010 | } | |
1011 | ||
1012 | case 0x1F9E: // NMT_ResetCmd_U8 | |
1013 | { | |
1014 | if (pParam_p->m_ObdEvent == kEplObdEvPreWrite) { | |
1015 | BYTE bNmtCommand; | |
1016 | ||
1017 | bNmtCommand = *((BYTE *) pParam_p->m_pArg); | |
1018 | // check value range | |
1019 | switch ((tEplNmtCommand) bNmtCommand) { | |
1020 | case kEplNmtCmdResetNode: | |
1021 | case kEplNmtCmdResetCommunication: | |
1022 | case kEplNmtCmdResetConfiguration: | |
1023 | case kEplNmtCmdSwReset: | |
1024 | case kEplNmtCmdInvalidService: | |
1025 | // valid command identifier specified | |
1026 | break; | |
1027 | ||
1028 | default: | |
1029 | pParam_p->m_dwAbortCode = | |
1030 | EPL_SDOAC_VALUE_RANGE_EXCEEDED; | |
1031 | Ret = kEplObdAccessViolation; | |
1032 | break; | |
1033 | } | |
1034 | } else if (pParam_p->m_ObdEvent == kEplObdEvPostWrite) { | |
1035 | BYTE bNmtCommand; | |
1036 | ||
1037 | bNmtCommand = *((BYTE *) pParam_p->m_pArg); | |
1038 | // check value range | |
1039 | switch ((tEplNmtCommand) bNmtCommand) { | |
1040 | case kEplNmtCmdResetNode: | |
9d7164cf | 1041 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTU)) != 0) |
833dfbe7 GKH |
1042 | Ret = |
1043 | EplNmtuNmtEvent | |
1044 | (kEplNmtEventResetNode); | |
9d7164cf | 1045 | #endif |
833dfbe7 | 1046 | break; |
9d7164cf | 1047 | |
833dfbe7 | 1048 | case kEplNmtCmdResetCommunication: |
9d7164cf | 1049 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTU)) != 0) |
833dfbe7 GKH |
1050 | Ret = |
1051 | EplNmtuNmtEvent | |
1052 | (kEplNmtEventResetCom); | |
9d7164cf | 1053 | #endif |
833dfbe7 | 1054 | break; |
9d7164cf | 1055 | |
833dfbe7 | 1056 | case kEplNmtCmdResetConfiguration: |
9d7164cf | 1057 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTU)) != 0) |
833dfbe7 GKH |
1058 | Ret = |
1059 | EplNmtuNmtEvent | |
1060 | (kEplNmtEventResetConfig); | |
9d7164cf | 1061 | #endif |
833dfbe7 | 1062 | break; |
9d7164cf | 1063 | |
833dfbe7 | 1064 | case kEplNmtCmdSwReset: |
9d7164cf | 1065 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTU)) != 0) |
833dfbe7 GKH |
1066 | Ret = |
1067 | EplNmtuNmtEvent | |
1068 | (kEplNmtEventSwReset); | |
9d7164cf | 1069 | #endif |
833dfbe7 | 1070 | break; |
9d7164cf | 1071 | |
833dfbe7 GKH |
1072 | case kEplNmtCmdInvalidService: |
1073 | break; | |
9d7164cf | 1074 | |
833dfbe7 GKH |
1075 | default: |
1076 | pParam_p->m_dwAbortCode = | |
1077 | EPL_SDOAC_VALUE_RANGE_EXCEEDED; | |
1078 | Ret = kEplObdAccessViolation; | |
1079 | break; | |
1080 | } | |
1081 | } | |
1082 | break; | |
1083 | } | |
9d7164cf | 1084 | |
833dfbe7 GKH |
1085 | default: |
1086 | break; | |
1087 | } | |
9d7164cf DK |
1088 | |
1089 | //Exit: | |
833dfbe7 | 1090 | return Ret; |
9d7164cf DK |
1091 | } |
1092 | ||
9d7164cf DK |
1093 | //=========================================================================// |
1094 | // // | |
1095 | // P R I V A T E F U N C T I O N S // | |
1096 | // // | |
1097 | //=========================================================================// | |
1098 | ||
9d7164cf DK |
1099 | //--------------------------------------------------------------------------- |
1100 | // | |
1101 | // Function: EplApiProcessEvent | |
1102 | // | |
1103 | // Description: processes events from event queue and forwards these to | |
1104 | // the application's event callback function | |
1105 | // | |
1106 | // Parameters: pEplEvent_p = pointer to event | |
1107 | // | |
1108 | // Returns: tEplKernel = errorcode | |
1109 | // | |
1110 | // State: | |
1111 | // | |
1112 | //--------------------------------------------------------------------------- | |
1113 | ||
d10f4699 | 1114 | static tEplKernel EplApiProcessEvent(tEplEvent *pEplEvent_p) |
9d7164cf | 1115 | { |
833dfbe7 GKH |
1116 | tEplKernel Ret; |
1117 | tEplEventError *pEventError; | |
1118 | tEplApiEventType EventType; | |
1119 | ||
1120 | Ret = kEplSuccessful; | |
1121 | ||
1122 | // process event | |
1123 | switch (pEplEvent_p->m_EventType) { | |
1124 | // error event | |
1125 | case kEplEventTypeError: | |
1126 | { | |
1127 | pEventError = (tEplEventError *) pEplEvent_p->m_pArg; | |
1128 | switch (pEventError->m_EventSource) { | |
1129 | // treat the errors from the following sources as critical | |
1130 | case kEplEventSourceEventk: | |
1131 | case kEplEventSourceEventu: | |
1132 | case kEplEventSourceDllk: | |
1133 | { | |
1134 | EventType = kEplApiEventCriticalError; | |
1135 | // halt the stack by entering NMT state Off | |
1136 | Ret = | |
1137 | EplNmtuNmtEvent | |
1138 | (kEplNmtEventCriticalError); | |
1139 | break; | |
1140 | } | |
1141 | ||
1142 | // the other errors are just warnings | |
1143 | default: | |
1144 | { | |
1145 | EventType = kEplApiEventWarning; | |
1146 | break; | |
1147 | } | |
1148 | } | |
1149 | ||
1150 | // call user callback | |
1151 | Ret = | |
1152 | EplApiInstance_g.m_InitParam.m_pfnCbEvent(EventType, | |
1153 | (tEplApiEventArg | |
1154 | *) | |
1155 | pEventError, | |
1156 | EplApiInstance_g. | |
1157 | m_InitParam. | |
1158 | m_pEventUserArg); | |
1159 | // discard error from callback function, because this could generate an endless loop | |
1160 | Ret = kEplSuccessful; | |
1161 | break; | |
1162 | } | |
1163 | ||
1164 | // at present, there are no other events for this module | |
1165 | default: | |
1166 | break; | |
1167 | } | |
1168 | ||
1169 | return Ret; | |
9d7164cf DK |
1170 | } |
1171 | ||
9d7164cf DK |
1172 | //--------------------------------------------------------------------------- |
1173 | // | |
1174 | // Function: EplApiCbNmtStateChange | |
1175 | // | |
1176 | // Description: callback function for NMT state changes | |
1177 | // | |
1178 | // Parameters: NmtStateChange_p = NMT state change event | |
1179 | // | |
1180 | // Returns: tEplKernel = error code | |
1181 | // | |
1182 | // | |
1183 | // State: | |
1184 | // | |
1185 | //--------------------------------------------------------------------------- | |
1186 | ||
d10f4699 | 1187 | static tEplKernel EplApiCbNmtStateChange(tEplEventNmtStateChange NmtStateChange_p) |
9d7164cf | 1188 | { |
833dfbe7 GKH |
1189 | tEplKernel Ret = kEplSuccessful; |
1190 | BYTE bNmtState; | |
1191 | tEplApiEventArg EventArg; | |
1192 | ||
1193 | // save NMT state in OD | |
1194 | bNmtState = (BYTE) NmtStateChange_p.m_NewNmtState; | |
1195 | Ret = EplObdWriteEntry(0x1F8C, 0, &bNmtState, 1); | |
1196 | if (Ret != kEplSuccessful) { | |
1197 | goto Exit; | |
1198 | } | |
1199 | // do work which must be done in that state | |
1200 | switch (NmtStateChange_p.m_NewNmtState) { | |
1201 | // EPL stack is not running | |
1202 | case kEplNmtGsOff: | |
1203 | break; | |
1204 | ||
1205 | // first init of the hardware | |
1206 | case kEplNmtGsInitialising: | |
9d7164cf DK |
1207 | #if 0 |
1208 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDO_UDP)) != 0) | |
833dfbe7 GKH |
1209 | // configure SDO via UDP (i.e. bind it to the EPL ethernet interface) |
1210 | Ret = | |
1211 | EplSdoUdpuConfig(EplApiInstance_g.m_InitParam.m_dwIpAddress, | |
1212 | EPL_C_SDO_EPL_PORT); | |
1213 | if (Ret != kEplSuccessful) { | |
1214 | goto Exit; | |
1215 | } | |
9d7164cf DK |
1216 | #endif |
1217 | #endif | |
1218 | ||
833dfbe7 GKH |
1219 | break; |
1220 | ||
1221 | // init of the manufacturer-specific profile area and the | |
1222 | // standardised device profile area | |
1223 | case kEplNmtGsResetApplication: | |
1224 | { | |
1225 | // reset application part of OD | |
1226 | Ret = EplObdAccessOdPart(kEplObdPartApp, | |
1227 | kEplObdDirLoad); | |
1228 | if (Ret != kEplSuccessful) { | |
1229 | goto Exit; | |
1230 | } | |
1231 | ||
1232 | break; | |
1233 | } | |
1234 | ||
1235 | // init of the communication profile area | |
1236 | case kEplNmtGsResetCommunication: | |
1237 | { | |
1238 | // reset communication part of OD | |
1239 | Ret = EplObdAccessOdPart(kEplObdPartGen, | |
1240 | kEplObdDirLoad); | |
1241 | ||
1242 | if (Ret != kEplSuccessful) { | |
1243 | goto Exit; | |
1244 | } | |
1245 | // $$$ d.k.: update OD only if OD was not loaded from non-volatile memory | |
1246 | Ret = EplApiUpdateObd(); | |
1247 | if (Ret != kEplSuccessful) { | |
1248 | goto Exit; | |
1249 | } | |
1250 | ||
1251 | break; | |
1252 | } | |
1253 | ||
1254 | // build the configuration with infos from OD | |
1255 | case kEplNmtGsResetConfiguration: | |
1256 | { | |
1257 | ||
1258 | Ret = EplApiUpdateDllConfig(TRUE); | |
1259 | if (Ret != kEplSuccessful) { | |
1260 | goto Exit; | |
1261 | } | |
1262 | ||
1263 | break; | |
1264 | } | |
1265 | ||
1266 | //----------------------------------------------------------- | |
1267 | // CN part of the state machine | |
1268 | ||
1269 | // node liste for EPL-Frames and check timeout | |
1270 | case kEplNmtCsNotActive: | |
1271 | { | |
1272 | // indicate completion of reset in NMT_ResetCmd_U8 | |
1273 | bNmtState = (BYTE) kEplNmtCmdInvalidService; | |
1274 | Ret = EplObdWriteEntry(0x1F9E, 0, &bNmtState, 1); | |
1275 | if (Ret != kEplSuccessful) { | |
1276 | goto Exit; | |
1277 | } | |
1278 | ||
1279 | break; | |
1280 | } | |
1281 | ||
1282 | // node process only async frames | |
1283 | case kEplNmtCsPreOperational1: | |
1284 | { | |
1285 | break; | |
1286 | } | |
1287 | ||
1288 | // node process isochronus and asynchronus frames | |
1289 | case kEplNmtCsPreOperational2: | |
1290 | { | |
1291 | break; | |
1292 | } | |
1293 | ||
1294 | // node should be configured und application is ready | |
1295 | case kEplNmtCsReadyToOperate: | |
1296 | { | |
1297 | break; | |
1298 | } | |
1299 | ||
1300 | // normal work state | |
1301 | case kEplNmtCsOperational: | |
1302 | { | |
1303 | break; | |
1304 | } | |
1305 | ||
1306 | // node stopped by MN | |
1307 | // -> only process asynchronus frames | |
1308 | case kEplNmtCsStopped: | |
1309 | { | |
1310 | break; | |
1311 | } | |
1312 | ||
1313 | // no EPL cycle | |
1314 | // -> normal ethernet communication | |
1315 | case kEplNmtCsBasicEthernet: | |
1316 | { | |
1317 | break; | |
1318 | } | |
1319 | ||
1320 | //----------------------------------------------------------- | |
1321 | // MN part of the state machine | |
1322 | ||
1323 | // node listens for EPL-Frames and check timeout | |
1324 | case kEplNmtMsNotActive: | |
1325 | { | |
1326 | break; | |
1327 | } | |
1328 | ||
1329 | // node processes only async frames | |
1330 | case kEplNmtMsPreOperational1: | |
1331 | { | |
1332 | break; | |
1333 | } | |
1334 | ||
1335 | // node processes isochronous and asynchronous frames | |
1336 | case kEplNmtMsPreOperational2: | |
1337 | { | |
1338 | break; | |
1339 | } | |
1340 | ||
1341 | // node should be configured und application is ready | |
1342 | case kEplNmtMsReadyToOperate: | |
1343 | { | |
1344 | break; | |
1345 | } | |
1346 | ||
1347 | // normal work state | |
1348 | case kEplNmtMsOperational: | |
1349 | { | |
1350 | break; | |
1351 | } | |
1352 | ||
1353 | // no EPL cycle | |
1354 | // -> normal ethernet communication | |
1355 | case kEplNmtMsBasicEthernet: | |
1356 | { | |
1357 | break; | |
1358 | } | |
1359 | ||
1360 | default: | |
1361 | { | |
1362 | TRACE0 | |
1363 | ("EplApiCbNmtStateChange(): unhandled NMT state\n"); | |
1364 | } | |
1365 | } | |
9d7164cf DK |
1366 | |
1367 | #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_LEDU)) != 0) | |
833dfbe7 GKH |
1368 | // forward event to Led module |
1369 | Ret = EplLeduCbNmtStateChange(NmtStateChange_p); | |
1370 | if (Ret != kEplSuccessful) { | |
1371 | goto Exit; | |
1372 | } | |
9d7164cf DK |
1373 | #endif |
1374 | ||
1375 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) | |
833dfbe7 GKH |
1376 | // forward event to NmtMn module |
1377 | Ret = EplNmtMnuCbNmtStateChange(NmtStateChange_p); | |
1378 | if (Ret != kEplSuccessful) { | |
1379 | goto Exit; | |
1380 | } | |
9d7164cf DK |
1381 | #endif |
1382 | ||
833dfbe7 GKH |
1383 | // call user callback |
1384 | EventArg.m_NmtStateChange = NmtStateChange_p; | |
1385 | Ret = | |
1386 | EplApiInstance_g.m_InitParam. | |
1387 | m_pfnCbEvent(kEplApiEventNmtStateChange, &EventArg, | |
1388 | EplApiInstance_g.m_InitParam.m_pEventUserArg); | |
9d7164cf | 1389 | |
833dfbe7 GKH |
1390 | Exit: |
1391 | return Ret; | |
9d7164cf DK |
1392 | } |
1393 | ||
1394 | //--------------------------------------------------------------------------- | |
1395 | // | |
1396 | // Function: EplApiUpdateDllConfig | |
1397 | // | |
1398 | // Description: update configuration of DLL | |
1399 | // | |
1400 | // Parameters: fUpdateIdentity_p = TRUE, if identity must be updated | |
1401 | // | |
1402 | // Returns: tEplKernel = error code | |
1403 | // | |
1404 | // | |
1405 | // State: | |
1406 | // | |
1407 | //--------------------------------------------------------------------------- | |
1408 | ||
d10f4699 | 1409 | static tEplKernel EplApiUpdateDllConfig(BOOL fUpdateIdentity_p) |
9d7164cf | 1410 | { |
833dfbe7 GKH |
1411 | tEplKernel Ret = kEplSuccessful; |
1412 | tEplDllConfigParam DllConfigParam; | |
1413 | tEplDllIdentParam DllIdentParam; | |
1414 | tEplObdSize ObdSize; | |
1415 | WORD wTemp; | |
1416 | BYTE bTemp; | |
1417 | ||
1418 | // configure Dll | |
1419 | EPL_MEMSET(&DllConfigParam, 0, sizeof(DllConfigParam)); | |
1420 | DllConfigParam.m_uiNodeId = EplObdGetNodeId(); | |
1421 | ||
1422 | // Cycle Length (0x1006: NMT_CycleLen_U32) in [us] | |
1423 | ObdSize = 4; | |
1424 | Ret = | |
1425 | EplObdReadEntry(0x1006, 0, &DllConfigParam.m_dwCycleLen, &ObdSize); | |
1426 | if (Ret != kEplSuccessful) { | |
1427 | goto Exit; | |
1428 | } | |
1429 | // 0x1F82: NMT_FeatureFlags_U32 | |
1430 | ObdSize = 4; | |
1431 | Ret = | |
1432 | EplObdReadEntry(0x1F82, 0, &DllConfigParam.m_dwFeatureFlags, | |
1433 | &ObdSize); | |
1434 | if (Ret != kEplSuccessful) { | |
1435 | goto Exit; | |
1436 | } | |
1437 | // d.k. There is no dependance between FeatureFlags and async-only CN | |
1438 | DllConfigParam.m_fAsyncOnly = EplApiInstance_g.m_InitParam.m_fAsyncOnly; | |
1439 | ||
1440 | // 0x1C14: DLL_LossOfFrameTolerance_U32 in [ns] | |
1441 | ObdSize = 4; | |
1442 | Ret = | |
1443 | EplObdReadEntry(0x1C14, 0, &DllConfigParam.m_dwLossOfFrameTolerance, | |
1444 | &ObdSize); | |
1445 | if (Ret != kEplSuccessful) { | |
1446 | goto Exit; | |
1447 | } | |
1448 | // 0x1F98: NMT_CycleTiming_REC | |
1449 | // 0x1F98.1: IsochrTxMaxPayload_U16 | |
1450 | ObdSize = 2; | |
1451 | Ret = EplObdReadEntry(0x1F98, 1, &wTemp, &ObdSize); | |
1452 | if (Ret != kEplSuccessful) { | |
1453 | goto Exit; | |
1454 | } | |
1455 | DllConfigParam.m_uiIsochrTxMaxPayload = wTemp; | |
1456 | ||
1457 | // 0x1F98.2: IsochrRxMaxPayload_U16 | |
1458 | ObdSize = 2; | |
1459 | Ret = EplObdReadEntry(0x1F98, 2, &wTemp, &ObdSize); | |
1460 | if (Ret != kEplSuccessful) { | |
1461 | goto Exit; | |
1462 | } | |
1463 | DllConfigParam.m_uiIsochrRxMaxPayload = wTemp; | |
1464 | ||
1465 | // 0x1F98.3: PResMaxLatency_U32 | |
1466 | ObdSize = 4; | |
1467 | Ret = | |
1468 | EplObdReadEntry(0x1F98, 3, &DllConfigParam.m_dwPresMaxLatency, | |
1469 | &ObdSize); | |
1470 | if (Ret != kEplSuccessful) { | |
1471 | goto Exit; | |
1472 | } | |
1473 | // 0x1F98.4: PReqActPayloadLimit_U16 | |
1474 | ObdSize = 2; | |
1475 | Ret = EplObdReadEntry(0x1F98, 4, &wTemp, &ObdSize); | |
1476 | if (Ret != kEplSuccessful) { | |
1477 | goto Exit; | |
1478 | } | |
1479 | DllConfigParam.m_uiPreqActPayloadLimit = wTemp; | |
1480 | ||
1481 | // 0x1F98.5: PResActPayloadLimit_U16 | |
1482 | ObdSize = 2; | |
1483 | Ret = EplObdReadEntry(0x1F98, 5, &wTemp, &ObdSize); | |
1484 | if (Ret != kEplSuccessful) { | |
1485 | goto Exit; | |
1486 | } | |
1487 | DllConfigParam.m_uiPresActPayloadLimit = wTemp; | |
1488 | ||
1489 | // 0x1F98.6: ASndMaxLatency_U32 | |
1490 | ObdSize = 4; | |
1491 | Ret = | |
1492 | EplObdReadEntry(0x1F98, 6, &DllConfigParam.m_dwAsndMaxLatency, | |
1493 | &ObdSize); | |
1494 | if (Ret != kEplSuccessful) { | |
1495 | goto Exit; | |
1496 | } | |
1497 | // 0x1F98.7: MultiplCycleCnt_U8 | |
1498 | ObdSize = 1; | |
1499 | Ret = EplObdReadEntry(0x1F98, 7, &bTemp, &ObdSize); | |
1500 | if (Ret != kEplSuccessful) { | |
1501 | goto Exit; | |
1502 | } | |
1503 | DllConfigParam.m_uiMultiplCycleCnt = bTemp; | |
1504 | ||
1505 | // 0x1F98.8: AsyncMTU_U16 | |
1506 | ObdSize = 2; | |
1507 | Ret = EplObdReadEntry(0x1F98, 8, &wTemp, &ObdSize); | |
1508 | if (Ret != kEplSuccessful) { | |
1509 | goto Exit; | |
1510 | } | |
1511 | DllConfigParam.m_uiAsyncMtu = wTemp; | |
1512 | ||
1513 | // $$$ Prescaler | |
9d7164cf DK |
1514 | |
1515 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) | |
833dfbe7 GKH |
1516 | // 0x1F8A.1: WaitSoCPReq_U32 in [ns] |
1517 | ObdSize = 4; | |
1518 | Ret = | |
1519 | EplObdReadEntry(0x1F8A, 1, &DllConfigParam.m_dwWaitSocPreq, | |
1520 | &ObdSize); | |
1521 | if (Ret != kEplSuccessful) { | |
1522 | goto Exit; | |
1523 | } | |
1524 | // 0x1F8A.2: AsyncSlotTimeout_U32 in [ns] (optional) | |
1525 | ObdSize = 4; | |
1526 | Ret = | |
1527 | EplObdReadEntry(0x1F8A, 2, &DllConfigParam.m_dwAsyncSlotTimeout, | |
1528 | &ObdSize); | |
9d7164cf DK |
1529 | /* if(Ret != kEplSuccessful) |
1530 | { | |
1531 | goto Exit; | |
1532 | }*/ | |
1533 | #endif | |
1534 | ||
833dfbe7 GKH |
1535 | DllConfigParam.m_uiSizeOfStruct = sizeof(DllConfigParam); |
1536 | Ret = EplDllkConfig(&DllConfigParam); | |
1537 | if (Ret != kEplSuccessful) { | |
1538 | goto Exit; | |
1539 | } | |
1540 | ||
1541 | if (fUpdateIdentity_p != FALSE) { | |
1542 | // configure Identity | |
1543 | EPL_MEMSET(&DllIdentParam, 0, sizeof(DllIdentParam)); | |
1544 | ObdSize = 4; | |
1545 | Ret = | |
1546 | EplObdReadEntry(0x1000, 0, &DllIdentParam.m_dwDeviceType, | |
1547 | &ObdSize); | |
1548 | if (Ret != kEplSuccessful) { | |
1549 | goto Exit; | |
1550 | } | |
1551 | ||
1552 | ObdSize = 4; | |
1553 | Ret = | |
1554 | EplObdReadEntry(0x1018, 1, &DllIdentParam.m_dwVendorId, | |
1555 | &ObdSize); | |
1556 | if (Ret != kEplSuccessful) { | |
1557 | goto Exit; | |
1558 | } | |
1559 | ObdSize = 4; | |
1560 | Ret = | |
1561 | EplObdReadEntry(0x1018, 2, &DllIdentParam.m_dwProductCode, | |
1562 | &ObdSize); | |
1563 | if (Ret != kEplSuccessful) { | |
1564 | goto Exit; | |
1565 | } | |
1566 | ObdSize = 4; | |
1567 | Ret = | |
1568 | EplObdReadEntry(0x1018, 3, | |
1569 | &DllIdentParam.m_dwRevisionNumber, | |
1570 | &ObdSize); | |
1571 | if (Ret != kEplSuccessful) { | |
1572 | goto Exit; | |
1573 | } | |
1574 | ObdSize = 4; | |
1575 | Ret = | |
1576 | EplObdReadEntry(0x1018, 4, &DllIdentParam.m_dwSerialNumber, | |
1577 | &ObdSize); | |
1578 | if (Ret != kEplSuccessful) { | |
1579 | goto Exit; | |
1580 | } | |
1581 | ||
1582 | DllIdentParam.m_dwIpAddress = | |
1583 | EplApiInstance_g.m_InitParam.m_dwIpAddress; | |
1584 | DllIdentParam.m_dwSubnetMask = | |
1585 | EplApiInstance_g.m_InitParam.m_dwSubnetMask; | |
1586 | EPL_MEMCPY(DllIdentParam.m_sHostname, | |
1587 | EplApiInstance_g.m_InitParam.m_sHostname, | |
1588 | sizeof(DllIdentParam.m_sHostname)); | |
1589 | ||
1590 | ObdSize = 4; | |
1591 | Ret = | |
1592 | EplObdReadEntry(0x1020, 1, | |
1593 | &DllIdentParam.m_dwVerifyConfigurationDate, | |
1594 | &ObdSize); | |
1595 | // ignore any error, because this object is optional | |
1596 | ||
1597 | ObdSize = 4; | |
1598 | Ret = | |
1599 | EplObdReadEntry(0x1020, 2, | |
1600 | &DllIdentParam.m_dwVerifyConfigurationTime, | |
1601 | &ObdSize); | |
1602 | // ignore any error, because this object is optional | |
1603 | ||
1604 | // $$$ d.k.: fill rest of ident structure | |
1605 | ||
1606 | DllIdentParam.m_uiSizeOfStruct = sizeof(DllIdentParam); | |
1607 | Ret = EplDllkSetIdentity(&DllIdentParam); | |
1608 | if (Ret != kEplSuccessful) { | |
1609 | goto Exit; | |
1610 | } | |
1611 | } | |
1612 | ||
1613 | Exit: | |
1614 | return Ret; | |
9d7164cf DK |
1615 | } |
1616 | ||
1617 | //--------------------------------------------------------------------------- | |
1618 | // | |
1619 | // Function: EplApiUpdateObd | |
1620 | // | |
1621 | // Description: update OD from init param | |
1622 | // | |
1623 | // Parameters: (none) | |
1624 | // | |
1625 | // Returns: tEplKernel = error code | |
1626 | // | |
1627 | // | |
1628 | // State: | |
1629 | // | |
1630 | //--------------------------------------------------------------------------- | |
1631 | ||
d10f4699 | 1632 | static tEplKernel EplApiUpdateObd(void) |
9d7164cf | 1633 | { |
833dfbe7 GKH |
1634 | tEplKernel Ret = kEplSuccessful; |
1635 | WORD wTemp; | |
1636 | BYTE bTemp; | |
1637 | ||
1638 | // set node id in OD | |
1639 | Ret = EplObdSetNodeId(EplApiInstance_g.m_InitParam.m_uiNodeId, // node id | |
1640 | kEplObdNodeIdHardware); // set by hardware | |
1641 | if (Ret != kEplSuccessful) { | |
1642 | goto Exit; | |
1643 | } | |
1644 | ||
1645 | if (EplApiInstance_g.m_InitParam.m_dwCycleLen != -1) { | |
1646 | Ret = | |
1647 | EplObdWriteEntry(0x1006, 0, | |
1648 | &EplApiInstance_g.m_InitParam.m_dwCycleLen, | |
1649 | 4); | |
9d7164cf DK |
1650 | /* if(Ret != kEplSuccessful) |
1651 | { | |
1652 | goto Exit; | |
1653 | }*/ | |
833dfbe7 GKH |
1654 | } |
1655 | ||
1656 | if (EplApiInstance_g.m_InitParam.m_dwLossOfFrameTolerance != -1) { | |
1657 | Ret = | |
1658 | EplObdWriteEntry(0x1C14, 0, | |
1659 | &EplApiInstance_g.m_InitParam. | |
1660 | m_dwLossOfFrameTolerance, 4); | |
1661 | /* if(Ret != kEplSuccessful) | |
1662 | { | |
1663 | goto Exit; | |
1664 | } */ | |
1665 | } | |
1666 | // d.k. There is no dependance between FeatureFlags and async-only CN. | |
1667 | if (EplApiInstance_g.m_InitParam.m_dwFeatureFlags != -1) { | |
1668 | Ret = | |
1669 | EplObdWriteEntry(0x1F82, 0, | |
1670 | &EplApiInstance_g.m_InitParam. | |
1671 | m_dwFeatureFlags, 4); | |
1672 | /* if(Ret != kEplSuccessful) | |
1673 | { | |
1674 | goto Exit; | |
1675 | } */ | |
1676 | } | |
1677 | ||
1678 | wTemp = (WORD) EplApiInstance_g.m_InitParam.m_uiIsochrTxMaxPayload; | |
1679 | Ret = EplObdWriteEntry(0x1F98, 1, &wTemp, 2); | |
9d7164cf DK |
1680 | /* if(Ret != kEplSuccessful) |
1681 | { | |
1682 | goto Exit; | |
1683 | }*/ | |
1684 | ||
833dfbe7 GKH |
1685 | wTemp = (WORD) EplApiInstance_g.m_InitParam.m_uiIsochrRxMaxPayload; |
1686 | Ret = EplObdWriteEntry(0x1F98, 2, &wTemp, 2); | |
9d7164cf DK |
1687 | /* if(Ret != kEplSuccessful) |
1688 | { | |
1689 | goto Exit; | |
1690 | }*/ | |
1691 | ||
833dfbe7 GKH |
1692 | Ret = |
1693 | EplObdWriteEntry(0x1F98, 3, | |
1694 | &EplApiInstance_g.m_InitParam.m_dwPresMaxLatency, | |
1695 | 4); | |
9d7164cf DK |
1696 | /* if(Ret != kEplSuccessful) |
1697 | { | |
1698 | goto Exit; | |
1699 | }*/ | |
1700 | ||
833dfbe7 GKH |
1701 | if (EplApiInstance_g.m_InitParam.m_uiPreqActPayloadLimit <= |
1702 | EPL_C_DLL_ISOCHR_MAX_PAYL) { | |
1703 | wTemp = | |
1704 | (WORD) EplApiInstance_g.m_InitParam.m_uiPreqActPayloadLimit; | |
1705 | Ret = EplObdWriteEntry(0x1F98, 4, &wTemp, 2); | |
9d7164cf DK |
1706 | /* if(Ret != kEplSuccessful) |
1707 | { | |
1708 | goto Exit; | |
1709 | }*/ | |
833dfbe7 | 1710 | } |
9d7164cf | 1711 | |
833dfbe7 GKH |
1712 | if (EplApiInstance_g.m_InitParam.m_uiPresActPayloadLimit <= |
1713 | EPL_C_DLL_ISOCHR_MAX_PAYL) { | |
1714 | wTemp = | |
1715 | (WORD) EplApiInstance_g.m_InitParam.m_uiPresActPayloadLimit; | |
1716 | Ret = EplObdWriteEntry(0x1F98, 5, &wTemp, 2); | |
9d7164cf DK |
1717 | /* if(Ret != kEplSuccessful) |
1718 | { | |
1719 | goto Exit; | |
1720 | }*/ | |
833dfbe7 | 1721 | } |
9d7164cf | 1722 | |
833dfbe7 GKH |
1723 | Ret = |
1724 | EplObdWriteEntry(0x1F98, 6, | |
1725 | &EplApiInstance_g.m_InitParam.m_dwAsndMaxLatency, | |
1726 | 4); | |
9d7164cf DK |
1727 | /* if(Ret != kEplSuccessful) |
1728 | { | |
1729 | goto Exit; | |
1730 | }*/ | |
1731 | ||
833dfbe7 GKH |
1732 | if (EplApiInstance_g.m_InitParam.m_uiMultiplCycleCnt <= 0xFF) { |
1733 | bTemp = (BYTE) EplApiInstance_g.m_InitParam.m_uiMultiplCycleCnt; | |
1734 | Ret = EplObdWriteEntry(0x1F98, 7, &bTemp, 1); | |
9d7164cf DK |
1735 | /* if(Ret != kEplSuccessful) |
1736 | { | |
1737 | goto Exit; | |
1738 | }*/ | |
833dfbe7 | 1739 | } |
9d7164cf | 1740 | |
833dfbe7 GKH |
1741 | if (EplApiInstance_g.m_InitParam.m_uiAsyncMtu <= |
1742 | EPL_C_DLL_MAX_ASYNC_MTU) { | |
1743 | wTemp = (WORD) EplApiInstance_g.m_InitParam.m_uiAsyncMtu; | |
1744 | Ret = EplObdWriteEntry(0x1F98, 8, &wTemp, 2); | |
9d7164cf DK |
1745 | /* if(Ret != kEplSuccessful) |
1746 | { | |
1747 | goto Exit; | |
1748 | }*/ | |
833dfbe7 GKH |
1749 | } |
1750 | ||
1751 | if (EplApiInstance_g.m_InitParam.m_uiPrescaler <= 1000) { | |
1752 | wTemp = (WORD) EplApiInstance_g.m_InitParam.m_uiPrescaler; | |
1753 | Ret = EplObdWriteEntry(0x1F98, 9, &wTemp, 2); | |
1754 | // ignore return code | |
1755 | Ret = kEplSuccessful; | |
1756 | } | |
9d7164cf | 1757 | #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) |
833dfbe7 GKH |
1758 | if (EplApiInstance_g.m_InitParam.m_dwWaitSocPreq != -1) { |
1759 | Ret = | |
1760 | EplObdWriteEntry(0x1F8A, 1, | |
1761 | &EplApiInstance_g.m_InitParam. | |
1762 | m_dwWaitSocPreq, 4); | |
1763 | /* if(Ret != kEplSuccessful) | |
1764 | { | |
1765 | goto Exit; | |
1766 | } */ | |
1767 | } | |
1768 | ||
1769 | if ((EplApiInstance_g.m_InitParam.m_dwAsyncSlotTimeout != 0) | |
1770 | && (EplApiInstance_g.m_InitParam.m_dwAsyncSlotTimeout != -1)) { | |
1771 | Ret = | |
1772 | EplObdWriteEntry(0x1F8A, 2, | |
1773 | &EplApiInstance_g.m_InitParam. | |
1774 | m_dwAsyncSlotTimeout, 4); | |
1775 | /* if(Ret != kEplSuccessful) | |
1776 | { | |
1777 | goto Exit; | |
1778 | } */ | |
1779 | } | |
9d7164cf DK |
1780 | #endif |
1781 | ||
833dfbe7 GKH |
1782 | // configure Identity |
1783 | if (EplApiInstance_g.m_InitParam.m_dwDeviceType != -1) { | |
1784 | Ret = | |
1785 | EplObdWriteEntry(0x1000, 0, | |
1786 | &EplApiInstance_g.m_InitParam. | |
1787 | m_dwDeviceType, 4); | |
9d7164cf DK |
1788 | /* if(Ret != kEplSuccessful) |
1789 | { | |
1790 | goto Exit; | |
1791 | }*/ | |
833dfbe7 | 1792 | } |
9d7164cf | 1793 | |
833dfbe7 GKH |
1794 | if (EplApiInstance_g.m_InitParam.m_dwVendorId != -1) { |
1795 | Ret = | |
1796 | EplObdWriteEntry(0x1018, 1, | |
1797 | &EplApiInstance_g.m_InitParam.m_dwVendorId, | |
1798 | 4); | |
9d7164cf DK |
1799 | /* if(Ret != kEplSuccessful) |
1800 | { | |
1801 | goto Exit; | |
1802 | }*/ | |
833dfbe7 | 1803 | } |
9d7164cf | 1804 | |
833dfbe7 GKH |
1805 | if (EplApiInstance_g.m_InitParam.m_dwProductCode != -1) { |
1806 | Ret = | |
1807 | EplObdWriteEntry(0x1018, 2, | |
1808 | &EplApiInstance_g.m_InitParam. | |
1809 | m_dwProductCode, 4); | |
9d7164cf DK |
1810 | /* if(Ret != kEplSuccessful) |
1811 | { | |
1812 | goto Exit; | |
1813 | }*/ | |
833dfbe7 | 1814 | } |
9d7164cf | 1815 | |
833dfbe7 GKH |
1816 | if (EplApiInstance_g.m_InitParam.m_dwRevisionNumber != -1) { |
1817 | Ret = | |
1818 | EplObdWriteEntry(0x1018, 3, | |
1819 | &EplApiInstance_g.m_InitParam. | |
1820 | m_dwRevisionNumber, 4); | |
9d7164cf DK |
1821 | /* if(Ret != kEplSuccessful) |
1822 | { | |
1823 | goto Exit; | |
1824 | }*/ | |
833dfbe7 | 1825 | } |
9d7164cf | 1826 | |
833dfbe7 GKH |
1827 | if (EplApiInstance_g.m_InitParam.m_dwSerialNumber != -1) { |
1828 | Ret = | |
1829 | EplObdWriteEntry(0x1018, 4, | |
1830 | &EplApiInstance_g.m_InitParam. | |
1831 | m_dwSerialNumber, 4); | |
9d7164cf DK |
1832 | /* if(Ret != kEplSuccessful) |
1833 | { | |
1834 | goto Exit; | |
1835 | }*/ | |
833dfbe7 GKH |
1836 | } |
1837 | ||
1838 | if (EplApiInstance_g.m_InitParam.m_pszDevName != NULL) { | |
1839 | // write Device Name (0x1008) | |
1840 | Ret = | |
1841 | EplObdWriteEntry(0x1008, 0, | |
1842 | (void GENERIC *)EplApiInstance_g. | |
1843 | m_InitParam.m_pszDevName, | |
1844 | (tEplObdSize) strlen(EplApiInstance_g. | |
1845 | m_InitParam. | |
1846 | m_pszDevName)); | |
9d7164cf DK |
1847 | /* if (Ret != kEplSuccessful) |
1848 | { | |
1849 | goto Exit; | |
1850 | }*/ | |
833dfbe7 GKH |
1851 | } |
1852 | ||
1853 | if (EplApiInstance_g.m_InitParam.m_pszHwVersion != NULL) { | |
1854 | // write Hardware version (0x1009) | |
1855 | Ret = | |
1856 | EplObdWriteEntry(0x1009, 0, | |
1857 | (void GENERIC *)EplApiInstance_g. | |
1858 | m_InitParam.m_pszHwVersion, | |
1859 | (tEplObdSize) strlen(EplApiInstance_g. | |
1860 | m_InitParam. | |
1861 | m_pszHwVersion)); | |
9d7164cf DK |
1862 | /* if (Ret != kEplSuccessful) |
1863 | { | |
1864 | goto Exit; | |
1865 | }*/ | |
833dfbe7 GKH |
1866 | } |
1867 | ||
1868 | if (EplApiInstance_g.m_InitParam.m_pszSwVersion != NULL) { | |
1869 | // write Software version (0x100A) | |
1870 | Ret = | |
1871 | EplObdWriteEntry(0x100A, 0, | |
1872 | (void GENERIC *)EplApiInstance_g. | |
1873 | m_InitParam.m_pszSwVersion, | |
1874 | (tEplObdSize) strlen(EplApiInstance_g. | |
1875 | m_InitParam. | |
1876 | m_pszSwVersion)); | |
9d7164cf DK |
1877 | /* if (Ret != kEplSuccessful) |
1878 | { | |
1879 | goto Exit; | |
1880 | }*/ | |
833dfbe7 | 1881 | } |
9d7164cf | 1882 | |
833dfbe7 GKH |
1883 | Exit: |
1884 | return Ret; | |
9d7164cf DK |
1885 | } |
1886 | ||
9d7164cf DK |
1887 | //--------------------------------------------------------------------------- |
1888 | // | |
1889 | // Function: EplApiCbSdoCon | |
1890 | // | |
1891 | // Description: callback function for SDO transfers | |
1892 | // | |
1893 | // Parameters: pSdoComFinished_p = SDO parameter | |
1894 | // | |
1895 | // Returns: tEplKernel = error code | |
1896 | // | |
1897 | // | |
1898 | // State: | |
1899 | // | |
1900 | //--------------------------------------------------------------------------- | |
1901 | ||
1902 | #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOC)) != 0) | |
d10f4699 | 1903 | static tEplKernel EplApiCbSdoCon(tEplSdoComFinished *pSdoComFinished_p) |
9d7164cf | 1904 | { |
833dfbe7 GKH |
1905 | tEplKernel Ret; |
1906 | tEplApiEventArg EventArg; | |
9d7164cf | 1907 | |
833dfbe7 | 1908 | Ret = kEplSuccessful; |
9d7164cf | 1909 | |
833dfbe7 GKH |
1910 | // call user callback |
1911 | EventArg.m_Sdo = *pSdoComFinished_p; | |
1912 | Ret = EplApiInstance_g.m_InitParam.m_pfnCbEvent(kEplApiEventSdo, | |
1913 | &EventArg, | |
1914 | EplApiInstance_g. | |
1915 | m_InitParam. | |
1916 | m_pEventUserArg); | |
9d7164cf | 1917 | |
833dfbe7 | 1918 | return Ret; |
9d7164cf DK |
1919 | |
1920 | } | |
1921 | #endif | |
1922 | ||
9d7164cf DK |
1923 | #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) |
1924 | ||
1925 | //--------------------------------------------------------------------------- | |
1926 | // | |
1927 | // Function: EplApiCbNodeEvent | |
1928 | // | |
1929 | // Description: callback function for node events | |
1930 | // | |
1931 | // Parameters: uiNodeId_p = node ID of the CN | |
1932 | // NodeEvent_p = event from the specified CN | |
1933 | // NmtState_p = current NMT state of the CN | |
1934 | // wErrorCode_p = EPL error code if NodeEvent_p==kEplNmtNodeEventError | |
1935 | // fMandatory_p = flag if CN is mandatory | |
1936 | // | |
1937 | // Returns: tEplKernel = error code | |
1938 | // | |
1939 | // | |
1940 | // State: | |
1941 | // | |
1942 | //--------------------------------------------------------------------------- | |
1943 | ||
d10f4699 GKH |
1944 | static tEplKernel EplApiCbNodeEvent(unsigned int uiNodeId_p, |
1945 | tEplNmtNodeEvent NodeEvent_p, | |
1946 | tEplNmtState NmtState_p, | |
1947 | WORD wErrorCode_p, BOOL fMandatory_p) | |
9d7164cf | 1948 | { |
833dfbe7 GKH |
1949 | tEplKernel Ret; |
1950 | tEplApiEventArg EventArg; | |
9d7164cf | 1951 | |
833dfbe7 | 1952 | Ret = kEplSuccessful; |
9d7164cf | 1953 | |
833dfbe7 GKH |
1954 | // call user callback |
1955 | EventArg.m_Node.m_uiNodeId = uiNodeId_p; | |
1956 | EventArg.m_Node.m_NodeEvent = NodeEvent_p; | |
1957 | EventArg.m_Node.m_NmtState = NmtState_p; | |
1958 | EventArg.m_Node.m_wErrorCode = wErrorCode_p; | |
1959 | EventArg.m_Node.m_fMandatory = fMandatory_p; | |
9d7164cf | 1960 | |
833dfbe7 GKH |
1961 | Ret = EplApiInstance_g.m_InitParam.m_pfnCbEvent(kEplApiEventNode, |
1962 | &EventArg, | |
1963 | EplApiInstance_g. | |
1964 | m_InitParam. | |
1965 | m_pEventUserArg); | |
9d7164cf | 1966 | |
833dfbe7 | 1967 | return Ret; |
9d7164cf DK |
1968 | |
1969 | } | |
1970 | ||
9d7164cf DK |
1971 | //--------------------------------------------------------------------------- |
1972 | // | |
1973 | // Function: EplApiCbBootEvent | |
1974 | // | |
1975 | // Description: callback function for boot events | |
1976 | // | |
1977 | // Parameters: BootEvent_p = event from the boot-up process | |
1978 | // NmtState_p = current local NMT state | |
1979 | // wErrorCode_p = EPL error code if BootEvent_p==kEplNmtBootEventError | |
1980 | // | |
1981 | // Returns: tEplKernel = error code | |
1982 | // | |
1983 | // | |
1984 | // State: | |
1985 | // | |
1986 | //--------------------------------------------------------------------------- | |
1987 | ||
d10f4699 GKH |
1988 | static tEplKernel EplApiCbBootEvent(tEplNmtBootEvent BootEvent_p, |
1989 | tEplNmtState NmtState_p, | |
1990 | WORD wErrorCode_p) | |
9d7164cf | 1991 | { |
833dfbe7 GKH |
1992 | tEplKernel Ret; |
1993 | tEplApiEventArg EventArg; | |
9d7164cf | 1994 | |
833dfbe7 | 1995 | Ret = kEplSuccessful; |
9d7164cf | 1996 | |
833dfbe7 GKH |
1997 | // call user callback |
1998 | EventArg.m_Boot.m_BootEvent = BootEvent_p; | |
1999 | EventArg.m_Boot.m_NmtState = NmtState_p; | |
2000 | EventArg.m_Boot.m_wErrorCode = wErrorCode_p; | |
9d7164cf | 2001 | |
833dfbe7 GKH |
2002 | Ret = EplApiInstance_g.m_InitParam.m_pfnCbEvent(kEplApiEventBoot, |
2003 | &EventArg, | |
2004 | EplApiInstance_g. | |
2005 | m_InitParam. | |
2006 | m_pEventUserArg); | |
9d7164cf | 2007 | |
833dfbe7 | 2008 | return Ret; |
9d7164cf DK |
2009 | |
2010 | } | |
2011 | ||
2012 | #endif // (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) | |
2013 | ||
9d7164cf DK |
2014 | #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_LEDU)) != 0) |
2015 | ||
2016 | //--------------------------------------------------------------------------- | |
2017 | // | |
2018 | // Function: EplApiCbLedStateChange | |
2019 | // | |
2020 | // Description: callback function for LED change events. | |
2021 | // | |
2022 | // Parameters: LedType_p = type of LED | |
2023 | // fOn_p = state of LED | |
2024 | // | |
2025 | // Returns: tEplKernel = errorcode | |
2026 | // | |
2027 | // State: | |
2028 | // | |
2029 | //--------------------------------------------------------------------------- | |
2030 | ||
d10f4699 | 2031 | static tEplKernel EplApiCbLedStateChange(tEplLedType LedType_p, BOOL fOn_p) |
9d7164cf | 2032 | { |
833dfbe7 GKH |
2033 | tEplKernel Ret; |
2034 | tEplApiEventArg EventArg; | |
9d7164cf | 2035 | |
833dfbe7 | 2036 | Ret = kEplSuccessful; |
9d7164cf | 2037 | |
833dfbe7 GKH |
2038 | // call user callback |
2039 | EventArg.m_Led.m_LedType = LedType_p; | |
2040 | EventArg.m_Led.m_fOn = fOn_p; | |
9d7164cf | 2041 | |
833dfbe7 GKH |
2042 | Ret = EplApiInstance_g.m_InitParam.m_pfnCbEvent(kEplApiEventLed, |
2043 | &EventArg, | |
2044 | EplApiInstance_g. | |
2045 | m_InitParam. | |
2046 | m_pEventUserArg); | |
9d7164cf | 2047 | |
833dfbe7 | 2048 | return Ret; |
9d7164cf DK |
2049 | |
2050 | } | |
2051 | ||
2052 | #endif | |
2053 | ||
9d7164cf | 2054 | // EOF |