85df0b8520
() isn't valid, you need to put (void). Cc: Daniel Krueger <daniel.krueger@systec-electronic.com> Cc: Ronald Sieber <Ronald.Sieber@systec-electronic.com> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
530 lines
16 KiB
C
530 lines
16 KiB
C
/****************************************************************************
|
|
|
|
(c) SYSTEC electronic GmbH, D-07973 Greiz, August-Bebel-Str. 29
|
|
www.systec-electronic.com
|
|
|
|
Project: openPOWERLINK
|
|
|
|
Description: source file for DLL Communication Abstraction Layer module in EPL user part
|
|
|
|
License:
|
|
|
|
Redistribution and use in source and binary forms, with or without
|
|
modification, are permitted provided that the following conditions
|
|
are met:
|
|
|
|
1. Redistributions of source code must retain the above copyright
|
|
notice, this list of conditions and the following disclaimer.
|
|
|
|
2. Redistributions in binary form must reproduce the above copyright
|
|
notice, this list of conditions and the following disclaimer in the
|
|
documentation and/or other materials provided with the distribution.
|
|
|
|
3. Neither the name of SYSTEC electronic GmbH nor the names of its
|
|
contributors may be used to endorse or promote products derived
|
|
from this software without prior written permission. For written
|
|
permission, please contact info@systec-electronic.com.
|
|
|
|
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
"AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
|
FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
|
COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
|
BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
|
LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
|
|
CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
|
ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
POSSIBILITY OF SUCH DAMAGE.
|
|
|
|
Severability Clause:
|
|
|
|
If a provision of this License is or becomes illegal, invalid or
|
|
unenforceable in any jurisdiction, that shall not affect:
|
|
1. the validity or enforceability in that jurisdiction of any other
|
|
provision of this License; or
|
|
2. the validity or enforceability in other jurisdictions of that or
|
|
any other provision of this License.
|
|
|
|
-------------------------------------------------------------------------
|
|
|
|
$RCSfile: EplDlluCal.c,v $
|
|
|
|
$Author: D.Krueger $
|
|
|
|
$Revision: 1.7 $ $Date: 2008/10/17 15:32:32 $
|
|
|
|
$State: Exp $
|
|
|
|
Build Environment:
|
|
GCC V3.4
|
|
|
|
-------------------------------------------------------------------------
|
|
|
|
Revision History:
|
|
|
|
2006/06/20 d.k.: start of the implementation, version 1.00
|
|
|
|
****************************************************************************/
|
|
|
|
#include "user/EplDlluCal.h"
|
|
#include "user/EplEventu.h"
|
|
|
|
#include "EplDllCal.h"
|
|
|
|
// include only if direct call between user- and kernelspace is enabled
|
|
#if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLK)) != 0)
|
|
#include "kernel/EplDllkCal.h"
|
|
#endif
|
|
|
|
#if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLU)) != 0)
|
|
|
|
/***************************************************************************/
|
|
/* */
|
|
/* */
|
|
/* G L O B A L D E F I N I T I O N S */
|
|
/* */
|
|
/* */
|
|
/***************************************************************************/
|
|
|
|
//---------------------------------------------------------------------------
|
|
// const defines
|
|
//---------------------------------------------------------------------------
|
|
|
|
//---------------------------------------------------------------------------
|
|
// local types
|
|
//---------------------------------------------------------------------------
|
|
|
|
//---------------------------------------------------------------------------
|
|
// modul globale vars
|
|
//---------------------------------------------------------------------------
|
|
|
|
//---------------------------------------------------------------------------
|
|
// local function prototypes
|
|
//---------------------------------------------------------------------------
|
|
|
|
/***************************************************************************/
|
|
/* */
|
|
/* */
|
|
/* C L A S S EplDlluCal */
|
|
/* */
|
|
/* */
|
|
/***************************************************************************/
|
|
//
|
|
// Description:
|
|
//
|
|
//
|
|
/***************************************************************************/
|
|
|
|
//=========================================================================//
|
|
// //
|
|
// P R I V A T E D E F I N I T I O N S //
|
|
// //
|
|
//=========================================================================//
|
|
|
|
//---------------------------------------------------------------------------
|
|
// const defines
|
|
//---------------------------------------------------------------------------
|
|
|
|
//---------------------------------------------------------------------------
|
|
// local types
|
|
//---------------------------------------------------------------------------
|
|
|
|
typedef struct {
|
|
tEplDlluCbAsnd m_apfnDlluCbAsnd[EPL_DLL_MAX_ASND_SERVICE_ID];
|
|
|
|
} tEplDlluCalInstance;
|
|
|
|
//---------------------------------------------------------------------------
|
|
// local vars
|
|
//---------------------------------------------------------------------------
|
|
|
|
// if no dynamic memory allocation shall be used
|
|
// define structures statically
|
|
static tEplDlluCalInstance EplDlluCalInstance_g;
|
|
|
|
//---------------------------------------------------------------------------
|
|
// local function prototypes
|
|
//---------------------------------------------------------------------------
|
|
|
|
static tEplKernel EplDlluCalSetAsndServiceIdFilter(tEplDllAsndServiceId
|
|
ServiceId_p,
|
|
tEplDllAsndFilter Filter_p);
|
|
|
|
//=========================================================================//
|
|
// //
|
|
// P U B L I C F U N C T I O N S //
|
|
// //
|
|
//=========================================================================//
|
|
|
|
//---------------------------------------------------------------------------
|
|
//
|
|
// Function: EplDlluCalAddInstance()
|
|
//
|
|
// Description: add and initialize new instance of DLL CAL module
|
|
//
|
|
// Parameters: none
|
|
//
|
|
// Returns: tEplKernel = error code
|
|
//
|
|
//
|
|
// State:
|
|
//
|
|
//---------------------------------------------------------------------------
|
|
|
|
tEplKernel EplDlluCalAddInstance(void)
|
|
{
|
|
tEplKernel Ret = kEplSuccessful;
|
|
|
|
// reset instance structure
|
|
EPL_MEMSET(&EplDlluCalInstance_g, 0, sizeof(EplDlluCalInstance_g));
|
|
|
|
return Ret;
|
|
}
|
|
|
|
//---------------------------------------------------------------------------
|
|
//
|
|
// Function: EplDlluCalDelInstance()
|
|
//
|
|
// Description: deletes an instance of DLL CAL module
|
|
//
|
|
// Parameters: none
|
|
//
|
|
// Returns: tEplKernel = error code
|
|
//
|
|
//
|
|
// State:
|
|
//
|
|
//---------------------------------------------------------------------------
|
|
|
|
tEplKernel EplDlluCalDelInstance(void)
|
|
{
|
|
tEplKernel Ret = kEplSuccessful;
|
|
|
|
// reset instance structure
|
|
EPL_MEMSET(&EplDlluCalInstance_g, 0, sizeof(EplDlluCalInstance_g));
|
|
|
|
return Ret;
|
|
}
|
|
|
|
//---------------------------------------------------------------------------
|
|
//
|
|
// Function: EplDlluCalProcess
|
|
//
|
|
// Description: process the passed asynch frame
|
|
//
|
|
// Parameters: pEvent_p = event containing frame to be processed
|
|
//
|
|
// Returns: tEplKernel = error code
|
|
//
|
|
//
|
|
// State:
|
|
//
|
|
//---------------------------------------------------------------------------
|
|
|
|
tEplKernel EplDlluCalProcess(tEplEvent * pEvent_p)
|
|
{
|
|
tEplKernel Ret = kEplSuccessful;
|
|
tEplMsgType MsgType;
|
|
unsigned int uiAsndServiceId;
|
|
tEplFrameInfo FrameInfo;
|
|
|
|
if (pEvent_p->m_EventType == kEplEventTypeAsndRx) {
|
|
FrameInfo.m_pFrame = (tEplFrame *) pEvent_p->m_pArg;
|
|
FrameInfo.m_uiFrameSize = pEvent_p->m_uiSize;
|
|
// extract NetTime
|
|
FrameInfo.m_NetTime = pEvent_p->m_NetTime;
|
|
|
|
MsgType =
|
|
(tEplMsgType) AmiGetByteFromLe(&FrameInfo.m_pFrame->
|
|
m_le_bMessageType);
|
|
if (MsgType != kEplMsgTypeAsnd) {
|
|
Ret = kEplInvalidOperation;
|
|
goto Exit;
|
|
}
|
|
|
|
uiAsndServiceId =
|
|
(unsigned int)AmiGetByteFromLe(&FrameInfo.m_pFrame->m_Data.
|
|
m_Asnd.m_le_bServiceId);
|
|
if (uiAsndServiceId < EPL_DLL_MAX_ASND_SERVICE_ID) { // ASnd service ID is valid
|
|
if (EplDlluCalInstance_g.m_apfnDlluCbAsnd[uiAsndServiceId] != NULL) { // handler was registered
|
|
Ret =
|
|
EplDlluCalInstance_g.
|
|
m_apfnDlluCbAsnd[uiAsndServiceId]
|
|
(&FrameInfo);
|
|
}
|
|
}
|
|
}
|
|
|
|
Exit:
|
|
return Ret;
|
|
}
|
|
|
|
//---------------------------------------------------------------------------
|
|
//
|
|
// Function: EplDlluCalRegAsndService()
|
|
//
|
|
// Description: registers the specified handler for the specified
|
|
// AsndServiceId with the specified node ID filter.
|
|
//
|
|
// Parameters: ServiceId_p = ASnd Service ID
|
|
// pfnDlluCbAsnd_p = callback function
|
|
// Filter_p = node ID filter
|
|
//
|
|
// Returns: tEplKernel = error code
|
|
//
|
|
//
|
|
// State:
|
|
//
|
|
//---------------------------------------------------------------------------
|
|
|
|
tEplKernel EplDlluCalRegAsndService(tEplDllAsndServiceId ServiceId_p,
|
|
tEplDlluCbAsnd pfnDlluCbAsnd_p,
|
|
tEplDllAsndFilter Filter_p)
|
|
{
|
|
tEplKernel Ret = kEplSuccessful;
|
|
|
|
if (ServiceId_p < tabentries(EplDlluCalInstance_g.m_apfnDlluCbAsnd)) {
|
|
// memorize function pointer
|
|
EplDlluCalInstance_g.m_apfnDlluCbAsnd[ServiceId_p] =
|
|
pfnDlluCbAsnd_p;
|
|
|
|
if (pfnDlluCbAsnd_p == NULL) { // close filter
|
|
Filter_p = kEplDllAsndFilterNone;
|
|
}
|
|
// set filter in DLL module in kernel part
|
|
Ret = EplDlluCalSetAsndServiceIdFilter(ServiceId_p, Filter_p);
|
|
|
|
}
|
|
|
|
return Ret;
|
|
}
|
|
|
|
//---------------------------------------------------------------------------
|
|
//
|
|
// Function: EplDlluCalAsyncSend()
|
|
//
|
|
// Description: sends the frame with the specified priority.
|
|
//
|
|
// Parameters: pFrameInfo_p = frame
|
|
// m_uiFrameSize does not include the
|
|
// ethernet header (14 bytes)
|
|
// Priority_p = priority
|
|
//
|
|
// Returns: tEplKernel = error code
|
|
//
|
|
//
|
|
// State:
|
|
//
|
|
//---------------------------------------------------------------------------
|
|
|
|
tEplKernel EplDlluCalAsyncSend(tEplFrameInfo * pFrameInfo_p,
|
|
tEplDllAsyncReqPriority Priority_p)
|
|
{
|
|
tEplKernel Ret = kEplSuccessful;
|
|
|
|
#if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLK)) != 0)
|
|
pFrameInfo_p->m_uiFrameSize += 14; // add size of ethernet header
|
|
Ret = EplDllkCalAsyncSend(pFrameInfo_p, Priority_p);
|
|
#else
|
|
Ret = kEplSuccessful;
|
|
#endif
|
|
|
|
return Ret;
|
|
}
|
|
|
|
#if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0)
|
|
|
|
//---------------------------------------------------------------------------
|
|
//
|
|
// Function: EplDlluCalIssueRequest()
|
|
//
|
|
// Description: issues a StatusRequest or a IdentRequest to the specified node.
|
|
//
|
|
// Parameters: Service_p = request service ID
|
|
// uiNodeId_p = node ID
|
|
// bSoaFlag1_p = flag1 for this node (transmit in SoA and PReq)
|
|
// If 0xFF this flag is ignored.
|
|
//
|
|
// Returns: tEplKernel = error code
|
|
//
|
|
//
|
|
// State:
|
|
//
|
|
//---------------------------------------------------------------------------
|
|
|
|
tEplKernel EplDlluCalIssueRequest(tEplDllReqServiceId Service_p,
|
|
unsigned int uiNodeId_p, u8 bSoaFlag1_p)
|
|
{
|
|
tEplKernel Ret = kEplSuccessful;
|
|
|
|
// add node to appropriate request queue
|
|
switch (Service_p) {
|
|
case kEplDllReqServiceIdent:
|
|
case kEplDllReqServiceStatus:
|
|
{
|
|
tEplEvent Event;
|
|
tEplDllCalIssueRequest IssueReq;
|
|
|
|
Event.m_EventSink = kEplEventSinkDllkCal;
|
|
Event.m_EventType = kEplEventTypeDllkIssueReq;
|
|
IssueReq.m_Service = Service_p;
|
|
IssueReq.m_uiNodeId = uiNodeId_p;
|
|
IssueReq.m_bSoaFlag1 = bSoaFlag1_p;
|
|
Event.m_pArg = &IssueReq;
|
|
Event.m_uiSize = sizeof(IssueReq);
|
|
|
|
Ret = EplEventuPost(&Event);
|
|
break;
|
|
}
|
|
|
|
default:
|
|
{
|
|
Ret = kEplDllInvalidParam;
|
|
goto Exit;
|
|
}
|
|
}
|
|
|
|
Exit:
|
|
return Ret;
|
|
}
|
|
|
|
//---------------------------------------------------------------------------
|
|
//
|
|
// Function: EplDlluCalAddNode()
|
|
//
|
|
// Description: adds the specified node to the isochronous phase.
|
|
//
|
|
// Parameters: pNodeInfo_p = pointer of node info structure
|
|
//
|
|
// Returns: tEplKernel = error code
|
|
//
|
|
//
|
|
// State:
|
|
//
|
|
//---------------------------------------------------------------------------
|
|
|
|
tEplKernel EplDlluCalAddNode(tEplDllNodeInfo * pNodeInfo_p)
|
|
{
|
|
tEplKernel Ret = kEplSuccessful;
|
|
tEplEvent Event;
|
|
|
|
Event.m_EventSink = kEplEventSinkDllkCal;
|
|
Event.m_EventType = kEplEventTypeDllkAddNode;
|
|
Event.m_pArg = pNodeInfo_p;
|
|
Event.m_uiSize = sizeof(tEplDllNodeInfo);
|
|
|
|
Ret = EplEventuPost(&Event);
|
|
|
|
return Ret;
|
|
}
|
|
|
|
//---------------------------------------------------------------------------
|
|
//
|
|
// Function: EplDlluCalDeleteNode()
|
|
//
|
|
// Description: removes the specified node from the isochronous phase.
|
|
//
|
|
// Parameters: uiNodeId_p = node ID
|
|
//
|
|
// Returns: tEplKernel = error code
|
|
//
|
|
//
|
|
// State:
|
|
//
|
|
//---------------------------------------------------------------------------
|
|
|
|
tEplKernel EplDlluCalDeleteNode(unsigned int uiNodeId_p)
|
|
{
|
|
tEplKernel Ret = kEplSuccessful;
|
|
tEplEvent Event;
|
|
|
|
Event.m_EventSink = kEplEventSinkDllkCal;
|
|
Event.m_EventType = kEplEventTypeDllkDelNode;
|
|
Event.m_pArg = &uiNodeId_p;
|
|
Event.m_uiSize = sizeof(uiNodeId_p);
|
|
|
|
Ret = EplEventuPost(&Event);
|
|
|
|
return Ret;
|
|
}
|
|
|
|
//---------------------------------------------------------------------------
|
|
//
|
|
// Function: EplDlluCalSoftDeleteNode()
|
|
//
|
|
// Description: removes the specified node softly from the isochronous phase.
|
|
//
|
|
// Parameters: uiNodeId_p = node ID
|
|
//
|
|
// Returns: tEplKernel = error code
|
|
//
|
|
//
|
|
// State:
|
|
//
|
|
//---------------------------------------------------------------------------
|
|
|
|
tEplKernel EplDlluCalSoftDeleteNode(unsigned int uiNodeId_p)
|
|
{
|
|
tEplKernel Ret = kEplSuccessful;
|
|
tEplEvent Event;
|
|
|
|
Event.m_EventSink = kEplEventSinkDllkCal;
|
|
Event.m_EventType = kEplEventTypeDllkSoftDelNode;
|
|
Event.m_pArg = &uiNodeId_p;
|
|
Event.m_uiSize = sizeof(uiNodeId_p);
|
|
|
|
Ret = EplEventuPost(&Event);
|
|
|
|
return Ret;
|
|
}
|
|
|
|
#endif // (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0)
|
|
|
|
//=========================================================================//
|
|
// //
|
|
// P R I V A T E F U N C T I O N S //
|
|
// //
|
|
//=========================================================================//
|
|
|
|
//---------------------------------------------------------------------------
|
|
//
|
|
// Function: EplDlluCalSetAsndServiceIdFilter()
|
|
//
|
|
// Description: forwards call to EplDllkSetAsndServiceIdFilter() in kernel part
|
|
//
|
|
// Parameters: ServiceId_p = ASnd Service ID
|
|
// Filter_p = node ID filter
|
|
//
|
|
// Returns: tEplKernel = error code
|
|
//
|
|
//
|
|
// State:
|
|
//
|
|
//---------------------------------------------------------------------------
|
|
|
|
static tEplKernel EplDlluCalSetAsndServiceIdFilter(tEplDllAsndServiceId
|
|
ServiceId_p,
|
|
tEplDllAsndFilter Filter_p)
|
|
{
|
|
tEplKernel Ret = kEplSuccessful;
|
|
tEplEvent Event;
|
|
tEplDllCalAsndServiceIdFilter ServFilter;
|
|
|
|
Event.m_EventSink = kEplEventSinkDllkCal;
|
|
Event.m_EventType = kEplEventTypeDllkServFilter;
|
|
ServFilter.m_ServiceId = ServiceId_p;
|
|
ServFilter.m_Filter = Filter_p;
|
|
Event.m_pArg = &ServFilter;
|
|
Event.m_uiSize = sizeof(ServFilter);
|
|
|
|
Ret = EplEventuPost(&Event);
|
|
|
|
return Ret;
|
|
}
|
|
|
|
#endif // (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLU)) != 0)
|
|
|
|
// EOF
|