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 Epl-Kernelspace-Event-Modul
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: EplEventk.c,v $
53
54 $Author: D.Krueger $
55
56 $Revision: 1.9 $ $Date: 2008/10/17 15:32:32 $
57
58 $State: Exp $
59
60 Build Environment:
61 GCC V3.4
62
63 -------------------------------------------------------------------------
64
65 Revision History:
66
67 2006/06/20 k.t.: start of the implementation
68
69 ****************************************************************************/
70
71 #include "kernel/EplEventk.h"
72 #include "kernel/EplNmtk.h"
73 #include "kernel/EplDllk.h"
74 #include "kernel/EplDllkCal.h"
75 #include "kernel/EplErrorHandlerk.h"
76 #include "Benchmark.h"
77
78 #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_PDOK)) != 0)
79 #include "kernel/EplPdok.h"
80 #include "kernel/EplPdokCal.h"
81 #endif
82
83 #ifdef EPL_NO_FIFO
84 #include "user/EplEventu.h"
85 #else
86 #include "SharedBuff.h"
87 #endif
88
89 /***************************************************************************/
90 /* */
91 /* */
92 /* G L O B A L D E F I N I T I O N S */
93 /* */
94 /* */
95 /***************************************************************************/
96
97 //---------------------------------------------------------------------------
98 // const defines
99 //---------------------------------------------------------------------------
100
101 // TracePoint support for realtime-debugging
102 #ifdef _DBG_TRACE_POINTS_
103 void TgtDbgSignalTracePoint(u8 bTracePointNumber_p);
104 void TgtDbgPostTraceValue(u32 dwTraceValue_p);
105 #define TGT_DBG_SIGNAL_TRACE_POINT(p) TgtDbgSignalTracePoint(p)
106 #define TGT_DBG_POST_TRACE_VALUE(v) TgtDbgPostTraceValue(v)
107 #else
108 #define TGT_DBG_SIGNAL_TRACE_POINT(p)
109 #define TGT_DBG_POST_TRACE_VALUE(v)
110 #endif
111
112 //---------------------------------------------------------------------------
113 // local types
114 //---------------------------------------------------------------------------
115
116 typedef struct {
117 #ifndef EPL_NO_FIFO
118 tShbInstance m_pShbKernelToUserInstance;
119 tShbInstance m_pShbUserToKernelInstance;
120 #else
121
122 #endif
123 tEplSyncCb m_pfnCbSync;
124 unsigned int m_uiUserToKernelFullCount;
125
126 } tEplEventkInstance;
127
128 //---------------------------------------------------------------------------
129 // modul globale vars
130 //---------------------------------------------------------------------------
131 static tEplEventkInstance EplEventkInstance_g;
132 //---------------------------------------------------------------------------
133 // local function prototypes
134 //---------------------------------------------------------------------------
135
136 // callback function for incoming events
137 #ifndef EPL_NO_FIFO
138 static void EplEventkRxSignalHandlerCb(tShbInstance pShbRxInstance_p,
139 unsigned long ulDataSize_p);
140 #endif
141
142 /***************************************************************************/
143 /* */
144 /* */
145 /* C L A S S <Epl-Kernelspace-Event> */
146 /* */
147 /* */
148 /***************************************************************************/
149 //
150 // Description:
151 //
152 //
153 /***************************************************************************/
154
155 //=========================================================================//
156 // //
157 // P U B L I C F U N C T I O N S //
158 // //
159 //=========================================================================//
160
161 //---------------------------------------------------------------------------
162 //
163 // Function: EplEventkInit
164 //
165 // Description: function initializes the first instance
166 //
167 // Parameters: pfnCbSync_p = callback-function for sync event
168 //
169 // Returns: tEpKernel = errorcode
170 //
171 // State:
172 //
173 //---------------------------------------------------------------------------
174
175 tEplKernel EplEventkInit(tEplSyncCb pfnCbSync_p)
176 {
177 tEplKernel Ret;
178
179 Ret = EplEventkAddInstance(pfnCbSync_p);
180
181 return Ret;
182
183 }
184
185 //---------------------------------------------------------------------------
186 //
187 // Function: EplEventkAddInstance
188 //
189 // Description: function adds one more instance
190 //
191 // Parameters: pfnCbSync_p = callback-function for sync event
192 //
193 // Returns: tEpKernel = errorcode
194 //
195 // State:
196 //
197 //---------------------------------------------------------------------------
198
199 tEplKernel EplEventkAddInstance(tEplSyncCb pfnCbSync_p)
200 {
201 tEplKernel Ret;
202 #ifndef EPL_NO_FIFO
203 tShbError ShbError;
204 unsigned int fShbNewCreated;
205 #endif
206
207 Ret = kEplSuccessful;
208
209 // init instance structure
210 EplEventkInstance_g.m_uiUserToKernelFullCount = 0;
211
212 // save cb-function
213 EplEventkInstance_g.m_pfnCbSync = pfnCbSync_p;
214
215 #ifndef EPL_NO_FIFO
216 // init shared loop buffer
217 // kernel -> user
218 ShbError = ShbCirAllocBuffer(EPL_EVENT_SIZE_SHB_KERNEL_TO_USER,
219 EPL_EVENT_NAME_SHB_KERNEL_TO_USER,
220 &EplEventkInstance_g.
221 m_pShbKernelToUserInstance,
222 &fShbNewCreated);
223 if (ShbError != kShbOk) {
224 EPL_DBGLVL_EVENTK_TRACE1
225 ("EplEventkAddInstance(): ShbCirAllocBuffer(K2U) -> 0x%X\n",
226 ShbError);
227 Ret = kEplNoResource;
228 goto Exit;
229 }
230 // user -> kernel
231 ShbError = ShbCirAllocBuffer(EPL_EVENT_SIZE_SHB_USER_TO_KERNEL,
232 EPL_EVENT_NAME_SHB_USER_TO_KERNEL,
233 &EplEventkInstance_g.
234 m_pShbUserToKernelInstance,
235 &fShbNewCreated);
236 if (ShbError != kShbOk) {
237 EPL_DBGLVL_EVENTK_TRACE1
238 ("EplEventkAddInstance(): ShbCirAllocBuffer(U2K) -> 0x%X\n",
239 ShbError);
240 Ret = kEplNoResource;
241 goto Exit;
242 }
243 // register eventhandler
244 ShbError =
245 ShbCirSetSignalHandlerNewData(EplEventkInstance_g.
246 m_pShbUserToKernelInstance,
247 EplEventkRxSignalHandlerCb,
248 kshbPriorityHigh);
249 if (ShbError != kShbOk) {
250 EPL_DBGLVL_EVENTK_TRACE1
251 ("EplEventkAddInstance(): ShbCirSetSignalHandlerNewData(U2K) -> 0x%X\n",
252 ShbError);
253 Ret = kEplNoResource;
254 goto Exit;
255 }
256
257 Exit:
258 #endif
259
260 return Ret;
261
262 }
263
264 //---------------------------------------------------------------------------
265 //
266 // Function: EplEventkDelInstance
267 //
268 // Description: function deletes instance and frees the buffers
269 //
270 // Parameters: void
271 //
272 // Returns: tEpKernel = errorcode
273 //
274 // State:
275 //
276 //---------------------------------------------------------------------------
277
278 tEplKernel EplEventkDelInstance(void)
279 {
280 tEplKernel Ret;
281 #ifndef EPL_NO_FIFO
282 tShbError ShbError;
283 #endif
284
285 Ret = kEplSuccessful;
286
287 #ifndef EPL_NO_FIFO
288 // set eventhandler to NULL
289 ShbError =
290 ShbCirSetSignalHandlerNewData(EplEventkInstance_g.
291 m_pShbUserToKernelInstance, NULL,
292 kShbPriorityNormal);
293 if (ShbError != kShbOk) {
294 EPL_DBGLVL_EVENTK_TRACE1
295 ("EplEventkDelInstance(): ShbCirSetSignalHandlerNewData(U2K) -> 0x%X\n",
296 ShbError);
297 Ret = kEplNoResource;
298 }
299 // free buffer User -> Kernel
300 ShbError =
301 ShbCirReleaseBuffer(EplEventkInstance_g.m_pShbUserToKernelInstance);
302 if (ShbError != kShbOk) {
303 EPL_DBGLVL_EVENTK_TRACE1
304 ("EplEventkDelInstance(): ShbCirReleaseBuffer(U2K) -> 0x%X\n",
305 ShbError);
306 Ret = kEplNoResource;
307 } else {
308 EplEventkInstance_g.m_pShbUserToKernelInstance = NULL;
309 }
310
311 // free buffer Kernel -> User
312 ShbError =
313 ShbCirReleaseBuffer(EplEventkInstance_g.m_pShbKernelToUserInstance);
314 if (ShbError != kShbOk) {
315 EPL_DBGLVL_EVENTK_TRACE1
316 ("EplEventkDelInstance(): ShbCirReleaseBuffer(K2U) -> 0x%X\n",
317 ShbError);
318 Ret = kEplNoResource;
319 } else {
320 EplEventkInstance_g.m_pShbKernelToUserInstance = NULL;
321 }
322 #endif
323
324 return Ret;
325
326 }
327
328 //---------------------------------------------------------------------------
329 //
330 // Function: EplEventkProcess
331 //
332 // Description: Kernelthread that dispatches events in kernel part
333 //
334 // Parameters: pEvent_p = pointer to event-structure from buffer
335 //
336 // Returns: tEpKernel = errorcode
337 //
338 // State:
339 //
340 //---------------------------------------------------------------------------
341
342 tEplKernel EplEventkProcess(tEplEvent *pEvent_p)
343 {
344 tEplKernel Ret;
345 tEplEventSource EventSource;
346
347 Ret = kEplSuccessful;
348
349 // error handling if event queue is full
350 if (EplEventkInstance_g.m_uiUserToKernelFullCount > 0) { // UserToKernel event queue has run out of space -> kEplNmtEventInternComError
351 #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTK)) != 0)
352 tEplEvent Event;
353 tEplNmtEvent NmtEvent;
354 #endif
355 #ifndef EPL_NO_FIFO
356 tShbError ShbError;
357 #endif
358
359 // directly call NMTk process function, because event queue is full
360 #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTK)) != 0)
361 NmtEvent = kEplNmtEventInternComError;
362 Event.m_EventSink = kEplEventSinkNmtk;
363 Event.m_NetTime.m_dwNanoSec = 0;
364 Event.m_NetTime.m_dwSec = 0;
365 Event.m_EventType = kEplEventTypeNmtEvent;
366 Event.m_pArg = &NmtEvent;
367 Event.m_uiSize = sizeof(NmtEvent);
368 Ret = EplNmtkProcess(&Event);
369 #endif
370
371 // NMT state machine changed to reset (i.e. NMT_GS_RESET_COMMUNICATION)
372 // now, it is safe to reset the counter and empty the event queue
373 #ifndef EPL_NO_FIFO
374 ShbError =
375 ShbCirResetBuffer(EplEventkInstance_g.
376 m_pShbUserToKernelInstance, 1000, NULL);
377 #endif
378
379 EplEventkInstance_g.m_uiUserToKernelFullCount = 0;
380 TGT_DBG_SIGNAL_TRACE_POINT(22);
381
382 // also discard the current event (it doesn't matter if we lose another event)
383 goto Exit;
384 }
385 // check m_EventSink
386 switch (pEvent_p->m_EventSink) {
387 case kEplEventSinkSync:
388 {
389 if (EplEventkInstance_g.m_pfnCbSync != NULL) {
390 Ret = EplEventkInstance_g.m_pfnCbSync();
391 if (Ret == kEplSuccessful) {
392 #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_PDOK)) != 0)
393 // mark TPDOs as valid
394 Ret = EplPdokCalSetTpdosValid(TRUE);
395 #endif
396 } else if ((Ret != kEplReject)
397 && (Ret != kEplShutdown)) {
398 EventSource = kEplEventSourceSyncCb;
399
400 // Error event for API layer
401 EplEventkPostError
402 (kEplEventSourceEventk, Ret,
403 sizeof(EventSource), &EventSource);
404 }
405 }
406 break;
407 }
408
409 // NMT-Kernel-Modul
410 case kEplEventSinkNmtk:
411 {
412 #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTK)) != 0)
413 Ret = EplNmtkProcess(pEvent_p);
414 if ((Ret != kEplSuccessful) && (Ret != kEplShutdown)) {
415 EventSource = kEplEventSourceNmtk;
416
417 // Error event for API layer
418 EplEventkPostError(kEplEventSourceEventk,
419 Ret,
420 sizeof(EventSource),
421 &EventSource);
422 }
423 #endif
424 #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLK)) != 0)
425 if ((pEvent_p->m_EventType == kEplEventTypeNmtEvent)
426 &&
427 ((*((tEplNmtEvent *) pEvent_p->m_pArg) ==
428 kEplNmtEventDllCeSoa)
429 #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0)
430 || (*((tEplNmtEvent *) pEvent_p->m_pArg) ==
431 kEplNmtEventDllMeSoaSent)
432 #endif
433 )) { // forward SoA event to error handler
434 Ret = EplErrorHandlerkProcess(pEvent_p);
435 if ((Ret != kEplSuccessful)
436 && (Ret != kEplShutdown)) {
437 EventSource = kEplEventSourceErrk;
438
439 // Error event for API layer
440 EplEventkPostError
441 (kEplEventSourceEventk, Ret,
442 sizeof(EventSource), &EventSource);
443 }
444 #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_PDOK)) != 0)
445 // forward SoA event to PDO module
446 pEvent_p->m_EventType = kEplEventTypePdoSoa;
447 Ret = EplPdokProcess(pEvent_p);
448 if ((Ret != kEplSuccessful)
449 && (Ret != kEplShutdown)) {
450 EventSource = kEplEventSourcePdok;
451
452 // Error event for API layer
453 EplEventkPostError
454 (kEplEventSourceEventk, Ret,
455 sizeof(EventSource), &EventSource);
456 }
457 #endif
458
459 }
460 break;
461 #endif
462 }
463
464 // events for Dllk module
465 case kEplEventSinkDllk:
466 {
467 #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLK)) != 0)
468 Ret = EplDllkProcess(pEvent_p);
469 if ((Ret != kEplSuccessful) && (Ret != kEplShutdown)) {
470 EventSource = kEplEventSourceDllk;
471
472 // Error event for API layer
473 EplEventkPostError(kEplEventSourceEventk,
474 Ret,
475 sizeof(EventSource),
476 &EventSource);
477 }
478 #endif
479 break;
480 }
481
482 // events for DllkCal module
483 case kEplEventSinkDllkCal:
484 {
485 #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLK)) != 0)
486 Ret = EplDllkCalProcess(pEvent_p);
487 if ((Ret != kEplSuccessful) && (Ret != kEplShutdown)) {
488 EventSource = kEplEventSourceDllk;
489
490 // Error event for API layer
491 EplEventkPostError(kEplEventSourceEventk,
492 Ret,
493 sizeof(EventSource),
494 &EventSource);
495 }
496 #endif
497 break;
498 }
499
500 //
501 case kEplEventSinkPdok:
502 {
503 // PDO-Module
504 #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_PDOK)) != 0)
505 Ret = EplPdokProcess(pEvent_p);
506 if ((Ret != kEplSuccessful) && (Ret != kEplShutdown)) {
507 EventSource = kEplEventSourcePdok;
508
509 // Error event for API layer
510 EplEventkPostError(kEplEventSourceEventk,
511 Ret,
512 sizeof(EventSource),
513 &EventSource);
514 }
515 #endif
516 break;
517 }
518
519 // events for Error handler module
520 case kEplEventSinkErrk:
521 {
522 // only call error handler if DLL is present
523 #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLK)) != 0)
524 Ret = EplErrorHandlerkProcess(pEvent_p);
525 if ((Ret != kEplSuccessful) && (Ret != kEplShutdown)) {
526 EventSource = kEplEventSourceErrk;
527
528 // Error event for API layer
529 EplEventkPostError(kEplEventSourceEventk,
530 Ret,
531 sizeof(EventSource),
532 &EventSource);
533 }
534 break;
535 #endif
536 }
537
538 // unknown sink
539 default:
540 {
541 Ret = kEplEventUnknownSink;
542 }
543
544 } // end of switch(pEvent_p->m_EventSink)
545
546 Exit:
547 return Ret;
548
549 }
550
551 //---------------------------------------------------------------------------
552 //
553 // Function: EplEventkPost
554 //
555 // Description: post events from kernel part
556 //
557 // Parameters: pEvent_p = pointer to event-structure from buffer
558 //
559 // Returns: tEpKernel = errorcode
560 //
561 // State:
562 //
563 //---------------------------------------------------------------------------
564
565 tEplKernel EplEventkPost(tEplEvent *pEvent_p)
566 {
567 tEplKernel Ret;
568 #ifndef EPL_NO_FIFO
569 tShbError ShbError;
570 tShbCirChunk ShbCirChunk;
571 unsigned long ulDataSize;
572 unsigned int fBufferCompleted;
573 #endif
574
575 Ret = kEplSuccessful;
576
577 // the event must be posted by using the abBuffer
578 // it is neede because the Argument must by copied
579 // to the buffer too and not only the pointer
580
581 #ifndef EPL_NO_FIFO
582 // 2006/08/03 d.k.: Event and argument are posted as separate chunks to the event queue.
583 ulDataSize =
584 sizeof(tEplEvent) +
585 ((pEvent_p->m_pArg != NULL) ? pEvent_p->m_uiSize : 0);
586 #endif
587
588 // decide in which buffer the event have to write
589 switch (pEvent_p->m_EventSink) {
590 // kernelspace modules
591 case kEplEventSinkSync:
592 case kEplEventSinkNmtk:
593 case kEplEventSinkDllk:
594 case kEplEventSinkDllkCal:
595 case kEplEventSinkPdok:
596 case kEplEventSinkErrk:
597 {
598 #ifndef EPL_NO_FIFO
599 // post message
600 BENCHMARK_MOD_27_SET(2);
601 ShbError =
602 ShbCirAllocDataBlock(EplEventkInstance_g.
603 m_pShbUserToKernelInstance,
604 &ShbCirChunk, ulDataSize);
605 switch (ShbError) {
606 case kShbOk:
607 break;
608
609 case kShbBufferFull:
610 {
611 EplEventkInstance_g.
612 m_uiUserToKernelFullCount++;
613 Ret = kEplEventPostError;
614 goto Exit;
615 }
616
617 default:
618 {
619 EPL_DBGLVL_EVENTK_TRACE1
620 ("EplEventkPost(): ShbCirAllocDataBlock(U2K) -> 0x%X\n",
621 ShbError);
622 Ret = kEplEventPostError;
623 goto Exit;
624 }
625 }
626 ShbError =
627 ShbCirWriteDataChunk(EplEventkInstance_g.
628 m_pShbUserToKernelInstance,
629 &ShbCirChunk, pEvent_p,
630 sizeof(tEplEvent),
631 &fBufferCompleted);
632 if (ShbError != kShbOk) {
633 EPL_DBGLVL_EVENTK_TRACE1
634 ("EplEventkPost(): ShbCirWriteDataChunk(U2K) -> 0x%X\n",
635 ShbError);
636 Ret = kEplEventPostError;
637 goto Exit;
638 }
639 if (fBufferCompleted == FALSE) {
640 ShbError =
641 ShbCirWriteDataChunk(EplEventkInstance_g.
642 m_pShbUserToKernelInstance,
643 &ShbCirChunk,
644 pEvent_p->m_pArg,
645 (unsigned long)
646 pEvent_p->m_uiSize,
647 &fBufferCompleted);
648 if ((ShbError != kShbOk)
649 || (fBufferCompleted == FALSE)) {
650 EPL_DBGLVL_EVENTK_TRACE1
651 ("EplEventkPost(): ShbCirWriteDataChunk2(U2K) -> 0x%X\n",
652 ShbError);
653 Ret = kEplEventPostError;
654 goto Exit;
655 }
656 }
657 BENCHMARK_MOD_27_RESET(2);
658
659 #else
660 Ret = EplEventkProcess(pEvent_p);
661 #endif
662
663 break;
664 }
665
666 // userspace modules
667 case kEplEventSinkNmtu:
668 case kEplEventSinkNmtMnu:
669 case kEplEventSinkSdoAsySeq:
670 case kEplEventSinkApi:
671 case kEplEventSinkDlluCal:
672 case kEplEventSinkErru:
673 {
674 #ifndef EPL_NO_FIFO
675 // post message
676 // BENCHMARK_MOD_27_SET(3); // 74 µs until reset
677 ShbError =
678 ShbCirAllocDataBlock(EplEventkInstance_g.
679 m_pShbKernelToUserInstance,
680 &ShbCirChunk, ulDataSize);
681 if (ShbError != kShbOk) {
682 EPL_DBGLVL_EVENTK_TRACE1
683 ("EplEventkPost(): ShbCirAllocDataBlock(K2U) -> 0x%X\n",
684 ShbError);
685 Ret = kEplEventPostError;
686 goto Exit;
687 }
688 ShbError =
689 ShbCirWriteDataChunk(EplEventkInstance_g.
690 m_pShbKernelToUserInstance,
691 &ShbCirChunk, pEvent_p,
692 sizeof(tEplEvent),
693 &fBufferCompleted);
694 if (ShbError != kShbOk) {
695 EPL_DBGLVL_EVENTK_TRACE1
696 ("EplEventkPost(): ShbCirWriteDataChunk(K2U) -> 0x%X\n",
697 ShbError);
698 Ret = kEplEventPostError;
699 goto Exit;
700 }
701 if (fBufferCompleted == FALSE) {
702 ShbError =
703 ShbCirWriteDataChunk(EplEventkInstance_g.
704 m_pShbKernelToUserInstance,
705 &ShbCirChunk,
706 pEvent_p->m_pArg,
707 (unsigned long)
708 pEvent_p->m_uiSize,
709 &fBufferCompleted);
710 if ((ShbError != kShbOk)
711 || (fBufferCompleted == FALSE)) {
712 EPL_DBGLVL_EVENTK_TRACE1
713 ("EplEventkPost(): ShbCirWriteDataChunk2(K2U) -> 0x%X\n",
714 ShbError);
715 Ret = kEplEventPostError;
716 goto Exit;
717 }
718 }
719 // BENCHMARK_MOD_27_RESET(3); // 82 µs until ShbCirGetReadDataSize() in EplEventu
720
721 #else
722 Ret = EplEventuProcess(pEvent_p);
723 #endif
724
725 break;
726 }
727
728 default:
729 {
730 Ret = kEplEventUnknownSink;
731 }
732
733 } // end of switch(pEvent_p->m_EventSink)
734
735 #ifndef EPL_NO_FIFO
736 Exit:
737 #endif
738 return Ret;
739 }
740
741 //---------------------------------------------------------------------------
742 //
743 // Function: EplEventkPostError
744 //
745 // Description: post error event from kernel part to API layer
746 //
747 // Parameters: EventSource_p = source-module of the error event
748 // EplError_p = code of occured error
749 // ArgSize_p = size of the argument
750 // pArg_p = pointer to the argument
751 //
752 // Returns: tEpKernel = errorcode
753 //
754 // State:
755 //
756 //---------------------------------------------------------------------------
757
758 tEplKernel EplEventkPostError(tEplEventSource EventSource_p,
759 tEplKernel EplError_p,
760 unsigned int uiArgSize_p, void *pArg_p)
761 {
762 tEplKernel Ret;
763 u8 abBuffer[EPL_MAX_EVENT_ARG_SIZE];
764 tEplEventError *pEventError = (tEplEventError *) abBuffer;
765 tEplEvent EplEvent;
766
767 Ret = kEplSuccessful;
768
769 // create argument
770 pEventError->m_EventSource = EventSource_p;
771 pEventError->m_EplError = EplError_p;
772 EPL_MEMCPY(&pEventError->m_Arg, pArg_p, uiArgSize_p);
773
774 // create event
775 EplEvent.m_EventType = kEplEventTypeError;
776 EplEvent.m_EventSink = kEplEventSinkApi;
777 EPL_MEMSET(&EplEvent.m_NetTime, 0x00, sizeof(EplEvent.m_NetTime));
778 EplEvent.m_uiSize =
779 (sizeof(EventSource_p) + sizeof(EplError_p) + uiArgSize_p);
780 EplEvent.m_pArg = &abBuffer[0];
781
782 // post errorevent
783 Ret = EplEventkPost(&EplEvent);
784
785 return Ret;
786 }
787
788 //=========================================================================//
789 // //
790 // P R I V A T E F U N C T I O N S //
791 // //
792 //=========================================================================//
793
794 //---------------------------------------------------------------------------
795 //
796 // Function: EplEventkRxSignalHandlerCb()
797 //
798 // Description: Callback-function for events from user and kernel part
799 //
800 // Parameters: pShbRxInstance_p = Instance-pointer of buffer
801 // ulDataSize_p = size of data
802 //
803 // Returns: void
804 //
805 // State:
806 //
807 //---------------------------------------------------------------------------
808
809 #ifndef EPL_NO_FIFO
810 static void EplEventkRxSignalHandlerCb(tShbInstance pShbRxInstance_p,
811 unsigned long ulDataSize_p)
812 {
813 tEplEvent *pEplEvent;
814 tShbError ShbError;
815 //unsigned long ulBlockCount;
816 //unsigned long ulDataSize;
817 u8 abDataBuffer[sizeof(tEplEvent) + EPL_MAX_EVENT_ARG_SIZE];
818 // d.k.: abDataBuffer contains the complete tEplEvent structure
819 // and behind this the argument
820
821 TGT_DBG_SIGNAL_TRACE_POINT(20);
822
823 BENCHMARK_MOD_27_RESET(0);
824 // copy data from event queue
825 ShbError = ShbCirReadDataBlock(pShbRxInstance_p,
826 &abDataBuffer[0],
827 sizeof(abDataBuffer), &ulDataSize_p);
828 if (ShbError != kShbOk) {
829 // error goto exit
830 goto Exit;
831 }
832 // resolve the pointer to the event structure
833 pEplEvent = (tEplEvent *) abDataBuffer;
834 // set Datasize
835 pEplEvent->m_uiSize = (ulDataSize_p - sizeof(tEplEvent));
836 if (pEplEvent->m_uiSize > 0) {
837 // set pointer to argument
838 pEplEvent->m_pArg = &abDataBuffer[sizeof(tEplEvent)];
839 } else {
840 //set pointer to NULL
841 pEplEvent->m_pArg = NULL;
842 }
843
844 BENCHMARK_MOD_27_SET(0);
845 // call processfunction
846 EplEventkProcess(pEplEvent);
847
848 Exit:
849 return;
850 }
851 #endif
852
853 // EOF
854
|
This page was automatically generated by the
LXR engine.
|