/**************************************************************************** (c) SYSTEC electronic GmbH, D-07973 Greiz, August-Bebel-Str. 29 www.systec-electronic.com Project: openPOWERLINK Description: source file for generic EPL API module 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: EplApiGeneric.c,v $ $Author: D.Krueger $ $Revision: 1.21 $ $Date: 2008/11/21 09:00:38 $ $State: Exp $ Build Environment: GCC V3.4 ------------------------------------------------------------------------- Revision History: 2006/09/05 d.k.: start of the implementation, version 1.00 ****************************************************************************/ #include "Epl.h" #include "kernel/EplDllk.h" #include "kernel/EplErrorHandlerk.h" #include "kernel/EplEventk.h" #include "kernel/EplNmtk.h" #include "kernel/EplObdk.h" #include "kernel/EplTimerk.h" #include "kernel/EplDllkCal.h" #include "kernel/EplPdokCal.h" #include "user/EplDlluCal.h" #include "user/EplLedu.h" #include "user/EplNmtCnu.h" #include "user/EplNmtMnu.h" #include "user/EplSdoComu.h" #include "user/EplIdentu.h" #include "user/EplStatusu.h" #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_PDOK)) != 0) #include "kernel/EplPdok.h" #endif #include "SharedBuff.h" #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_OBDK)) == 0) #error "EPL API layer needs EPL module OBDK!" #endif /***************************************************************************/ /* */ /* */ /* 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 EplApi */ /* */ /* */ /***************************************************************************/ // // 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 { tEplApiInitParam m_InitParam; } tEplApiInstance; //--------------------------------------------------------------------------- // local vars //--------------------------------------------------------------------------- static tEplApiInstance EplApiInstance_g; //--------------------------------------------------------------------------- // local function prototypes //--------------------------------------------------------------------------- // NMT state change event callback function static tEplKernel PUBLIC EplApiCbNmtStateChange(tEplEventNmtStateChange NmtStateChange_p); // update DLL configuration from OD static tEplKernel PUBLIC EplApiUpdateDllConfig(BOOL fUpdateIdentity_p); // update OD from init param static tEplKernel PUBLIC EplApiUpdateObd(void); // process events from user event queue static tEplKernel PUBLIC EplApiProcessEvent(tEplEvent * pEplEvent_p); #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOC)) != 0) // callback function of SDO module static tEplKernel PUBLIC EplApiCbSdoCon(tEplSdoComFinished * pSdoComFinished_p); #endif #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) // callback functions of NmtMnu module static tEplKernel PUBLIC EplApiCbNodeEvent(unsigned int uiNodeId_p, tEplNmtNodeEvent NodeEvent_p, tEplNmtState NmtState_p, WORD wErrorCode_p, BOOL fMandatory_p); static tEplKernel PUBLIC EplApiCbBootEvent(tEplNmtBootEvent BootEvent_p, tEplNmtState NmtState_p, WORD wErrorCode_p); #endif #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_LEDU)) != 0) // callback function of Ledu module static tEplKernel PUBLIC EplApiCbLedStateChange(tEplLedType LedType_p, BOOL fOn_p); #endif // OD initialization function (implemented in Objdict.c) tEplKernel PUBLIC EplObdInitRam(tEplObdInitParam MEM * pInitParam_p); //=========================================================================// // // // P U B L I C F U N C T I O N S // // // //=========================================================================// //--------------------------------------------------------------------------- // // Function: EplApiInitialize() // // Description: add and initialize new instance of EPL stack. // After return from this function the application must start // the NMT state machine via // EplApiExecNmtCommand(kEplNmtEventSwReset) // and thereby the whole EPL stack :-) // // Parameters: pInitParam_p = initialisation parameters // // Returns: tEplKernel = error code // // // State: // //--------------------------------------------------------------------------- tEplKernel PUBLIC EplApiInitialize(tEplApiInitParam * pInitParam_p) { tEplKernel Ret = kEplSuccessful; tEplObdInitParam ObdInitParam; tEplDllkInitParam DllkInitParam; #ifndef EPL_NO_FIFO tShbError ShbError; #endif // reset instance structure EPL_MEMSET(&EplApiInstance_g, 0, sizeof(EplApiInstance_g)); EPL_MEMCPY(&EplApiInstance_g.m_InitParam, pInitParam_p, min(sizeof(tEplApiInitParam), pInitParam_p->m_uiSizeOfStruct)); // check event callback function pointer if (EplApiInstance_g.m_InitParam.m_pfnCbEvent == NULL) { // application must always have an event callback function Ret = kEplApiInvalidParam; goto Exit; } #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_OBDK)) != 0) // init OD // FIXME // Ret = EplObdInitRam(&ObdInitParam); // if (Ret != kEplSuccessful) // { // goto Exit; // } // initialize EplObd module Ret = EplObdInit(&ObdInitParam); if (Ret != kEplSuccessful) { goto Exit; } #endif #ifndef EPL_NO_FIFO ShbError = ShbInit(); if (ShbError != kShbOk) { Ret = kEplNoResource; goto Exit; } #endif // initialize EplEventk module Ret = EplEventkInit(EplApiInstance_g.m_InitParam.m_pfnCbSync); if (Ret != kEplSuccessful) { goto Exit; } // initialize EplEventu module Ret = EplEventuInit(EplApiProcessEvent); if (Ret != kEplSuccessful) { goto Exit; } // init EplTimerk module Ret = EplTimerkInit(); if (Ret != kEplSuccessful) { goto Exit; } // initialize EplNmtk module before DLL #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTK)) != 0) Ret = EplNmtkInit(); if (Ret != kEplSuccessful) { goto Exit; } #endif // initialize EplDllk module #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLK)) != 0) EPL_MEMCPY(DllkInitParam.m_be_abSrcMac, EplApiInstance_g.m_InitParam.m_abMacAddress, 6); Ret = EplDllkAddInstance(&DllkInitParam); if (Ret != kEplSuccessful) { goto Exit; } // initialize EplErrorHandlerk module Ret = EplErrorHandlerkInit(); if (Ret != kEplSuccessful) { goto Exit; } // initialize EplDllkCal module Ret = EplDllkCalAddInstance(); if (Ret != kEplSuccessful) { goto Exit; } #endif // initialize EplDlluCal module #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLU)) != 0) Ret = EplDlluCalAddInstance(); if (Ret != kEplSuccessful) { goto Exit; } #endif // initialize EplPdok module #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_PDOK)) != 0) Ret = EplPdokAddInstance(); if (Ret != kEplSuccessful) { goto Exit; } Ret = EplPdokCalAddInstance(); if (Ret != kEplSuccessful) { goto Exit; } #endif // initialize EplNmtCnu module #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_CN)) != 0) Ret = EplNmtCnuAddInstance(EplApiInstance_g.m_InitParam.m_uiNodeId); if (Ret != kEplSuccessful) { goto Exit; } #endif // initialize EplNmtu module #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTU)) != 0) Ret = EplNmtuInit(); if (Ret != kEplSuccessful) { goto Exit; } // register NMT event callback function Ret = EplNmtuRegisterStateChangeCb(EplApiCbNmtStateChange); if (Ret != kEplSuccessful) { goto Exit; } #endif #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) // initialize EplNmtMnu module Ret = EplNmtMnuInit(EplApiCbNodeEvent, EplApiCbBootEvent); if (Ret != kEplSuccessful) { goto Exit; } // initialize EplIdentu module Ret = EplIdentuInit(); if (Ret != kEplSuccessful) { goto Exit; } // initialize EplStatusu module Ret = EplStatusuInit(); if (Ret != kEplSuccessful) { goto Exit; } #endif // initialize EplLedu module #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_LEDU)) != 0) Ret = EplLeduInit(EplApiCbLedStateChange); if (Ret != kEplSuccessful) { goto Exit; } #endif // init SDO module #if ((((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOS)) != 0) || \ (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOC)) != 0)) // init sdo command layer Ret = EplSdoComInit(); if (Ret != kEplSuccessful) { goto Exit; } #endif // the application must start NMT state machine // via EplApiExecNmtCommand(kEplNmtEventSwReset) // and thereby the whole EPL stack Exit: return Ret; } //--------------------------------------------------------------------------- // // Function: EplApiShutdown() // // Description: deletes an instance of EPL stack // // Parameters: (none) // // Returns: tEplKernel = error code // // // State: // //--------------------------------------------------------------------------- tEplKernel PUBLIC EplApiShutdown(void) { tEplKernel Ret = kEplSuccessful; // $$$ d.k.: check if NMT state is NMT_GS_OFF // $$$ d.k.: maybe delete event queues at first, but this implies that // no other module must not use the event queues for communication // during shutdown. // delete instance for all modules // deinitialize EplSdoCom module #if ((((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOS)) != 0) || \ (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOC)) != 0)) Ret = EplSdoComDelInstance(); // PRINTF1("EplSdoComDelInstance(): 0x%X\n", Ret); #endif // deinitialize EplLedu module #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_LEDU)) != 0) Ret = EplLeduDelInstance(); // PRINTF1("EplLeduDelInstance(): 0x%X\n", Ret); #endif #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) // deinitialize EplNmtMnu module Ret = EplNmtMnuDelInstance(); // PRINTF1("EplNmtMnuDelInstance(): 0x%X\n", Ret); // deinitialize EplIdentu module Ret = EplIdentuDelInstance(); // PRINTF1("EplIdentuDelInstance(): 0x%X\n", Ret); // deinitialize EplStatusu module Ret = EplStatusuDelInstance(); // PRINTF1("EplStatusuDelInstance(): 0x%X\n", Ret); #endif // deinitialize EplNmtCnu module #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_CN)) != 0) Ret = EplNmtCnuDelInstance(); // PRINTF1("EplNmtCnuDelInstance(): 0x%X\n", Ret); #endif // deinitialize EplNmtu module #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTU)) != 0) Ret = EplNmtuDelInstance(); // PRINTF1("EplNmtuDelInstance(): 0x%X\n", Ret); #endif // deinitialize EplDlluCal module #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLU)) != 0) Ret = EplDlluCalDelInstance(); // PRINTF1("EplDlluCalDelInstance(): 0x%X\n", Ret); #endif // deinitialize EplEventu module Ret = EplEventuDelInstance(); // PRINTF1("EplEventuDelInstance(): 0x%X\n", Ret); // deinitialize EplNmtk module #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTK)) != 0) Ret = EplNmtkDelInstance(); // PRINTF1("EplNmtkDelInstance(): 0x%X\n", Ret); #endif // deinitialize EplDllk module #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLK)) != 0) Ret = EplDllkDelInstance(); // PRINTF1("EplDllkDelInstance(): 0x%X\n", Ret); // deinitialize EplDllkCal module Ret = EplDllkCalDelInstance(); // PRINTF1("EplDllkCalDelInstance(): 0x%X\n", Ret); #endif // deinitialize EplEventk module Ret = EplEventkDelInstance(); // PRINTF1("EplEventkDelInstance(): 0x%X\n", Ret); // deinitialize EplTimerk module Ret = EplTimerkDelInstance(); // PRINTF1("EplTimerkDelInstance(): 0x%X\n", Ret); #ifndef EPL_NO_FIFO ShbExit(); #endif return Ret; } //---------------------------------------------------------------------------- // Function: EplApiExecNmtCommand() // // Description: executes a NMT command, i.e. post the NMT command/event to the // NMTk module. NMT commands which are not appropriate in the current // NMT state are silently ignored. Please keep in mind that the // NMT state may change until the NMT command is actually executed. // // Parameters: NmtEvent_p = NMT command/event // // Returns: tEplKernel = error code // // State: //---------------------------------------------------------------------------- tEplKernel PUBLIC EplApiExecNmtCommand(tEplNmtEvent NmtEvent_p) { tEplKernel Ret = kEplSuccessful; #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTU)) != 0) Ret = EplNmtuNmtEvent(NmtEvent_p); #endif return Ret; } //---------------------------------------------------------------------------- // Function: EplApiLinkObject() // // Description: Function maps array of application variables onto specified object in OD // // Parameters: uiObjIndex_p = Function maps variables for this object index // pVar_p = Pointer to data memory area for the specified object // puiVarEntries_p = IN: pointer to number of entries to map // OUT: pointer to number of actually used entries // pEntrySize_p = IN: pointer to size of one entry; // if size is zero, the actual size will be read from OD // OUT: pointer to entire size of all entries mapped // uiFirstSubindex_p = This is the first subindex to be mapped. // // Returns: tEplKernel = error code // // State: //---------------------------------------------------------------------------- tEplKernel PUBLIC EplApiLinkObject(unsigned int uiObjIndex_p, void *pVar_p, unsigned int *puiVarEntries_p, tEplObdSize * pEntrySize_p, unsigned int uiFirstSubindex_p) { BYTE bVarEntries; BYTE bIndexEntries; BYTE MEM *pbData; unsigned int uiSubindex; tEplVarParam VarParam; tEplObdSize EntrySize; tEplObdSize UsedSize; tEplKernel RetCode = kEplSuccessful; if ((pVar_p == NULL) || (puiVarEntries_p == NULL) || (*puiVarEntries_p == 0) || (pEntrySize_p == NULL)) { RetCode = kEplApiInvalidParam; goto Exit; } pbData = (BYTE MEM *) pVar_p; bVarEntries = (BYTE) * puiVarEntries_p; UsedSize = 0; // init VarParam structure with default values VarParam.m_uiIndex = uiObjIndex_p; VarParam.m_ValidFlag = kVarValidAll; if (uiFirstSubindex_p != 0) { // check if object exists by reading subindex 0x00, // because user wants to link a variable to a subindex unequal 0x00 // read number of entries EntrySize = (tEplObdSize) sizeof(bIndexEntries); RetCode = EplObdReadEntry(uiObjIndex_p, 0x00, (void GENERIC *)&bIndexEntries, &EntrySize); if ((RetCode != kEplSuccessful) || (bIndexEntries == 0x00)) { // Object doesn't exist or invalid entry number RetCode = kEplObdIndexNotExist; goto Exit; } } else { // user wants to link a variable to subindex 0x00 // that's OK bIndexEntries = 0; } // Correct number of entries if number read from OD is greater // than the specified number. // This is done, so that we do not set more entries than subindexes the // object actually has. if ((bIndexEntries > (bVarEntries + uiFirstSubindex_p - 1)) && (bVarEntries != 0x00)) { bIndexEntries = (BYTE) (bVarEntries + uiFirstSubindex_p - 1); } // map entries for (uiSubindex = uiFirstSubindex_p; uiSubindex <= bIndexEntries; uiSubindex++) { // if passed entry size is 0, then get size from OD if (*pEntrySize_p == 0x00) { // read entry size EntrySize = EplObdGetDataSize(uiObjIndex_p, uiSubindex); if (EntrySize == 0x00) { // invalid entry size (maybe object doesn't exist or entry of type DOMAIN is empty) RetCode = kEplObdSubindexNotExist; break; } } else { // use passed entry size EntrySize = *pEntrySize_p; } VarParam.m_uiSubindex = uiSubindex; // set pointer to user var VarParam.m_Size = EntrySize; VarParam.m_pData = pbData; UsedSize += EntrySize; pbData += EntrySize; RetCode = EplObdDefineVar(&VarParam); if (RetCode != kEplSuccessful) { break; } } // set number of mapped entries and entry size *puiVarEntries_p = ((bIndexEntries - uiFirstSubindex_p) + 1); *pEntrySize_p = UsedSize; Exit: return (RetCode); } // ---------------------------------------------------------------------------- // // Function: EplApiReadObject() // // Description: reads the specified entry from the OD of the specified node. // If this node is a remote node, it performs a SDO transfer, which // means this function returns kEplApiTaskDeferred and the application // is informed via the event callback function when the task is completed. // // Parameters: pSdoComConHdl_p = INOUT: pointer to SDO connection handle (may be NULL in case of local OD access) // uiNodeId_p = IN: node ID (0 = itself) // uiIndex_p = IN: index of object in OD // uiSubindex_p = IN: sub-index of object in OD // pDstData_le_p = OUT: pointer to data in little endian // puiSize_p = INOUT: pointer to size of data // SdoType_p = IN: type of SDO transfer // pUserArg_p = IN: user-definable argument pointer, // which will be passed to the event callback function // // Return: tEplKernel = error code // // ---------------------------------------------------------------------------- tEplKernel PUBLIC EplApiReadObject(tEplSdoComConHdl * pSdoComConHdl_p, unsigned int uiNodeId_p, unsigned int uiIndex_p, unsigned int uiSubindex_p, void *pDstData_le_p, unsigned int *puiSize_p, tEplSdoType SdoType_p, void *pUserArg_p) { tEplKernel Ret = kEplSuccessful; if ((uiIndex_p == 0) || (pDstData_le_p == NULL) || (puiSize_p == NULL) || (*puiSize_p == 0)) { Ret = kEplApiInvalidParam; goto Exit; } if (uiNodeId_p == 0 || uiNodeId_p == EplObdGetNodeId()) { // local OD access can be performed tEplObdSize ObdSize; ObdSize = (tEplObdSize) * puiSize_p; Ret = EplObdReadEntryToLe(uiIndex_p, uiSubindex_p, pDstData_le_p, &ObdSize); *puiSize_p = (unsigned int)ObdSize; } else { // perform SDO transfer #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOC)) != 0) tEplSdoComTransParamByIndex TransParamByIndex; // tEplSdoComConHdl SdoComConHdl; // check if application provides space for handle if (pSdoComConHdl_p == NULL) { Ret = kEplApiInvalidParam; goto Exit; // pSdoComConHdl_p = &SdoComConHdl; } // init command layer connection Ret = EplSdoComDefineCon(pSdoComConHdl_p, uiNodeId_p, // target node id SdoType_p); // SDO type if ((Ret != kEplSuccessful) && (Ret != kEplSdoComHandleExists)) { goto Exit; } TransParamByIndex.m_pData = pDstData_le_p; TransParamByIndex.m_SdoAccessType = kEplSdoAccessTypeRead; TransParamByIndex.m_SdoComConHdl = *pSdoComConHdl_p; TransParamByIndex.m_uiDataSize = *puiSize_p; TransParamByIndex.m_uiIndex = uiIndex_p; TransParamByIndex.m_uiSubindex = uiSubindex_p; TransParamByIndex.m_pfnSdoFinishedCb = EplApiCbSdoCon; TransParamByIndex.m_pUserArg = pUserArg_p; Ret = EplSdoComInitTransferByIndex(&TransParamByIndex); if (Ret != kEplSuccessful) { goto Exit; } Ret = kEplApiTaskDeferred; #else Ret = kEplApiInvalidParam; #endif } Exit: return Ret; } // ---------------------------------------------------------------------------- // // Function: EplApiWriteObject() // // Description: writes the specified entry to the OD of the specified node. // If this node is a remote node, it performs a SDO transfer, which // means this function returns kEplApiTaskDeferred and the application // is informed via the event callback function when the task is completed. // // Parameters: pSdoComConHdl_p = INOUT: pointer to SDO connection handle (may be NULL in case of local OD access) // uiNodeId_p = IN: node ID (0 = itself) // uiIndex_p = IN: index of object in OD // uiSubindex_p = IN: sub-index of object in OD // pSrcData_le_p = IN: pointer to data in little endian // uiSize_p = IN: size of data in bytes // SdoType_p = IN: type of SDO transfer // pUserArg_p = IN: user-definable argument pointer, // which will be passed to the event callback function // // Return: tEplKernel = error code // // ---------------------------------------------------------------------------- tEplKernel PUBLIC EplApiWriteObject(tEplSdoComConHdl * pSdoComConHdl_p, unsigned int uiNodeId_p, unsigned int uiIndex_p, unsigned int uiSubindex_p, void *pSrcData_le_p, unsigned int uiSize_p, tEplSdoType SdoType_p, void *pUserArg_p) { tEplKernel Ret = kEplSuccessful; if ((uiIndex_p == 0) || (pSrcData_le_p == NULL) || (uiSize_p == 0)) { Ret = kEplApiInvalidParam; goto Exit; } if (uiNodeId_p == 0 || uiNodeId_p == EplObdGetNodeId()) { // local OD access can be performed Ret = EplObdWriteEntryFromLe(uiIndex_p, uiSubindex_p, pSrcData_le_p, uiSize_p); } else { // perform SDO transfer #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOC)) != 0) tEplSdoComTransParamByIndex TransParamByIndex; // tEplSdoComConHdl SdoComConHdl; // check if application provides space for handle if (pSdoComConHdl_p == NULL) { Ret = kEplApiInvalidParam; goto Exit; // pSdoComConHdl_p = &SdoComConHdl; } // d.k.: How to recycle command layer connection? // Try to redefine it, which will return kEplSdoComHandleExists // and the existing command layer handle. // If the returned handle is busy, EplSdoComInitTransferByIndex() // will return with error. // $$$ d.k.: Collisions may occur with Configuration Manager, if both the application and // Configuration Manager, are trying to communicate with the very same node. // possible solution: disallow communication by application if Configuration Manager is busy // init command layer connection Ret = EplSdoComDefineCon(pSdoComConHdl_p, uiNodeId_p, // target node id SdoType_p); // SDO type if ((Ret != kEplSuccessful) && (Ret != kEplSdoComHandleExists)) { goto Exit; } TransParamByIndex.m_pData = pSrcData_le_p; TransParamByIndex.m_SdoAccessType = kEplSdoAccessTypeWrite; TransParamByIndex.m_SdoComConHdl = *pSdoComConHdl_p; TransParamByIndex.m_uiDataSize = uiSize_p; TransParamByIndex.m_uiIndex = uiIndex_p; TransParamByIndex.m_uiSubindex = uiSubindex_p; TransParamByIndex.m_pfnSdoFinishedCb = EplApiCbSdoCon; TransParamByIndex.m_pUserArg = pUserArg_p; Ret = EplSdoComInitTransferByIndex(&TransParamByIndex); if (Ret != kEplSuccessful) { goto Exit; } Ret = kEplApiTaskDeferred; #else Ret = kEplApiInvalidParam; #endif } Exit: return Ret; } // ---------------------------------------------------------------------------- // // Function: EplApiFreeSdoChannel() // // Description: frees the specified SDO channel. // This function must be called after each call to EplApiReadObject()/EplApiWriteObject() // which returns kEplApiTaskDeferred and the application // is informed via the event callback function when the task is completed. // // Parameters: SdoComConHdl_p = IN: SDO connection handle // // Return: tEplKernel = error code // // ---------------------------------------------------------------------------- tEplKernel PUBLIC EplApiFreeSdoChannel(tEplSdoComConHdl SdoComConHdl_p) { tEplKernel Ret = kEplSuccessful; #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOC)) != 0) // init command layer connection Ret = EplSdoComUndefineCon(SdoComConHdl_p); #else Ret = kEplApiInvalidParam; #endif return Ret; } // ---------------------------------------------------------------------------- // // Function: EplApiReadLocalObject() // // Description: reads the specified entry from the local OD. // // Parameters: uiIndex_p = IN: index of object in OD // uiSubindex_p = IN: sub-index of object in OD // pDstData_p = OUT: pointer to data in platform byte order // puiSize_p = INOUT: pointer to size of data // // Return: tEplKernel = error code // // ---------------------------------------------------------------------------- tEplKernel PUBLIC EplApiReadLocalObject(unsigned int uiIndex_p, unsigned int uiSubindex_p, void *pDstData_p, unsigned int *puiSize_p) { tEplKernel Ret = kEplSuccessful; tEplObdSize ObdSize; ObdSize = (tEplObdSize) * puiSize_p; Ret = EplObdReadEntry(uiIndex_p, uiSubindex_p, pDstData_p, &ObdSize); *puiSize_p = (unsigned int)ObdSize; return Ret; } // ---------------------------------------------------------------------------- // // Function: EplApiWriteLocalObject() // // Description: writes the specified entry to the local OD. // // Parameters: uiIndex_p = IN: index of object in OD // uiSubindex_p = IN: sub-index of object in OD // pSrcData_p = IN: pointer to data in platform byte order // uiSize_p = IN: size of data in bytes // // Return: tEplKernel = error code // // ---------------------------------------------------------------------------- tEplKernel PUBLIC EplApiWriteLocalObject(unsigned int uiIndex_p, unsigned int uiSubindex_p, void *pSrcData_p, unsigned int uiSize_p) { tEplKernel Ret = kEplSuccessful; Ret = EplObdWriteEntry(uiIndex_p, uiSubindex_p, pSrcData_p, (tEplObdSize) uiSize_p); return Ret; } #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) // ---------------------------------------------------------------------------- // // Function: EplApiMnTriggerStateChange() // // Description: triggers the specified node command for the specified node. // // Parameters: uiNodeId_p = node ID for which the node command will be executed // NodeCommand_p = node command // // Return: tEplKernel = error code // // ---------------------------------------------------------------------------- tEplKernel PUBLIC EplApiMnTriggerStateChange(unsigned int uiNodeId_p, tEplNmtNodeCommand NodeCommand_p) { tEplKernel Ret = kEplSuccessful; Ret = EplNmtMnuTriggerStateChange(uiNodeId_p, NodeCommand_p); return Ret; } #endif // (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) //--------------------------------------------------------------------------- // // Function: EplApiCbObdAccess // // Description: callback function for OD accesses // // Parameters: pParam_p = OBD parameter // // Returns: tEplKernel = error code // // // State: // //--------------------------------------------------------------------------- tEplKernel PUBLIC EplApiCbObdAccess(tEplObdCbParam MEM * pParam_p) { tEplKernel Ret = kEplSuccessful; #if (EPL_API_OBD_FORWARD_EVENT != FALSE) tEplApiEventArg EventArg; // call user callback // must be disabled for EplApiLinuxKernel.c, because of reentrancy problem // for local OD access. This is not so bad as user callback function in // application does not use OD callbacks at the moment. EventArg.m_ObdCbParam = *pParam_p; Ret = EplApiInstance_g.m_InitParam.m_pfnCbEvent(kEplApiEventObdAccess, &EventArg, EplApiInstance_g. m_InitParam. m_pEventUserArg); #endif switch (pParam_p->m_uiIndex) { //case 0x1006: // NMT_CycleLen_U32 (valid on reset) case 0x1C14: // DLL_LossOfFrameTolerance_U32 //case 0x1F98: // NMT_CycleTiming_REC (valid on reset) { if (pParam_p->m_ObdEvent == kEplObdEvPostWrite) { // update DLL configuration Ret = EplApiUpdateDllConfig(FALSE); } break; } case 0x1020: // CFM_VerifyConfiguration_REC.ConfId_U32 != 0 { if ((pParam_p->m_ObdEvent == kEplObdEvPostWrite) && (pParam_p->m_uiSubIndex == 3) && (*((DWORD *) pParam_p->m_pArg) != 0)) { DWORD dwVerifyConfInvalid = 0; // set CFM_VerifyConfiguration_REC.VerifyConfInvalid_U32 to 0 Ret = EplObdWriteEntry(0x1020, 4, &dwVerifyConfInvalid, 4); // ignore any error because this objekt is optional Ret = kEplSuccessful; } break; } case 0x1F9E: // NMT_ResetCmd_U8 { if (pParam_p->m_ObdEvent == kEplObdEvPreWrite) { BYTE bNmtCommand; bNmtCommand = *((BYTE *) pParam_p->m_pArg); // check value range switch ((tEplNmtCommand) bNmtCommand) { case kEplNmtCmdResetNode: case kEplNmtCmdResetCommunication: case kEplNmtCmdResetConfiguration: case kEplNmtCmdSwReset: case kEplNmtCmdInvalidService: // valid command identifier specified break; default: pParam_p->m_dwAbortCode = EPL_SDOAC_VALUE_RANGE_EXCEEDED; Ret = kEplObdAccessViolation; break; } } else if (pParam_p->m_ObdEvent == kEplObdEvPostWrite) { BYTE bNmtCommand; bNmtCommand = *((BYTE *) pParam_p->m_pArg); // check value range switch ((tEplNmtCommand) bNmtCommand) { case kEplNmtCmdResetNode: #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTU)) != 0) Ret = EplNmtuNmtEvent (kEplNmtEventResetNode); #endif break; case kEplNmtCmdResetCommunication: #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTU)) != 0) Ret = EplNmtuNmtEvent (kEplNmtEventResetCom); #endif break; case kEplNmtCmdResetConfiguration: #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTU)) != 0) Ret = EplNmtuNmtEvent (kEplNmtEventResetConfig); #endif break; case kEplNmtCmdSwReset: #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMTU)) != 0) Ret = EplNmtuNmtEvent (kEplNmtEventSwReset); #endif break; case kEplNmtCmdInvalidService: break; default: pParam_p->m_dwAbortCode = EPL_SDOAC_VALUE_RANGE_EXCEEDED; Ret = kEplObdAccessViolation; break; } } break; } default: break; } //Exit: return Ret; } //=========================================================================// // // // P R I V A T E F U N C T I O N S // // // //=========================================================================// //--------------------------------------------------------------------------- // // Function: EplApiProcessEvent // // Description: processes events from event queue and forwards these to // the application's event callback function // // Parameters: pEplEvent_p = pointer to event // // Returns: tEplKernel = errorcode // // State: // //--------------------------------------------------------------------------- static tEplKernel PUBLIC EplApiProcessEvent(tEplEvent * pEplEvent_p) { tEplKernel Ret; tEplEventError *pEventError; tEplApiEventType EventType; Ret = kEplSuccessful; // process event switch (pEplEvent_p->m_EventType) { // error event case kEplEventTypeError: { pEventError = (tEplEventError *) pEplEvent_p->m_pArg; switch (pEventError->m_EventSource) { // treat the errors from the following sources as critical case kEplEventSourceEventk: case kEplEventSourceEventu: case kEplEventSourceDllk: { EventType = kEplApiEventCriticalError; // halt the stack by entering NMT state Off Ret = EplNmtuNmtEvent (kEplNmtEventCriticalError); break; } // the other errors are just warnings default: { EventType = kEplApiEventWarning; break; } } // call user callback Ret = EplApiInstance_g.m_InitParam.m_pfnCbEvent(EventType, (tEplApiEventArg *) pEventError, EplApiInstance_g. m_InitParam. m_pEventUserArg); // discard error from callback function, because this could generate an endless loop Ret = kEplSuccessful; break; } // at present, there are no other events for this module default: break; } return Ret; } //--------------------------------------------------------------------------- // // Function: EplApiCbNmtStateChange // // Description: callback function for NMT state changes // // Parameters: NmtStateChange_p = NMT state change event // // Returns: tEplKernel = error code // // // State: // //--------------------------------------------------------------------------- static tEplKernel PUBLIC EplApiCbNmtStateChange(tEplEventNmtStateChange NmtStateChange_p) { tEplKernel Ret = kEplSuccessful; BYTE bNmtState; tEplApiEventArg EventArg; // save NMT state in OD bNmtState = (BYTE) NmtStateChange_p.m_NewNmtState; Ret = EplObdWriteEntry(0x1F8C, 0, &bNmtState, 1); if (Ret != kEplSuccessful) { goto Exit; } // do work which must be done in that state switch (NmtStateChange_p.m_NewNmtState) { // EPL stack is not running case kEplNmtGsOff: break; // first init of the hardware case kEplNmtGsInitialising: #if 0 #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDO_UDP)) != 0) // configure SDO via UDP (i.e. bind it to the EPL ethernet interface) Ret = EplSdoUdpuConfig(EplApiInstance_g.m_InitParam.m_dwIpAddress, EPL_C_SDO_EPL_PORT); if (Ret != kEplSuccessful) { goto Exit; } #endif #endif break; // init of the manufacturer-specific profile area and the // standardised device profile area case kEplNmtGsResetApplication: { // reset application part of OD Ret = EplObdAccessOdPart(kEplObdPartApp, kEplObdDirLoad); if (Ret != kEplSuccessful) { goto Exit; } break; } // init of the communication profile area case kEplNmtGsResetCommunication: { // reset communication part of OD Ret = EplObdAccessOdPart(kEplObdPartGen, kEplObdDirLoad); if (Ret != kEplSuccessful) { goto Exit; } // $$$ d.k.: update OD only if OD was not loaded from non-volatile memory Ret = EplApiUpdateObd(); if (Ret != kEplSuccessful) { goto Exit; } break; } // build the configuration with infos from OD case kEplNmtGsResetConfiguration: { Ret = EplApiUpdateDllConfig(TRUE); if (Ret != kEplSuccessful) { goto Exit; } break; } //----------------------------------------------------------- // CN part of the state machine // node liste for EPL-Frames and check timeout case kEplNmtCsNotActive: { // indicate completion of reset in NMT_ResetCmd_U8 bNmtState = (BYTE) kEplNmtCmdInvalidService; Ret = EplObdWriteEntry(0x1F9E, 0, &bNmtState, 1); if (Ret != kEplSuccessful) { goto Exit; } break; } // node process only async frames case kEplNmtCsPreOperational1: { break; } // node process isochronus and asynchronus frames case kEplNmtCsPreOperational2: { break; } // node should be configured und application is ready case kEplNmtCsReadyToOperate: { break; } // normal work state case kEplNmtCsOperational: { break; } // node stopped by MN // -> only process asynchronus frames case kEplNmtCsStopped: { break; } // no EPL cycle // -> normal ethernet communication case kEplNmtCsBasicEthernet: { break; } //----------------------------------------------------------- // MN part of the state machine // node listens for EPL-Frames and check timeout case kEplNmtMsNotActive: { break; } // node processes only async frames case kEplNmtMsPreOperational1: { break; } // node processes isochronous and asynchronous frames case kEplNmtMsPreOperational2: { break; } // node should be configured und application is ready case kEplNmtMsReadyToOperate: { break; } // normal work state case kEplNmtMsOperational: { break; } // no EPL cycle // -> normal ethernet communication case kEplNmtMsBasicEthernet: { break; } default: { TRACE0 ("EplApiCbNmtStateChange(): unhandled NMT state\n"); } } #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_LEDU)) != 0) // forward event to Led module Ret = EplLeduCbNmtStateChange(NmtStateChange_p); if (Ret != kEplSuccessful) { goto Exit; } #endif #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) // forward event to NmtMn module Ret = EplNmtMnuCbNmtStateChange(NmtStateChange_p); if (Ret != kEplSuccessful) { goto Exit; } #endif // call user callback EventArg.m_NmtStateChange = NmtStateChange_p; Ret = EplApiInstance_g.m_InitParam. m_pfnCbEvent(kEplApiEventNmtStateChange, &EventArg, EplApiInstance_g.m_InitParam.m_pEventUserArg); Exit: return Ret; } //--------------------------------------------------------------------------- // // Function: EplApiUpdateDllConfig // // Description: update configuration of DLL // // Parameters: fUpdateIdentity_p = TRUE, if identity must be updated // // Returns: tEplKernel = error code // // // State: // //--------------------------------------------------------------------------- static tEplKernel PUBLIC EplApiUpdateDllConfig(BOOL fUpdateIdentity_p) { tEplKernel Ret = kEplSuccessful; tEplDllConfigParam DllConfigParam; tEplDllIdentParam DllIdentParam; tEplObdSize ObdSize; WORD wTemp; BYTE bTemp; // configure Dll EPL_MEMSET(&DllConfigParam, 0, sizeof(DllConfigParam)); DllConfigParam.m_uiNodeId = EplObdGetNodeId(); // Cycle Length (0x1006: NMT_CycleLen_U32) in [us] ObdSize = 4; Ret = EplObdReadEntry(0x1006, 0, &DllConfigParam.m_dwCycleLen, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } // 0x1F82: NMT_FeatureFlags_U32 ObdSize = 4; Ret = EplObdReadEntry(0x1F82, 0, &DllConfigParam.m_dwFeatureFlags, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } // d.k. There is no dependance between FeatureFlags and async-only CN DllConfigParam.m_fAsyncOnly = EplApiInstance_g.m_InitParam.m_fAsyncOnly; // 0x1C14: DLL_LossOfFrameTolerance_U32 in [ns] ObdSize = 4; Ret = EplObdReadEntry(0x1C14, 0, &DllConfigParam.m_dwLossOfFrameTolerance, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } // 0x1F98: NMT_CycleTiming_REC // 0x1F98.1: IsochrTxMaxPayload_U16 ObdSize = 2; Ret = EplObdReadEntry(0x1F98, 1, &wTemp, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } DllConfigParam.m_uiIsochrTxMaxPayload = wTemp; // 0x1F98.2: IsochrRxMaxPayload_U16 ObdSize = 2; Ret = EplObdReadEntry(0x1F98, 2, &wTemp, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } DllConfigParam.m_uiIsochrRxMaxPayload = wTemp; // 0x1F98.3: PResMaxLatency_U32 ObdSize = 4; Ret = EplObdReadEntry(0x1F98, 3, &DllConfigParam.m_dwPresMaxLatency, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } // 0x1F98.4: PReqActPayloadLimit_U16 ObdSize = 2; Ret = EplObdReadEntry(0x1F98, 4, &wTemp, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } DllConfigParam.m_uiPreqActPayloadLimit = wTemp; // 0x1F98.5: PResActPayloadLimit_U16 ObdSize = 2; Ret = EplObdReadEntry(0x1F98, 5, &wTemp, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } DllConfigParam.m_uiPresActPayloadLimit = wTemp; // 0x1F98.6: ASndMaxLatency_U32 ObdSize = 4; Ret = EplObdReadEntry(0x1F98, 6, &DllConfigParam.m_dwAsndMaxLatency, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } // 0x1F98.7: MultiplCycleCnt_U8 ObdSize = 1; Ret = EplObdReadEntry(0x1F98, 7, &bTemp, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } DllConfigParam.m_uiMultiplCycleCnt = bTemp; // 0x1F98.8: AsyncMTU_U16 ObdSize = 2; Ret = EplObdReadEntry(0x1F98, 8, &wTemp, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } DllConfigParam.m_uiAsyncMtu = wTemp; // $$$ Prescaler #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) // 0x1F8A.1: WaitSoCPReq_U32 in [ns] ObdSize = 4; Ret = EplObdReadEntry(0x1F8A, 1, &DllConfigParam.m_dwWaitSocPreq, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } // 0x1F8A.2: AsyncSlotTimeout_U32 in [ns] (optional) ObdSize = 4; Ret = EplObdReadEntry(0x1F8A, 2, &DllConfigParam.m_dwAsyncSlotTimeout, &ObdSize); /* if(Ret != kEplSuccessful) { goto Exit; }*/ #endif DllConfigParam.m_uiSizeOfStruct = sizeof(DllConfigParam); Ret = EplDllkConfig(&DllConfigParam); if (Ret != kEplSuccessful) { goto Exit; } if (fUpdateIdentity_p != FALSE) { // configure Identity EPL_MEMSET(&DllIdentParam, 0, sizeof(DllIdentParam)); ObdSize = 4; Ret = EplObdReadEntry(0x1000, 0, &DllIdentParam.m_dwDeviceType, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } ObdSize = 4; Ret = EplObdReadEntry(0x1018, 1, &DllIdentParam.m_dwVendorId, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } ObdSize = 4; Ret = EplObdReadEntry(0x1018, 2, &DllIdentParam.m_dwProductCode, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } ObdSize = 4; Ret = EplObdReadEntry(0x1018, 3, &DllIdentParam.m_dwRevisionNumber, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } ObdSize = 4; Ret = EplObdReadEntry(0x1018, 4, &DllIdentParam.m_dwSerialNumber, &ObdSize); if (Ret != kEplSuccessful) { goto Exit; } DllIdentParam.m_dwIpAddress = EplApiInstance_g.m_InitParam.m_dwIpAddress; DllIdentParam.m_dwSubnetMask = EplApiInstance_g.m_InitParam.m_dwSubnetMask; EPL_MEMCPY(DllIdentParam.m_sHostname, EplApiInstance_g.m_InitParam.m_sHostname, sizeof(DllIdentParam.m_sHostname)); ObdSize = 4; Ret = EplObdReadEntry(0x1020, 1, &DllIdentParam.m_dwVerifyConfigurationDate, &ObdSize); // ignore any error, because this object is optional ObdSize = 4; Ret = EplObdReadEntry(0x1020, 2, &DllIdentParam.m_dwVerifyConfigurationTime, &ObdSize); // ignore any error, because this object is optional // $$$ d.k.: fill rest of ident structure DllIdentParam.m_uiSizeOfStruct = sizeof(DllIdentParam); Ret = EplDllkSetIdentity(&DllIdentParam); if (Ret != kEplSuccessful) { goto Exit; } } Exit: return Ret; } //--------------------------------------------------------------------------- // // Function: EplApiUpdateObd // // Description: update OD from init param // // Parameters: (none) // // Returns: tEplKernel = error code // // // State: // //--------------------------------------------------------------------------- static tEplKernel PUBLIC EplApiUpdateObd(void) { tEplKernel Ret = kEplSuccessful; WORD wTemp; BYTE bTemp; // set node id in OD Ret = EplObdSetNodeId(EplApiInstance_g.m_InitParam.m_uiNodeId, // node id kEplObdNodeIdHardware); // set by hardware if (Ret != kEplSuccessful) { goto Exit; } if (EplApiInstance_g.m_InitParam.m_dwCycleLen != -1) { Ret = EplObdWriteEntry(0x1006, 0, &EplApiInstance_g.m_InitParam.m_dwCycleLen, 4); /* if(Ret != kEplSuccessful) { goto Exit; }*/ } if (EplApiInstance_g.m_InitParam.m_dwLossOfFrameTolerance != -1) { Ret = EplObdWriteEntry(0x1C14, 0, &EplApiInstance_g.m_InitParam. m_dwLossOfFrameTolerance, 4); /* if(Ret != kEplSuccessful) { goto Exit; } */ } // d.k. There is no dependance between FeatureFlags and async-only CN. if (EplApiInstance_g.m_InitParam.m_dwFeatureFlags != -1) { Ret = EplObdWriteEntry(0x1F82, 0, &EplApiInstance_g.m_InitParam. m_dwFeatureFlags, 4); /* if(Ret != kEplSuccessful) { goto Exit; } */ } wTemp = (WORD) EplApiInstance_g.m_InitParam.m_uiIsochrTxMaxPayload; Ret = EplObdWriteEntry(0x1F98, 1, &wTemp, 2); /* if(Ret != kEplSuccessful) { goto Exit; }*/ wTemp = (WORD) EplApiInstance_g.m_InitParam.m_uiIsochrRxMaxPayload; Ret = EplObdWriteEntry(0x1F98, 2, &wTemp, 2); /* if(Ret != kEplSuccessful) { goto Exit; }*/ Ret = EplObdWriteEntry(0x1F98, 3, &EplApiInstance_g.m_InitParam.m_dwPresMaxLatency, 4); /* if(Ret != kEplSuccessful) { goto Exit; }*/ if (EplApiInstance_g.m_InitParam.m_uiPreqActPayloadLimit <= EPL_C_DLL_ISOCHR_MAX_PAYL) { wTemp = (WORD) EplApiInstance_g.m_InitParam.m_uiPreqActPayloadLimit; Ret = EplObdWriteEntry(0x1F98, 4, &wTemp, 2); /* if(Ret != kEplSuccessful) { goto Exit; }*/ } if (EplApiInstance_g.m_InitParam.m_uiPresActPayloadLimit <= EPL_C_DLL_ISOCHR_MAX_PAYL) { wTemp = (WORD) EplApiInstance_g.m_InitParam.m_uiPresActPayloadLimit; Ret = EplObdWriteEntry(0x1F98, 5, &wTemp, 2); /* if(Ret != kEplSuccessful) { goto Exit; }*/ } Ret = EplObdWriteEntry(0x1F98, 6, &EplApiInstance_g.m_InitParam.m_dwAsndMaxLatency, 4); /* if(Ret != kEplSuccessful) { goto Exit; }*/ if (EplApiInstance_g.m_InitParam.m_uiMultiplCycleCnt <= 0xFF) { bTemp = (BYTE) EplApiInstance_g.m_InitParam.m_uiMultiplCycleCnt; Ret = EplObdWriteEntry(0x1F98, 7, &bTemp, 1); /* if(Ret != kEplSuccessful) { goto Exit; }*/ } if (EplApiInstance_g.m_InitParam.m_uiAsyncMtu <= EPL_C_DLL_MAX_ASYNC_MTU) { wTemp = (WORD) EplApiInstance_g.m_InitParam.m_uiAsyncMtu; Ret = EplObdWriteEntry(0x1F98, 8, &wTemp, 2); /* if(Ret != kEplSuccessful) { goto Exit; }*/ } if (EplApiInstance_g.m_InitParam.m_uiPrescaler <= 1000) { wTemp = (WORD) EplApiInstance_g.m_InitParam.m_uiPrescaler; Ret = EplObdWriteEntry(0x1F98, 9, &wTemp, 2); // ignore return code Ret = kEplSuccessful; } #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) if (EplApiInstance_g.m_InitParam.m_dwWaitSocPreq != -1) { Ret = EplObdWriteEntry(0x1F8A, 1, &EplApiInstance_g.m_InitParam. m_dwWaitSocPreq, 4); /* if(Ret != kEplSuccessful) { goto Exit; } */ } if ((EplApiInstance_g.m_InitParam.m_dwAsyncSlotTimeout != 0) && (EplApiInstance_g.m_InitParam.m_dwAsyncSlotTimeout != -1)) { Ret = EplObdWriteEntry(0x1F8A, 2, &EplApiInstance_g.m_InitParam. m_dwAsyncSlotTimeout, 4); /* if(Ret != kEplSuccessful) { goto Exit; } */ } #endif // configure Identity if (EplApiInstance_g.m_InitParam.m_dwDeviceType != -1) { Ret = EplObdWriteEntry(0x1000, 0, &EplApiInstance_g.m_InitParam. m_dwDeviceType, 4); /* if(Ret != kEplSuccessful) { goto Exit; }*/ } if (EplApiInstance_g.m_InitParam.m_dwVendorId != -1) { Ret = EplObdWriteEntry(0x1018, 1, &EplApiInstance_g.m_InitParam.m_dwVendorId, 4); /* if(Ret != kEplSuccessful) { goto Exit; }*/ } if (EplApiInstance_g.m_InitParam.m_dwProductCode != -1) { Ret = EplObdWriteEntry(0x1018, 2, &EplApiInstance_g.m_InitParam. m_dwProductCode, 4); /* if(Ret != kEplSuccessful) { goto Exit; }*/ } if (EplApiInstance_g.m_InitParam.m_dwRevisionNumber != -1) { Ret = EplObdWriteEntry(0x1018, 3, &EplApiInstance_g.m_InitParam. m_dwRevisionNumber, 4); /* if(Ret != kEplSuccessful) { goto Exit; }*/ } if (EplApiInstance_g.m_InitParam.m_dwSerialNumber != -1) { Ret = EplObdWriteEntry(0x1018, 4, &EplApiInstance_g.m_InitParam. m_dwSerialNumber, 4); /* if(Ret != kEplSuccessful) { goto Exit; }*/ } if (EplApiInstance_g.m_InitParam.m_pszDevName != NULL) { // write Device Name (0x1008) Ret = EplObdWriteEntry(0x1008, 0, (void GENERIC *)EplApiInstance_g. m_InitParam.m_pszDevName, (tEplObdSize) strlen(EplApiInstance_g. m_InitParam. m_pszDevName)); /* if (Ret != kEplSuccessful) { goto Exit; }*/ } if (EplApiInstance_g.m_InitParam.m_pszHwVersion != NULL) { // write Hardware version (0x1009) Ret = EplObdWriteEntry(0x1009, 0, (void GENERIC *)EplApiInstance_g. m_InitParam.m_pszHwVersion, (tEplObdSize) strlen(EplApiInstance_g. m_InitParam. m_pszHwVersion)); /* if (Ret != kEplSuccessful) { goto Exit; }*/ } if (EplApiInstance_g.m_InitParam.m_pszSwVersion != NULL) { // write Software version (0x100A) Ret = EplObdWriteEntry(0x100A, 0, (void GENERIC *)EplApiInstance_g. m_InitParam.m_pszSwVersion, (tEplObdSize) strlen(EplApiInstance_g. m_InitParam. m_pszSwVersion)); /* if (Ret != kEplSuccessful) { goto Exit; }*/ } Exit: return Ret; } //--------------------------------------------------------------------------- // // Function: EplApiCbSdoCon // // Description: callback function for SDO transfers // // Parameters: pSdoComFinished_p = SDO parameter // // Returns: tEplKernel = error code // // // State: // //--------------------------------------------------------------------------- #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_SDOC)) != 0) static tEplKernel PUBLIC EplApiCbSdoCon(tEplSdoComFinished * pSdoComFinished_p) { tEplKernel Ret; tEplApiEventArg EventArg; Ret = kEplSuccessful; // call user callback EventArg.m_Sdo = *pSdoComFinished_p; Ret = EplApiInstance_g.m_InitParam.m_pfnCbEvent(kEplApiEventSdo, &EventArg, EplApiInstance_g. m_InitParam. m_pEventUserArg); return Ret; } #endif #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) //--------------------------------------------------------------------------- // // Function: EplApiCbNodeEvent // // Description: callback function for node events // // Parameters: uiNodeId_p = node ID of the CN // NodeEvent_p = event from the specified CN // NmtState_p = current NMT state of the CN // wErrorCode_p = EPL error code if NodeEvent_p==kEplNmtNodeEventError // fMandatory_p = flag if CN is mandatory // // Returns: tEplKernel = error code // // // State: // //--------------------------------------------------------------------------- static tEplKernel PUBLIC EplApiCbNodeEvent(unsigned int uiNodeId_p, tEplNmtNodeEvent NodeEvent_p, tEplNmtState NmtState_p, WORD wErrorCode_p, BOOL fMandatory_p) { tEplKernel Ret; tEplApiEventArg EventArg; Ret = kEplSuccessful; // call user callback EventArg.m_Node.m_uiNodeId = uiNodeId_p; EventArg.m_Node.m_NodeEvent = NodeEvent_p; EventArg.m_Node.m_NmtState = NmtState_p; EventArg.m_Node.m_wErrorCode = wErrorCode_p; EventArg.m_Node.m_fMandatory = fMandatory_p; Ret = EplApiInstance_g.m_InitParam.m_pfnCbEvent(kEplApiEventNode, &EventArg, EplApiInstance_g. m_InitParam. m_pEventUserArg); return Ret; } //--------------------------------------------------------------------------- // // Function: EplApiCbBootEvent // // Description: callback function for boot events // // Parameters: BootEvent_p = event from the boot-up process // NmtState_p = current local NMT state // wErrorCode_p = EPL error code if BootEvent_p==kEplNmtBootEventError // // Returns: tEplKernel = error code // // // State: // //--------------------------------------------------------------------------- static tEplKernel PUBLIC EplApiCbBootEvent(tEplNmtBootEvent BootEvent_p, tEplNmtState NmtState_p, WORD wErrorCode_p) { tEplKernel Ret; tEplApiEventArg EventArg; Ret = kEplSuccessful; // call user callback EventArg.m_Boot.m_BootEvent = BootEvent_p; EventArg.m_Boot.m_NmtState = NmtState_p; EventArg.m_Boot.m_wErrorCode = wErrorCode_p; Ret = EplApiInstance_g.m_InitParam.m_pfnCbEvent(kEplApiEventBoot, &EventArg, EplApiInstance_g. m_InitParam. m_pEventUserArg); return Ret; } #endif // (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0) #if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_LEDU)) != 0) //--------------------------------------------------------------------------- // // Function: EplApiCbLedStateChange // // Description: callback function for LED change events. // // Parameters: LedType_p = type of LED // fOn_p = state of LED // // Returns: tEplKernel = errorcode // // State: // //--------------------------------------------------------------------------- static tEplKernel PUBLIC EplApiCbLedStateChange(tEplLedType LedType_p, BOOL fOn_p) { tEplKernel Ret; tEplApiEventArg EventArg; Ret = kEplSuccessful; // call user callback EventArg.m_Led.m_LedType = LedType_p; EventArg.m_Led.m_fOn = fOn_p; Ret = EplApiInstance_g.m_InitParam.m_pfnCbEvent(kEplApiEventLed, &EventArg, EplApiInstance_g. m_InitParam. m_pEventUserArg); return Ret; } #endif // EOF