blob: d19434f5f6f80f969debe139436340a6fb3b7fb2 [file] [log] [blame]
/****************************************************************************
(c) SYSTEC electronic GmbH, D-07973 Greiz, August-Bebel-Str. 29
www.systec-electronic.com
Project: openPOWERLINK
Description: source file for NMT-MN-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: EplNmtMnu.c,v $
$Author: D.Krueger $
$Revision: 1.18 $ $Date: 2008/11/19 09:52:24 $
$State: Exp $
Build Environment:
GCC V3.4
-------------------------------------------------------------------------
Revision History:
2006/06/09 k.t.: start of the implementation
****************************************************************************/
#include "user/EplNmtMnu.h"
#include "user/EplTimeru.h"
#include "user/EplIdentu.h"
#include "user/EplStatusu.h"
#include "user/EplObdu.h"
#include "user/EplDlluCal.h"
#include "Benchmark.h"
#if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0)
#if (((EPL_MODULE_INTEGRATION) & (EPL_MODULE_OBDU)) == 0) && (EPL_OBD_USE_KERNEL == FALSE)
#error "EPL NmtMnu module needs EPL module OBDU or OBDK!"
#endif
//=========================================================================//
// //
// P R I V A T E D E F I N I T I O N S //
// //
//=========================================================================//
//---------------------------------------------------------------------------
// const defines
//---------------------------------------------------------------------------
// TracePoint support for realtime-debugging
#ifdef _DBG_TRACE_POINTS_
void TgtDbgSignalTracePoint(u8 bTracePointNumber_p);
void TgtDbgPostTraceValue(u32 dwTraceValue_p);
#define TGT_DBG_SIGNAL_TRACE_POINT(p) TgtDbgSignalTracePoint(p)
#define TGT_DBG_POST_TRACE_VALUE(v) TgtDbgPostTraceValue(v)
#else
#define TGT_DBG_SIGNAL_TRACE_POINT(p)
#define TGT_DBG_POST_TRACE_VALUE(v)
#endif
#define EPL_NMTMNU_DBG_POST_TRACE_VALUE(Event_p, uiNodeId_p, wErrorCode_p) \
TGT_DBG_POST_TRACE_VALUE((kEplEventSinkNmtMnu << 28) | (Event_p << 24) \
| (uiNodeId_p << 16) | wErrorCode_p)
// defines for flags in node info structure
#define EPL_NMTMNU_NODE_FLAG_ISOCHRON 0x0001 // CN is being accessed isochronously
#define EPL_NMTMNU_NODE_FLAG_NOT_SCANNED 0x0002 // CN was not scanned once -> decrement SignalCounter and reset flag
#define EPL_NMTMNU_NODE_FLAG_HALTED 0x0004 // boot process for this CN is halted
#define EPL_NMTMNU_NODE_FLAG_NMT_CMD_ISSUED 0x0008 // NMT command was just issued, wrong NMT states will be tolerated
#define EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ 0x0300 // counter for StatusRequest timer handle
#define EPL_NMTMNU_NODE_FLAG_COUNT_LONGER 0x0C00 // counter for longer timeouts timer handle
#define EPL_NMTMNU_NODE_FLAG_INC_STATREQ 0x0100 // increment for StatusRequest timer handle
#define EPL_NMTMNU_NODE_FLAG_INC_LONGER 0x0400 // increment for longer timeouts timer handle
// These counters will be incremented at every timer start
// and copied to timerarg. When the timer event occures
// both will be compared and if unequal the timer event
// will be discarded, because it is an old one.
// defines for timer arguments to draw a distinction between serveral events
#define EPL_NMTMNU_TIMERARG_NODE_MASK 0x000000FFL // mask that contains the node-ID
#define EPL_NMTMNU_TIMERARG_IDENTREQ 0x00010000L // timer event is for IdentRequest
#define EPL_NMTMNU_TIMERARG_STATREQ 0x00020000L // timer event is for StatusRequest
#define EPL_NMTMNU_TIMERARG_LONGER 0x00040000L // timer event is for longer timeouts
#define EPL_NMTMNU_TIMERARG_STATE_MON 0x00080000L // timer event for StatusRequest to monitor execution of NMT state changes
#define EPL_NMTMNU_TIMERARG_COUNT_SR 0x00000300L // counter for StatusRequest
#define EPL_NMTMNU_TIMERARG_COUNT_LO 0x00000C00L // counter for longer timeouts
// The counters must have the same position as in the node flags above.
#define EPL_NMTMNU_SET_FLAGS_TIMERARG_STATREQ(pNodeInfo_p, uiNodeId_p, TimerArg_p) \
pNodeInfo_p->m_wFlags = \
((pNodeInfo_p->m_wFlags + EPL_NMTMNU_NODE_FLAG_INC_STATREQ) \
& EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ) \
| (pNodeInfo_p->m_wFlags & ~EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ); \
TimerArg_p.m_ulArg = EPL_NMTMNU_TIMERARG_STATREQ | uiNodeId_p | \
(pNodeInfo_p->m_wFlags & EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ); \
TimerArg_p.m_EventSink = kEplEventSinkNmtMnu;
#define EPL_NMTMNU_SET_FLAGS_TIMERARG_IDENTREQ(pNodeInfo_p, uiNodeId_p, TimerArg_p) \
pNodeInfo_p->m_wFlags = \
((pNodeInfo_p->m_wFlags + EPL_NMTMNU_NODE_FLAG_INC_STATREQ) \
& EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ) \
| (pNodeInfo_p->m_wFlags & ~EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ); \
TimerArg_p.m_ulArg = EPL_NMTMNU_TIMERARG_IDENTREQ | uiNodeId_p | \
(pNodeInfo_p->m_wFlags & EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ); \
TimerArg_p.m_EventSink = kEplEventSinkNmtMnu;
#define EPL_NMTMNU_SET_FLAGS_TIMERARG_LONGER(pNodeInfo_p, uiNodeId_p, TimerArg_p) \
pNodeInfo_p->m_wFlags = \
((pNodeInfo_p->m_wFlags + EPL_NMTMNU_NODE_FLAG_INC_LONGER) \
& EPL_NMTMNU_NODE_FLAG_COUNT_LONGER) \
| (pNodeInfo_p->m_wFlags & ~EPL_NMTMNU_NODE_FLAG_COUNT_LONGER); \
TimerArg_p.m_ulArg = EPL_NMTMNU_TIMERARG_LONGER | uiNodeId_p | \
(pNodeInfo_p->m_wFlags & EPL_NMTMNU_NODE_FLAG_COUNT_LONGER); \
TimerArg_p.m_EventSink = kEplEventSinkNmtMnu;
#define EPL_NMTMNU_SET_FLAGS_TIMERARG_STATE_MON(pNodeInfo_p, uiNodeId_p, TimerArg_p) \
pNodeInfo_p->m_wFlags = \
((pNodeInfo_p->m_wFlags + EPL_NMTMNU_NODE_FLAG_INC_STATREQ) \
& EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ) \
| (pNodeInfo_p->m_wFlags & ~EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ); \
TimerArg_p.m_ulArg = EPL_NMTMNU_TIMERARG_STATE_MON | uiNodeId_p | \
(pNodeInfo_p->m_wFlags & EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ); \
TimerArg_p.m_EventSink = kEplEventSinkNmtMnu;
// defines for global flags
#define EPL_NMTMNU_FLAG_HALTED 0x0001 // boot process is halted
#define EPL_NMTMNU_FLAG_APP_INFORMED 0x0002 // application was informed about possible NMT state change
// return pointer to node info structure for specified node ID
// d.k. may be replaced by special (hash) function if node ID array is smaller than 254
#define EPL_NMTMNU_GET_NODEINFO(uiNodeId_p) (&EplNmtMnuInstance_g.m_aNodeInfo[uiNodeId_p - 1])
//---------------------------------------------------------------------------
// local types
//---------------------------------------------------------------------------
typedef enum {
kEplNmtMnuIntNodeEventNoIdentResponse = 0x00,
kEplNmtMnuIntNodeEventIdentResponse = 0x01,
kEplNmtMnuIntNodeEventBoot = 0x02,
kEplNmtMnuIntNodeEventExecReset = 0x03,
kEplNmtMnuIntNodeEventConfigured = 0x04,
kEplNmtMnuIntNodeEventNoStatusResponse = 0x05,
kEplNmtMnuIntNodeEventStatusResponse = 0x06,
kEplNmtMnuIntNodeEventHeartbeat = 0x07,
kEplNmtMnuIntNodeEventNmtCmdSent = 0x08,
kEplNmtMnuIntNodeEventTimerIdentReq = 0x09,
kEplNmtMnuIntNodeEventTimerStatReq = 0x0A,
kEplNmtMnuIntNodeEventTimerStateMon = 0x0B,
kEplNmtMnuIntNodeEventTimerLonger = 0x0C,
kEplNmtMnuIntNodeEventError = 0x0D,
} tEplNmtMnuIntNodeEvent;
typedef enum {
kEplNmtMnuNodeStateUnknown = 0x00,
kEplNmtMnuNodeStateIdentified = 0x01,
kEplNmtMnuNodeStateResetConf = 0x02, // CN reset after configuration update
kEplNmtMnuNodeStateConfigured = 0x03, // BootStep1 completed
kEplNmtMnuNodeStateReadyToOp = 0x04, // BootStep2 completed
kEplNmtMnuNodeStateComChecked = 0x05, // Communication checked successfully
kEplNmtMnuNodeStateOperational = 0x06, // CN is in NMT state OPERATIONAL
} tEplNmtMnuNodeState;
typedef struct {
tEplTimerHdl m_TimerHdlStatReq; // timer to delay StatusRequests and IdentRequests
tEplTimerHdl m_TimerHdlLonger; // 2nd timer for NMT command EnableReadyToOp and CheckCommunication
tEplNmtMnuNodeState m_NodeState; // internal node state (kind of sub state of NMT state)
u32 m_dwNodeCfg; // subindex from 0x1F81
u16 m_wFlags; // flags: CN is being accessed isochronously
} tEplNmtMnuNodeInfo;
typedef struct {
tEplNmtMnuNodeInfo m_aNodeInfo[EPL_NMT_MAX_NODE_ID];
tEplTimerHdl m_TimerHdlNmtState; // timeout for stay in NMT state
unsigned int m_uiMandatorySlaveCount;
unsigned int m_uiSignalSlaveCount;
unsigned long m_ulStatusRequestDelay; // in [ms] (object 0x1006 * EPL_C_NMT_STATREQ_CYCLE)
unsigned long m_ulTimeoutReadyToOp; // in [ms] (object 0x1F89/5)
unsigned long m_ulTimeoutCheckCom; // in [ms] (object 0x1006 * MultiplexedCycleCount)
u16 m_wFlags; // global flags
u32 m_dwNmtStartup; // object 0x1F80 NMT_StartUp_U32
tEplNmtMnuCbNodeEvent m_pfnCbNodeEvent;
tEplNmtMnuCbBootEvent m_pfnCbBootEvent;
} tEplNmtMnuInstance;
//---------------------------------------------------------------------------
// local vars
//---------------------------------------------------------------------------
static tEplNmtMnuInstance EplNmtMnuInstance_g;
//---------------------------------------------------------------------------
// local function prototypes
//---------------------------------------------------------------------------
static tEplKernel EplNmtMnuCbNmtRequest(tEplFrameInfo *pFrameInfo_p);
static tEplKernel EplNmtMnuCbIdentResponse(unsigned int uiNodeId_p,
tEplIdentResponse *pIdentResponse_p);
static tEplKernel EplNmtMnuCbStatusResponse(unsigned int uiNodeId_p,
tEplStatusResponse *pStatusResponse_p);
static tEplKernel EplNmtMnuCheckNmtState(unsigned int uiNodeId_p,
tEplNmtMnuNodeInfo * pNodeInfo_p,
tEplNmtState NodeNmtState_p,
u16 wErrorCode_p,
tEplNmtState LocalNmtState_p);
static tEplKernel EplNmtMnuStartBootStep1(void);
static tEplKernel EplNmtMnuStartBootStep2(void);
static tEplKernel EplNmtMnuStartCheckCom(void);
static tEplKernel EplNmtMnuNodeBootStep2(unsigned int uiNodeId_p,
tEplNmtMnuNodeInfo * pNodeInfo_p);
static tEplKernel EplNmtMnuNodeCheckCom(unsigned int uiNodeId_p,
tEplNmtMnuNodeInfo * pNodeInfo_p);
static tEplKernel EplNmtMnuStartNodes(void);
static tEplKernel EplNmtMnuProcessInternalEvent(unsigned int uiNodeId_p,
tEplNmtState NodeNmtState_p,
u16 wErrorCode_p,
tEplNmtMnuIntNodeEvent
NodeEvent_p);
static tEplKernel EplNmtMnuReset(void);
//=========================================================================//
// //
// P U B L I C F U N C T I O N S //
// //
//=========================================================================//
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuInit
//
// Description: init first instance of the module
//
//
//
// Parameters:
//
//
// Returns: tEplKernel = errorcode
//
//
// State:
//
//---------------------------------------------------------------------------
tEplKernel EplNmtMnuInit(tEplNmtMnuCbNodeEvent pfnCbNodeEvent_p,
tEplNmtMnuCbBootEvent pfnCbBootEvent_p)
{
tEplKernel Ret;
Ret = EplNmtMnuAddInstance(pfnCbNodeEvent_p, pfnCbBootEvent_p);
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuAddInstance
//
// Description: init other instances of the module
//
//
//
// Parameters:
//
//
// Returns: tEplKernel = errorcode
//
//
// State:
//
//---------------------------------------------------------------------------
tEplKernel EplNmtMnuAddInstance(tEplNmtMnuCbNodeEvent pfnCbNodeEvent_p,
tEplNmtMnuCbBootEvent pfnCbBootEvent_p)
{
tEplKernel Ret;
Ret = kEplSuccessful;
// reset instance structure
EPL_MEMSET(&EplNmtMnuInstance_g, 0, sizeof(EplNmtMnuInstance_g));
if ((pfnCbNodeEvent_p == NULL) || (pfnCbBootEvent_p == NULL)) {
Ret = kEplNmtInvalidParam;
goto Exit;
}
EplNmtMnuInstance_g.m_pfnCbNodeEvent = pfnCbNodeEvent_p;
EplNmtMnuInstance_g.m_pfnCbBootEvent = pfnCbBootEvent_p;
// initialize StatusRequest delay
EplNmtMnuInstance_g.m_ulStatusRequestDelay = 5000L;
// register NmtMnResponse callback function
Ret =
EplDlluCalRegAsndService(kEplDllAsndNmtRequest,
EplNmtMnuCbNmtRequest,
kEplDllAsndFilterLocal);
Exit:
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuDelInstance
//
// Description: delete instance
//
//
//
// Parameters:
//
//
// Returns: tEplKernel = errorcode
//
//
// State:
//
//---------------------------------------------------------------------------
tEplKernel EplNmtMnuDelInstance(void)
{
tEplKernel Ret;
Ret = kEplSuccessful;
// deregister NmtMnResponse callback function
Ret =
EplDlluCalRegAsndService(kEplDllAsndNmtRequest, NULL,
kEplDllAsndFilterNone);
Ret = EplNmtMnuReset();
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuSendNmtCommandEx
//
// Description: sends the specified NMT command to the specified node.
//
// Parameters: uiNodeId_p = node ID to which the NMT command will be sent
// NmtCommand_p = NMT command
//
// Returns: tEplKernel = error code
//
// State:
//
//---------------------------------------------------------------------------
tEplKernel EplNmtMnuSendNmtCommandEx(unsigned int uiNodeId_p,
tEplNmtCommand NmtCommand_p,
void *pNmtCommandData_p,
unsigned int uiDataSize_p)
{
tEplKernel Ret = kEplSuccessful;
tEplFrameInfo FrameInfo;
u8 abBuffer[EPL_C_DLL_MINSIZE_NMTCMDEXT];
tEplFrame *pFrame = (tEplFrame *) abBuffer;
BOOL fSoftDeleteNode = FALSE;
if ((uiNodeId_p == 0) || (uiNodeId_p > EPL_C_ADR_BROADCAST)) { // invalid node ID specified
Ret = kEplInvalidNodeId;
goto Exit;
}
if ((pNmtCommandData_p != NULL)
&& (uiDataSize_p >
(EPL_C_DLL_MINSIZE_NMTCMDEXT - EPL_C_DLL_MINSIZE_NMTCMD))) {
Ret = kEplNmtInvalidParam;
goto Exit;
}
// $$$ d.k. may be check in future versions if the caller wants to perform prohibited state transitions
// the CN should not perform these transitions, but the expected NMT state will be changed and never fullfilled.
// build frame
EPL_MEMSET(pFrame, 0x00, sizeof(abBuffer));
AmiSetByteToLe(&pFrame->m_le_bDstNodeId, (u8) uiNodeId_p);
AmiSetByteToLe(&pFrame->m_Data.m_Asnd.m_le_bServiceId,
(u8) kEplDllAsndNmtCommand);
AmiSetByteToLe(&pFrame->m_Data.m_Asnd.m_Payload.m_NmtCommandService.
m_le_bNmtCommandId, (u8) NmtCommand_p);
if ((pNmtCommandData_p != NULL) && (uiDataSize_p > 0)) { // copy command data to frame
EPL_MEMCPY(&pFrame->m_Data.m_Asnd.m_Payload.m_NmtCommandService.
m_le_abNmtCommandData[0], pNmtCommandData_p,
uiDataSize_p);
}
// build info structure
FrameInfo.m_NetTime.m_dwNanoSec = 0;
FrameInfo.m_NetTime.m_dwSec = 0;
FrameInfo.m_pFrame = pFrame;
FrameInfo.m_uiFrameSize = sizeof(abBuffer);
// send NMT-Request
#if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_DLLU)) != 0)
Ret = EplDlluCalAsyncSend(&FrameInfo, // pointer to frameinfo
kEplDllAsyncReqPrioNmt); // priority
#endif
if (Ret != kEplSuccessful) {
goto Exit;
}
EPL_DBGLVL_NMTMN_TRACE2("NMTCmd(%02X->%02X)\n", NmtCommand_p,
uiNodeId_p);
switch (NmtCommand_p) {
case kEplNmtCmdStartNode:
case kEplNmtCmdEnterPreOperational2:
case kEplNmtCmdEnableReadyToOperate:
{
// nothing left to do,
// because any further processing is done
// when the NMT command is actually sent
goto Exit;
}
case kEplNmtCmdStopNode:
{
fSoftDeleteNode = TRUE;
break;
}
case kEplNmtCmdResetNode:
case kEplNmtCmdResetCommunication:
case kEplNmtCmdResetConfiguration:
case kEplNmtCmdSwReset:
{
break;
}
default:
goto Exit;
}
// remove CN from isochronous phase;
// This must be done here and not when NMT command is actually sent
// because it will be too late and may cause unwanted errors
if (uiNodeId_p != EPL_C_ADR_BROADCAST) {
if (fSoftDeleteNode == FALSE) { // remove CN immediately from isochronous phase
Ret = EplDlluCalDeleteNode(uiNodeId_p);
} else { // remove CN from isochronous phase softly
Ret = EplDlluCalSoftDeleteNode(uiNodeId_p);
}
} else { // do it for all active CNs
for (uiNodeId_p = 1;
uiNodeId_p <= tabentries(EplNmtMnuInstance_g.m_aNodeInfo);
uiNodeId_p++) {
if ((EPL_NMTMNU_GET_NODEINFO(uiNodeId_p)->
m_dwNodeCfg & (EPL_NODEASSIGN_NODE_IS_CN |
EPL_NODEASSIGN_NODE_EXISTS)) != 0) {
if (fSoftDeleteNode == FALSE) { // remove CN immediately from isochronous phase
Ret = EplDlluCalDeleteNode(uiNodeId_p);
} else { // remove CN from isochronous phase softly
Ret =
EplDlluCalSoftDeleteNode
(uiNodeId_p);
}
}
}
}
Exit:
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuSendNmtCommand
//
// Description: sends the specified NMT command to the specified node.
//
// Parameters: uiNodeId_p = node ID to which the NMT command will be sent
// NmtCommand_p = NMT command
//
// Returns: tEplKernel = error code
//
// State:
//
//---------------------------------------------------------------------------
tEplKernel EplNmtMnuSendNmtCommand(unsigned int uiNodeId_p,
tEplNmtCommand NmtCommand_p)
{
tEplKernel Ret = kEplSuccessful;
Ret = EplNmtMnuSendNmtCommandEx(uiNodeId_p, NmtCommand_p, NULL, 0);
//Exit:
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuTriggerStateChange
//
// 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
//
// Returns: tEplKernel = error code
//
// State:
//
//---------------------------------------------------------------------------
tEplKernel EplNmtMnuTriggerStateChange(unsigned int uiNodeId_p,
tEplNmtNodeCommand NodeCommand_p)
{
tEplKernel Ret = kEplSuccessful;
tEplNmtMnuIntNodeEvent NodeEvent;
tEplObdSize ObdSize;
u8 bNmtState;
u16 wErrorCode = EPL_E_NO_ERROR;
if ((uiNodeId_p == 0) || (uiNodeId_p >= EPL_C_ADR_BROADCAST)) {
Ret = kEplInvalidNodeId;
goto Exit;
}
switch (NodeCommand_p) {
case kEplNmtNodeCommandBoot:
{
NodeEvent = kEplNmtMnuIntNodeEventBoot;
break;
}
case kEplNmtNodeCommandConfOk:
{
NodeEvent = kEplNmtMnuIntNodeEventConfigured;
break;
}
case kEplNmtNodeCommandConfErr:
{
NodeEvent = kEplNmtMnuIntNodeEventError;
wErrorCode = EPL_E_NMT_BPO1_CF_VERIFY;
break;
}
case kEplNmtNodeCommandConfReset:
{
NodeEvent = kEplNmtMnuIntNodeEventExecReset;
break;
}
default:
{ // invalid node command
goto Exit;
}
}
// fetch current NMT state
ObdSize = 1;
Ret = EplObduReadEntry(0x1F8E, uiNodeId_p, &bNmtState, &ObdSize);
if (Ret != kEplSuccessful) {
goto Exit;
}
Ret = EplNmtMnuProcessInternalEvent(uiNodeId_p,
(tEplNmtState) (bNmtState |
EPL_NMT_TYPE_CS),
wErrorCode, NodeEvent);
Exit:
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuCbNmtStateChange
//
// Description: callback function for NMT state changes
//
// Parameters: NmtStateChange_p = NMT state change event
//
// Returns: tEplKernel = error code
//
//
// State:
//
//---------------------------------------------------------------------------
tEplKernel EplNmtMnuCbNmtStateChange(tEplEventNmtStateChange NmtStateChange_p)
{
tEplKernel Ret = kEplSuccessful;
// 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:
break;
// init of the manufacturer-specific profile area and the
// standardised device profile area
case kEplNmtGsResetApplication:
{
break;
}
// init of the communication profile area
case kEplNmtGsResetCommunication:
{
break;
}
*/
// build the configuration with infos from OD
case kEplNmtGsResetConfiguration:
{
u32 dwTimeout;
tEplObdSize ObdSize;
// read object 0x1F80 NMT_StartUp_U32
ObdSize = 4;
Ret =
EplObduReadEntry(0x1F80, 0,
&EplNmtMnuInstance_g.
m_dwNmtStartup, &ObdSize);
if (Ret != kEplSuccessful) {
break;
}
// compute StatusReqDelay = object 0x1006 * EPL_C_NMT_STATREQ_CYCLE
ObdSize = sizeof(dwTimeout);
Ret = EplObduReadEntry(0x1006, 0, &dwTimeout, &ObdSize);
if (Ret != kEplSuccessful) {
break;
}
if (dwTimeout != 0L) {
EplNmtMnuInstance_g.m_ulStatusRequestDelay =
dwTimeout * EPL_C_NMT_STATREQ_CYCLE / 1000L;
if (EplNmtMnuInstance_g.
m_ulStatusRequestDelay == 0L) {
EplNmtMnuInstance_g.m_ulStatusRequestDelay = 1L; // at least 1 ms
}
// $$$ fetch and use MultiplexedCycleCount from OD
EplNmtMnuInstance_g.m_ulTimeoutCheckCom =
dwTimeout * EPL_C_NMT_STATREQ_CYCLE / 1000L;
if (EplNmtMnuInstance_g.m_ulTimeoutCheckCom ==
0L) {
EplNmtMnuInstance_g.m_ulTimeoutCheckCom = 1L; // at least 1 ms
}
}
// fetch ReadyToOp Timeout from OD
ObdSize = sizeof(dwTimeout);
Ret = EplObduReadEntry(0x1F89, 5, &dwTimeout, &ObdSize);
if (Ret != kEplSuccessful) {
break;
}
if (dwTimeout != 0L) {
// convert [us] to [ms]
dwTimeout /= 1000L;
if (dwTimeout == 0L) {
dwTimeout = 1L; // at least 1 ms
}
EplNmtMnuInstance_g.m_ulTimeoutReadyToOp =
dwTimeout;
} else {
EplNmtMnuInstance_g.m_ulTimeoutReadyToOp = 0L;
}
break;
}
/*
//-----------------------------------------------------------
// CN part of the state machine
// node liste for EPL-Frames and check timeout
case kEplNmtCsNotActive:
{
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:
{
u32 dwTimeout;
tEplTimerArg TimerArg;
tEplObdSize ObdSize;
tEplEvent Event;
// clear global flags, e.g. reenable boot process
EplNmtMnuInstance_g.m_wFlags = 0;
// reset IdentResponses and running IdentRequests and StatusRequests
Ret = EplIdentuReset();
Ret = EplStatusuReset();
// reset timers
Ret = EplNmtMnuReset();
// 2008/11/18 d.k. reset internal node info is not necessary,
// because timer flags are important and other
// things are reset by EplNmtMnuStartBootStep1().
/*
EPL_MEMSET(EplNmtMnuInstance_g.m_aNodeInfo,
0,
sizeof (EplNmtMnuInstance_g.m_aNodeInfo));
*/
// inform DLL about NMT state change,
// so that it can clear the asynchonous queues and start the reduced cycle
Event.m_EventSink = kEplEventSinkDllk;
Event.m_EventType = kEplEventTypeDllkStartReducedCycle;
EPL_MEMSET(&Event.m_NetTime, 0x00,
sizeof(Event.m_NetTime));
Event.m_pArg = NULL;
Event.m_uiSize = 0;
Ret = EplEventuPost(&Event);
if (Ret != kEplSuccessful) {
break;
}
// reset all nodes
// d.k.: skip this step if was just done before, e.g. because of a ResetNode command from a diagnostic node
if (NmtStateChange_p.m_NmtEvent ==
kEplNmtEventTimerMsPreOp1) {
BENCHMARK_MOD_07_TOGGLE(9);
EPL_NMTMNU_DBG_POST_TRACE_VALUE(0,
EPL_C_ADR_BROADCAST,
kEplNmtCmdResetNode);
Ret =
EplNmtMnuSendNmtCommand(EPL_C_ADR_BROADCAST,
kEplNmtCmdResetNode);
if (Ret != kEplSuccessful) {
break;
}
}
// start network scan
Ret = EplNmtMnuStartBootStep1();
// start timer for 0x1F89/2 MNTimeoutPreOp1_U32
ObdSize = sizeof(dwTimeout);
Ret = EplObduReadEntry(0x1F89, 2, &dwTimeout, &ObdSize);
if (Ret != kEplSuccessful) {
break;
}
if (dwTimeout != 0L) {
dwTimeout /= 1000L;
if (dwTimeout == 0L) {
dwTimeout = 1L; // at least 1 ms
}
TimerArg.m_EventSink = kEplEventSinkNmtMnu;
TimerArg.m_ulArg = 0;
Ret =
EplTimeruModifyTimerMs(&EplNmtMnuInstance_g.
m_TimerHdlNmtState,
dwTimeout, TimerArg);
}
break;
}
// node processes isochronous and asynchronous frames
case kEplNmtMsPreOperational2:
{
// add identified CNs to isochronous phase
// send EnableReadyToOp to all identified CNs
Ret = EplNmtMnuStartBootStep2();
// wait for NMT state change of CNs
break;
}
// node should be configured und application is ready
case kEplNmtMsReadyToOperate:
{
// check if PRes of CNs are OK
// d.k. that means wait CycleLength * MultiplexCycleCount (i.e. start timer)
// because Dllk checks PRes of CNs automatically in ReadyToOp
Ret = EplNmtMnuStartCheckCom();
break;
}
// normal work state
case kEplNmtMsOperational:
{
// send StartNode to CNs
// wait for NMT state change of CNs
Ret = EplNmtMnuStartNodes();
break;
}
// no EPL cycle
// -> normal ethernet communication
case kEplNmtMsBasicEthernet:
{
break;
}
default:
{
// TRACE0("EplNmtMnuCbNmtStateChange(): unhandled NMT state\n");
}
}
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuCbCheckEvent
//
// Description: callback funktion for NMT events before they are actually executed.
// The EPL API layer must forward NMT events from NmtCnu module.
// This module will reject some NMT commands while MN.
//
// Parameters: NmtEvent_p = outstanding NMT event for approval
//
// Returns: tEplKernel = error code
// kEplReject = reject the NMT event
//
// State:
//
//---------------------------------------------------------------------------
tEplKernel EplNmtMnuCbCheckEvent(tEplNmtEvent NmtEvent_p)
{
tEplKernel Ret = kEplSuccessful;
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtuProcessEvent
//
// Description: processes events from event queue
//
// Parameters: pEvent_p = pointer to event
//
// Returns: tEplKernel = errorcode
//
// State:
//
//---------------------------------------------------------------------------
tEplKernel EplNmtMnuProcessEvent(tEplEvent *pEvent_p)
{
tEplKernel Ret;
Ret = kEplSuccessful;
// process event
switch (pEvent_p->m_EventType) {
// timer event
case kEplEventTypeTimer:
{
tEplTimerEventArg *pTimerEventArg =
(tEplTimerEventArg *) pEvent_p->m_pArg;
unsigned int uiNodeId;
uiNodeId =
(unsigned int)(pTimerEventArg->
m_ulArg &
EPL_NMTMNU_TIMERARG_NODE_MASK);
if (uiNodeId != 0) {
tEplObdSize ObdSize;
u8 bNmtState;
tEplNmtMnuNodeInfo *pNodeInfo;
pNodeInfo = EPL_NMTMNU_GET_NODEINFO(uiNodeId);
ObdSize = 1;
Ret =
EplObduReadEntry(0x1F8E, uiNodeId,
&bNmtState, &ObdSize);
if (Ret != kEplSuccessful) {
break;
}
if ((pTimerEventArg->
m_ulArg & EPL_NMTMNU_TIMERARG_IDENTREQ) !=
0L) {
if ((pNodeInfo->
m_wFlags &
EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ)
!= (pTimerEventArg->m_ulArg & EPL_NMTMNU_TIMERARG_COUNT_SR)) { // this is an old (already deleted or modified) timer
// but not the current timer
// so discard it
EPL_NMTMNU_DBG_POST_TRACE_VALUE
(kEplNmtMnuIntNodeEventTimerIdentReq,
uiNodeId,
((pNodeInfo->
m_NodeState << 8)
| 0xFF));
break;
}
/*
EPL_NMTMNU_DBG_POST_TRACE_VALUE(kEplNmtMnuIntNodeEventTimerIdentReq,
uiNodeId,
((pNodeInfo->m_NodeState << 8)
| 0x80
| ((pNodeInfo->m_wFlags & EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ) >> 6)
| ((pTimerEventArg->m_ulArg & EPL_NMTMNU_TIMERARG_COUNT_SR) >> 8)));
*/
Ret =
EplNmtMnuProcessInternalEvent
(uiNodeId,
(tEplNmtState) (bNmtState |
EPL_NMT_TYPE_CS),
EPL_E_NO_ERROR,
kEplNmtMnuIntNodeEventTimerIdentReq);
}
else if ((pTimerEventArg->
m_ulArg & EPL_NMTMNU_TIMERARG_STATREQ)
!= 0L) {
if ((pNodeInfo->
m_wFlags &
EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ)
!= (pTimerEventArg->m_ulArg & EPL_NMTMNU_TIMERARG_COUNT_SR)) { // this is an old (already deleted or modified) timer
// but not the current timer
// so discard it
EPL_NMTMNU_DBG_POST_TRACE_VALUE
(kEplNmtMnuIntNodeEventTimerStatReq,
uiNodeId,
((pNodeInfo->
m_NodeState << 8)
| 0xFF));
break;
}
/*
EPL_NMTMNU_DBG_POST_TRACE_VALUE(kEplNmtMnuIntNodeEventTimerStatReq,
uiNodeId,
((pNodeInfo->m_NodeState << 8)
| 0x80
| ((pNodeInfo->m_wFlags & EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ) >> 6)
| ((pTimerEventArg->m_ulArg & EPL_NMTMNU_TIMERARG_COUNT_SR) >> 8)));
*/
Ret =
EplNmtMnuProcessInternalEvent
(uiNodeId,
(tEplNmtState) (bNmtState |
EPL_NMT_TYPE_CS),
EPL_E_NO_ERROR,
kEplNmtMnuIntNodeEventTimerStatReq);
}
else if ((pTimerEventArg->
m_ulArg &
EPL_NMTMNU_TIMERARG_STATE_MON) !=
0L) {
if ((pNodeInfo->
m_wFlags &
EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ)
!= (pTimerEventArg->m_ulArg & EPL_NMTMNU_TIMERARG_COUNT_SR)) { // this is an old (already deleted or modified) timer
// but not the current timer
// so discard it
EPL_NMTMNU_DBG_POST_TRACE_VALUE
(kEplNmtMnuIntNodeEventTimerStateMon,
uiNodeId,
((pNodeInfo->
m_NodeState << 8)
| 0xFF));
break;
}
/*
EPL_NMTMNU_DBG_POST_TRACE_VALUE(kEplNmtMnuIntNodeEventTimerStatReq,
uiNodeId,
((pNodeInfo->m_NodeState << 8)
| 0x80
| ((pNodeInfo->m_wFlags & EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ) >> 6)
| ((pTimerEventArg->m_ulArg & EPL_NMTMNU_TIMERARG_COUNT_SR) >> 8)));
*/
Ret =
EplNmtMnuProcessInternalEvent
(uiNodeId,
(tEplNmtState) (bNmtState |
EPL_NMT_TYPE_CS),
EPL_E_NO_ERROR,
kEplNmtMnuIntNodeEventTimerStateMon);
}
else if ((pTimerEventArg->
m_ulArg & EPL_NMTMNU_TIMERARG_LONGER)
!= 0L) {
if ((pNodeInfo->
m_wFlags &
EPL_NMTMNU_NODE_FLAG_COUNT_LONGER)
!= (pTimerEventArg->m_ulArg & EPL_NMTMNU_TIMERARG_COUNT_LO)) { // this is an old (already deleted or modified) timer
// but not the current timer
// so discard it
EPL_NMTMNU_DBG_POST_TRACE_VALUE
(kEplNmtMnuIntNodeEventTimerLonger,
uiNodeId,
((pNodeInfo->
m_NodeState << 8)
| 0xFF));
break;
}
/*
EPL_NMTMNU_DBG_POST_TRACE_VALUE(kEplNmtMnuIntNodeEventTimerLonger,
uiNodeId,
((pNodeInfo->m_NodeState << 8)
| 0x80
| ((pNodeInfo->m_wFlags & EPL_NMTMNU_NODE_FLAG_COUNT_LONGER) >> 6)
| ((pTimerEventArg->m_ulArg & EPL_NMTMNU_TIMERARG_COUNT_LO) >> 8)));
*/
Ret =
EplNmtMnuProcessInternalEvent
(uiNodeId,
(tEplNmtState) (bNmtState |
EPL_NMT_TYPE_CS),
EPL_E_NO_ERROR,
kEplNmtMnuIntNodeEventTimerLonger);
}
} else { // global timer event
}
break;
}
case kEplEventTypeHeartbeat:
{
tEplHeartbeatEvent *pHeartbeatEvent =
(tEplHeartbeatEvent *) pEvent_p->m_pArg;
Ret =
EplNmtMnuProcessInternalEvent(pHeartbeatEvent->
m_uiNodeId,
pHeartbeatEvent->
m_NmtState,
pHeartbeatEvent->
m_wErrorCode,
kEplNmtMnuIntNodeEventHeartbeat);
break;
}
case kEplEventTypeNmtMnuNmtCmdSent:
{
tEplFrame *pFrame = (tEplFrame *) pEvent_p->m_pArg;
unsigned int uiNodeId;
tEplNmtCommand NmtCommand;
u8 bNmtState;
uiNodeId = AmiGetByteFromLe(&pFrame->m_le_bDstNodeId);
NmtCommand =
(tEplNmtCommand) AmiGetByteFromLe(&pFrame->m_Data.
m_Asnd.m_Payload.
m_NmtCommandService.
m_le_bNmtCommandId);
switch (NmtCommand) {
case kEplNmtCmdStartNode:
bNmtState =
(u8) (kEplNmtCsOperational & 0xFF);
break;
case kEplNmtCmdStopNode:
bNmtState = (u8) (kEplNmtCsStopped & 0xFF);
break;
case kEplNmtCmdEnterPreOperational2:
bNmtState =
(u8) (kEplNmtCsPreOperational2 & 0xFF);
break;
case kEplNmtCmdEnableReadyToOperate:
// d.k. do not change expected node state, because of DS 1.0.0 7.3.1.2.1 Plain NMT State Command
// and because node may not change NMT state within EPL_C_NMT_STATE_TOLERANCE
bNmtState =
(u8) (kEplNmtCsPreOperational2 & 0xFF);
break;
case kEplNmtCmdResetNode:
case kEplNmtCmdResetCommunication:
case kEplNmtCmdResetConfiguration:
case kEplNmtCmdSwReset:
bNmtState = (u8) (kEplNmtCsNotActive & 0xFF);
// EplNmtMnuProcessInternalEvent() sets internal node state to kEplNmtMnuNodeStateUnknown
// after next unresponded IdentRequest/StatusRequest
break;
default:
goto Exit;
}
// process as internal event which update expected NMT state in OD
if (uiNodeId != EPL_C_ADR_BROADCAST) {
Ret = EplNmtMnuProcessInternalEvent(uiNodeId,
(tEplNmtState)
(bNmtState |
EPL_NMT_TYPE_CS),
0,
kEplNmtMnuIntNodeEventNmtCmdSent);
} else { // process internal event for all active nodes (except myself)
for (uiNodeId = 1;
uiNodeId <=
tabentries(EplNmtMnuInstance_g.
m_aNodeInfo); uiNodeId++) {
if ((EPL_NMTMNU_GET_NODEINFO(uiNodeId)->
m_dwNodeCfg &
(EPL_NODEASSIGN_NODE_IS_CN |
EPL_NODEASSIGN_NODE_EXISTS)) !=
0) {
Ret =
EplNmtMnuProcessInternalEvent
(uiNodeId,
(tEplNmtState) (bNmtState |
EPL_NMT_TYPE_CS),
0,
kEplNmtMnuIntNodeEventNmtCmdSent);
if (Ret != kEplSuccessful) {
goto Exit;
}
}
}
}
break;
}
default:
{
Ret = kEplNmtInvalidEvent;
}
}
Exit:
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuGetRunningTimerStatReq
//
// Description: returns a bit field with running StatReq timers
// just for debugging purposes
//
// Parameters: (none)
//
// Returns: tEplKernel = error code
//
// State:
//
//---------------------------------------------------------------------------
tEplKernel EplNmtMnuGetDiagnosticInfo(unsigned int *puiMandatorySlaveCount_p,
unsigned int *puiSignalSlaveCount_p,
u16 *pwFlags_p)
{
tEplKernel Ret = kEplSuccessful;
if ((puiMandatorySlaveCount_p == NULL)
|| (puiSignalSlaveCount_p == NULL)
|| (pwFlags_p == NULL)) {
Ret = kEplNmtInvalidParam;
goto Exit;
}
*puiMandatorySlaveCount_p = EplNmtMnuInstance_g.m_uiMandatorySlaveCount;
*puiSignalSlaveCount_p = EplNmtMnuInstance_g.m_uiSignalSlaveCount;
*pwFlags_p = EplNmtMnuInstance_g.m_wFlags;
Exit:
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuGetRunningTimerStatReq
//
// Description: returns a bit field with running StatReq timers
// just for debugging purposes
//
// Parameters: (none)
//
// Returns: tEplKernel = error code
//
// State:
//
//---------------------------------------------------------------------------
/*
u32 EplNmtMnuGetRunningTimerStatReq(void)
{
tEplKernel Ret = kEplSuccessful;
unsigned int uiIndex;
tEplNmtMnuNodeInfo* pNodeInfo;
pNodeInfo = EplNmtMnuInstance_g.m_aNodeInfo;
for (uiIndex = 1; uiIndex <= tabentries(EplNmtMnuInstance_g.m_aNodeInfo); uiIndex++, pNodeInfo++)
{
if (pNodeInfo->m_NodeState == kEplNmtMnuNodeStateConfigured)
{
// reset flag "scanned once"
pNodeInfo->m_wFlags &= ~EPL_NMTMNU_NODE_FLAG_SCANNED;
Ret = EplNmtMnuNodeBootStep2(uiIndex, pNodeInfo);
if (Ret != kEplSuccessful)
{
goto Exit;
}
EplNmtMnuInstance_g.m_uiSignalSlaveCount++;
// signal slave counter shall be decremented if StatusRequest was sent once to a CN
// mandatory slave counter shall be decremented if mandatory CN is ReadyToOp
}
}
Exit:
return Ret;
}
*/
//=========================================================================//
// //
// P R I V A T E F U N C T I O N S //
// //
//=========================================================================//
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuCbNmtRequest
//
// Description: callback funktion for NmtRequest
//
// Parameters: pFrameInfo_p = Frame with the NmtRequest
//
// Returns: tEplKernel = error code
//
//
// State:
//
//---------------------------------------------------------------------------
static tEplKernel EplNmtMnuCbNmtRequest(tEplFrameInfo *pFrameInfo_p)
{
tEplKernel Ret = kEplSuccessful;
// $$$ perform NMTRequest
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuCbIdentResponse
//
// Description: callback funktion for IdentResponse
//
// Parameters: uiNodeId_p = node ID for which IdentReponse was received
// pIdentResponse_p = pointer to IdentResponse
// is NULL if node did not answer
//
// Returns: tEplKernel = error code
//
// State:
//
//---------------------------------------------------------------------------
static tEplKernel EplNmtMnuCbIdentResponse(unsigned int uiNodeId_p,
tEplIdentResponse *pIdentResponse_p)
{
tEplKernel Ret = kEplSuccessful;
if (pIdentResponse_p == NULL) { // node did not answer
Ret = EplNmtMnuProcessInternalEvent(uiNodeId_p, kEplNmtCsNotActive, EPL_E_NMT_NO_IDENT_RES, // was EPL_E_NO_ERROR
kEplNmtMnuIntNodeEventNoIdentResponse);
} else { // node answered IdentRequest
tEplObdSize ObdSize;
u32 dwDevType;
u16 wErrorCode = EPL_E_NO_ERROR;
tEplNmtState NmtState =
(tEplNmtState) (AmiGetByteFromLe
(&pIdentResponse_p->
m_le_bNmtStatus) | EPL_NMT_TYPE_CS);
// check IdentResponse $$$ move to ProcessIntern, because this function may be called also if CN
// check DeviceType (0x1F84)
ObdSize = 4;
Ret =
EplObduReadEntry(0x1F84, uiNodeId_p, &dwDevType, &ObdSize);
if (Ret != kEplSuccessful) {
goto Exit;
}
if (dwDevType != 0L) { // actually compare it with DeviceType from IdentResponse
if (AmiGetDwordFromLe(&pIdentResponse_p->m_le_dwDeviceType) != dwDevType) { // wrong DeviceType
NmtState = kEplNmtCsNotActive;
wErrorCode = EPL_E_NMT_BPO1_DEVICE_TYPE;
}
}
Ret = EplNmtMnuProcessInternalEvent(uiNodeId_p,
NmtState,
wErrorCode,
kEplNmtMnuIntNodeEventIdentResponse);
}
Exit:
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuCbStatusResponse
//
// Description: callback funktion for StatusResponse
//
// Parameters: uiNodeId_p = node ID for which IdentReponse was received
// pIdentResponse_p = pointer to IdentResponse
// is NULL if node did not answer
//
// Returns: tEplKernel = error code
//
// State:
//
//---------------------------------------------------------------------------
static tEplKernel EplNmtMnuCbStatusResponse(unsigned int uiNodeId_p,
tEplStatusResponse *pStatusResponse_p)
{
tEplKernel Ret = kEplSuccessful;
if (pStatusResponse_p == NULL) { // node did not answer
Ret = EplNmtMnuProcessInternalEvent(uiNodeId_p, kEplNmtCsNotActive, EPL_E_NMT_NO_STATUS_RES, // was EPL_E_NO_ERROR
kEplNmtMnuIntNodeEventNoStatusResponse);
} else { // node answered StatusRequest
Ret = EplNmtMnuProcessInternalEvent(uiNodeId_p,
(tEplNmtState)
(AmiGetByteFromLe
(&pStatusResponse_p->
m_le_bNmtStatus) |
EPL_NMT_TYPE_CS),
EPL_E_NO_ERROR,
kEplNmtMnuIntNodeEventStatusResponse);
}
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuStartBootStep1
//
// Description: starts BootStep1
//
// Parameters: (none)
//
// Returns: tEplKernel = error code
//
// State:
//
//---------------------------------------------------------------------------
static tEplKernel EplNmtMnuStartBootStep1(void)
{
tEplKernel Ret = kEplSuccessful;
unsigned int uiSubIndex;
unsigned int uiLocalNodeId;
u32 dwNodeCfg;
tEplObdSize ObdSize;
// $$$ d.k.: save current time for 0x1F89/2 MNTimeoutPreOp1_U32
// start network scan
EplNmtMnuInstance_g.m_uiMandatorySlaveCount = 0;
EplNmtMnuInstance_g.m_uiSignalSlaveCount = 0;
// check 0x1F81
uiLocalNodeId = EplObduGetNodeId();
for (uiSubIndex = 1; uiSubIndex <= 254; uiSubIndex++) {
ObdSize = 4;
Ret =
EplObduReadEntry(0x1F81, uiSubIndex, &dwNodeCfg, &ObdSize);
if (Ret != kEplSuccessful) {
goto Exit;
}
if (uiSubIndex != uiLocalNodeId) {
// reset flags "not scanned" and "isochronous"
EPL_NMTMNU_GET_NODEINFO(uiSubIndex)->m_wFlags &=
~(EPL_NMTMNU_NODE_FLAG_ISOCHRON |
EPL_NMTMNU_NODE_FLAG_NOT_SCANNED);
if (uiSubIndex == EPL_C_ADR_DIAG_DEF_NODE_ID) { // diagnostic node must be scanned by MN in any case
dwNodeCfg |=
(EPL_NODEASSIGN_NODE_IS_CN |
EPL_NODEASSIGN_NODE_EXISTS);
// and it must be isochronously accessed
dwNodeCfg &= ~EPL_NODEASSIGN_ASYNCONLY_NODE;
}
// save node config in local node info structure
EPL_NMTMNU_GET_NODEINFO(uiSubIndex)->m_dwNodeCfg =
dwNodeCfg;
EPL_NMTMNU_GET_NODEINFO(uiSubIndex)->m_NodeState =
kEplNmtMnuNodeStateUnknown;
if ((dwNodeCfg & (EPL_NODEASSIGN_NODE_IS_CN | EPL_NODEASSIGN_NODE_EXISTS)) != 0) { // node is configured as CN
// identify the node
Ret =
EplIdentuRequestIdentResponse(uiSubIndex,
EplNmtMnuCbIdentResponse);
if (Ret != kEplSuccessful) {
goto Exit;
}
// set flag "not scanned"
EPL_NMTMNU_GET_NODEINFO(uiSubIndex)->m_wFlags |=
EPL_NMTMNU_NODE_FLAG_NOT_SCANNED;
EplNmtMnuInstance_g.m_uiSignalSlaveCount++;
// signal slave counter shall be decremented if IdentRequest was sent once to a CN
if ((dwNodeCfg & EPL_NODEASSIGN_MANDATORY_CN) != 0) { // node is a mandatory CN
EplNmtMnuInstance_g.
m_uiMandatorySlaveCount++;
// mandatory slave counter shall be decremented if mandatory CN was configured successfully
}
}
} else { // subindex of MN
if ((dwNodeCfg & (EPL_NODEASSIGN_MN_PRES | EPL_NODEASSIGN_NODE_EXISTS)) != 0) { // MN shall send PRes
tEplDllNodeInfo DllNodeInfo;
EPL_MEMSET(&DllNodeInfo, 0,
sizeof(DllNodeInfo));
DllNodeInfo.m_uiNodeId = uiLocalNodeId;
Ret = EplDlluCalAddNode(&DllNodeInfo);
}
}
}
Exit:
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuStartBootStep2
//
// Description: starts BootStep2.
// That means add nodes to isochronous phase and send
// NMT EnableReadyToOp.
//
// Parameters: (none)
//
// Returns: tEplKernel = error code
//
// State:
//
//---------------------------------------------------------------------------
static tEplKernel EplNmtMnuStartBootStep2(void)
{
tEplKernel Ret = kEplSuccessful;
unsigned int uiIndex;
tEplNmtMnuNodeInfo *pNodeInfo;
if ((EplNmtMnuInstance_g.m_wFlags & EPL_NMTMNU_FLAG_HALTED) == 0) { // boot process is not halted
// add nodes to isochronous phase and send NMT EnableReadyToOp
EplNmtMnuInstance_g.m_uiMandatorySlaveCount = 0;
EplNmtMnuInstance_g.m_uiSignalSlaveCount = 0;
// reset flag that application was informed about possible state change
EplNmtMnuInstance_g.m_wFlags &= ~EPL_NMTMNU_FLAG_APP_INFORMED;
pNodeInfo = EplNmtMnuInstance_g.m_aNodeInfo;
for (uiIndex = 1;
uiIndex <= tabentries(EplNmtMnuInstance_g.m_aNodeInfo);
uiIndex++, pNodeInfo++) {
if (pNodeInfo->m_NodeState ==
kEplNmtMnuNodeStateConfigured) {
Ret =
EplNmtMnuNodeBootStep2(uiIndex, pNodeInfo);
if (Ret != kEplSuccessful) {
goto Exit;
}
// set flag "not scanned"
pNodeInfo->m_wFlags |=
EPL_NMTMNU_NODE_FLAG_NOT_SCANNED;
EplNmtMnuInstance_g.m_uiSignalSlaveCount++;
// signal slave counter shall be decremented if StatusRequest was sent once to a CN
if ((pNodeInfo->m_dwNodeCfg & EPL_NODEASSIGN_MANDATORY_CN) != 0) { // node is a mandatory CN
EplNmtMnuInstance_g.
m_uiMandatorySlaveCount++;
}
// mandatory slave counter shall be decremented if mandatory CN is ReadyToOp
}
}
}
Exit:
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuNodeBootStep2
//
// Description: starts BootStep2 for the specified node.
// This means the CN is added to isochronous phase if not
// async-only and it gets the NMT command EnableReadyToOp.
// The CN must be in node state Configured, when it enters
// BootStep2. When BootStep2 finishes, the CN is in node state
// ReadyToOp.
// If TimeoutReadyToOp in object 0x1F89/5 is configured,
// TimerHdlLonger will be started with this timeout.
//
// Parameters: uiNodeId_p = node ID
// pNodeInfo_p = pointer to internal node info structure
//
// Returns: tEplKernel = error code
//
// State:
//
//---------------------------------------------------------------------------
static tEplKernel EplNmtMnuNodeBootStep2(unsigned int uiNodeId_p,
tEplNmtMnuNodeInfo * pNodeInfo_p)
{
tEplKernel Ret = kEplSuccessful;
tEplDllNodeInfo DllNodeInfo;
u32 dwNodeCfg;
tEplObdSize ObdSize;
tEplTimerArg TimerArg;
dwNodeCfg = pNodeInfo_p->m_dwNodeCfg;
if ((dwNodeCfg & EPL_NODEASSIGN_ASYNCONLY_NODE) == 0) { // add node to isochronous phase
DllNodeInfo.m_uiNodeId = uiNodeId_p;
ObdSize = 4;
Ret =
EplObduReadEntry(0x1F92, uiNodeId_p,
&DllNodeInfo.m_dwPresTimeout, &ObdSize);
if (Ret != kEplSuccessful) {
goto Exit;
}
ObdSize = 2;
Ret =
EplObduReadEntry(0x1F8B, uiNodeId_p,
&DllNodeInfo.m_wPreqPayloadLimit,
&ObdSize);
if (Ret != kEplSuccessful) {
goto Exit;
}
ObdSize = 2;
Ret =
EplObduReadEntry(0x1F8D, uiNodeId_p,
&DllNodeInfo.m_wPresPayloadLimit,
&ObdSize);
if (Ret != kEplSuccessful) {
goto Exit;
}
pNodeInfo_p->m_wFlags |= EPL_NMTMNU_NODE_FLAG_ISOCHRON;
Ret = EplDlluCalAddNode(&DllNodeInfo);
if (Ret != kEplSuccessful) {
goto Exit;
}
}
EPL_NMTMNU_DBG_POST_TRACE_VALUE(0,
uiNodeId_p,
kEplNmtCmdEnableReadyToOperate);
Ret =
EplNmtMnuSendNmtCommand(uiNodeId_p, kEplNmtCmdEnableReadyToOperate);
if (Ret != kEplSuccessful) {
goto Exit;
}
if (EplNmtMnuInstance_g.m_ulTimeoutReadyToOp != 0L) { // start timer
// when the timer expires the CN must be ReadyToOp
EPL_NMTMNU_SET_FLAGS_TIMERARG_LONGER(pNodeInfo_p, uiNodeId_p,
TimerArg);
// TimerArg.m_EventSink = kEplEventSinkNmtMnu;
// TimerArg.m_ulArg = EPL_NMTMNU_TIMERARG_LONGER | uiNodeId_p;
Ret =
EplTimeruModifyTimerMs(&pNodeInfo_p->m_TimerHdlLonger,
EplNmtMnuInstance_g.
m_ulTimeoutReadyToOp, TimerArg);
}
Exit:
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuStartCheckCom
//
// Description: starts CheckCommunication
//
// Parameters: (none)
//
// Returns: tEplKernel = error code
//
// State:
//
//---------------------------------------------------------------------------
static tEplKernel EplNmtMnuStartCheckCom(void)
{
tEplKernel Ret = kEplSuccessful;
unsigned int uiIndex;
tEplNmtMnuNodeInfo *pNodeInfo;
if ((EplNmtMnuInstance_g.m_wFlags & EPL_NMTMNU_FLAG_HALTED) == 0) { // boot process is not halted
// wait some time and check that no communication error occurs
EplNmtMnuInstance_g.m_uiMandatorySlaveCount = 0;
EplNmtMnuInstance_g.m_uiSignalSlaveCount = 0;
// reset flag that application was informed about possible state change
EplNmtMnuInstance_g.m_wFlags &= ~EPL_NMTMNU_FLAG_APP_INFORMED;
pNodeInfo = EplNmtMnuInstance_g.m_aNodeInfo;
for (uiIndex = 1;
uiIndex <= tabentries(EplNmtMnuInstance_g.m_aNodeInfo);
uiIndex++, pNodeInfo++) {
if (pNodeInfo->m_NodeState ==
kEplNmtMnuNodeStateReadyToOp) {
Ret = EplNmtMnuNodeCheckCom(uiIndex, pNodeInfo);
if (Ret == kEplReject) { // timer was started
// wait until it expires
if ((pNodeInfo->m_dwNodeCfg & EPL_NODEASSIGN_MANDATORY_CN) != 0) { // node is a mandatory CN
EplNmtMnuInstance_g.
m_uiMandatorySlaveCount++;
}
} else if (Ret != kEplSuccessful) {
goto Exit;
}
// set flag "not scanned"
pNodeInfo->m_wFlags |=
EPL_NMTMNU_NODE_FLAG_NOT_SCANNED;
EplNmtMnuInstance_g.m_uiSignalSlaveCount++;
// signal slave counter shall be decremented if timeout elapsed and regardless of an error
// mandatory slave counter shall be decremented if timeout elapsed and no error occured
}
}
}
Ret = kEplSuccessful;
Exit:
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuNodeCheckCom
//
// Description: checks communication of the specified node.
// That means wait some time and if no error occured everything
// is OK.
//
// Parameters: uiNodeId_p = node ID
// pNodeInfo_p = pointer to internal node info structure
//
// Returns: tEplKernel = error code
//
// State:
//
//---------------------------------------------------------------------------
static tEplKernel EplNmtMnuNodeCheckCom(unsigned int uiNodeId_p,
tEplNmtMnuNodeInfo * pNodeInfo_p)
{
tEplKernel Ret = kEplSuccessful;
u32 dwNodeCfg;
tEplTimerArg TimerArg;
dwNodeCfg = pNodeInfo_p->m_dwNodeCfg;
if (((dwNodeCfg & EPL_NODEASSIGN_ASYNCONLY_NODE) == 0)
&& (EplNmtMnuInstance_g.m_ulTimeoutCheckCom != 0L)) { // CN is not async-only and timeout for CheckCom was set
// check communication,
// that means wait some time and if no error occured everything is OK;
// start timer (when the timer expires the CN must be still ReadyToOp)
EPL_NMTMNU_SET_FLAGS_TIMERARG_LONGER(pNodeInfo_p, uiNodeId_p,
TimerArg);
// TimerArg.m_EventSink = kEplEventSinkNmtMnu;
// TimerArg.m_ulArg = EPL_NMTMNU_TIMERARG_LONGER | uiNodeId_p;
Ret =
EplTimeruModifyTimerMs(&pNodeInfo_p->m_TimerHdlLonger,
EplNmtMnuInstance_g.
m_ulTimeoutCheckCom, TimerArg);
// update mandatory slave counter, because timer was started
if (Ret == kEplSuccessful) {
Ret = kEplReject;
}
} else { // timer was not started
// assume everything is OK
pNodeInfo_p->m_NodeState = kEplNmtMnuNodeStateComChecked;
}
//Exit:
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuStartNodes
//
// Description: really starts all nodes which are ReadyToOp and CheckCom did not fail
//
// Parameters: (none)
//
// Returns: tEplKernel = error code
//
// State:
//
//---------------------------------------------------------------------------
static tEplKernel EplNmtMnuStartNodes(void)
{
tEplKernel Ret = kEplSuccessful;
unsigned int uiIndex;
tEplNmtMnuNodeInfo *pNodeInfo;
if ((EplNmtMnuInstance_g.m_wFlags & EPL_NMTMNU_FLAG_HALTED) == 0) { // boot process is not halted
// send NMT command Start Node
EplNmtMnuInstance_g.m_uiMandatorySlaveCount = 0;
EplNmtMnuInstance_g.m_uiSignalSlaveCount = 0;
// reset flag that application was informed about possible state change
EplNmtMnuInstance_g.m_wFlags &= ~EPL_NMTMNU_FLAG_APP_INFORMED;
pNodeInfo = EplNmtMnuInstance_g.m_aNodeInfo;
for (uiIndex = 1;
uiIndex <= tabentries(EplNmtMnuInstance_g.m_aNodeInfo);
uiIndex++, pNodeInfo++) {
if (pNodeInfo->m_NodeState ==
kEplNmtMnuNodeStateComChecked) {
if ((EplNmtMnuInstance_g.
m_dwNmtStartup & EPL_NMTST_STARTALLNODES)
== 0) {
EPL_NMTMNU_DBG_POST_TRACE_VALUE(0,
uiIndex,
kEplNmtCmdStartNode);
Ret =
EplNmtMnuSendNmtCommand(uiIndex,
kEplNmtCmdStartNode);
if (Ret != kEplSuccessful) {
goto Exit;
}
}
if ((pNodeInfo->m_dwNodeCfg & EPL_NODEASSIGN_MANDATORY_CN) != 0) { // node is a mandatory CN
EplNmtMnuInstance_g.
m_uiMandatorySlaveCount++;
}
// set flag "not scanned"
pNodeInfo->m_wFlags |=
EPL_NMTMNU_NODE_FLAG_NOT_SCANNED;
EplNmtMnuInstance_g.m_uiSignalSlaveCount++;
// signal slave counter shall be decremented if StatusRequest was sent once to a CN
// mandatory slave counter shall be decremented if mandatory CN is OPERATIONAL
}
}
// $$$ inform application if EPL_NMTST_NO_STARTNODE is set
if ((EplNmtMnuInstance_g.
m_dwNmtStartup & EPL_NMTST_STARTALLNODES) != 0) {
EPL_NMTMNU_DBG_POST_TRACE_VALUE(0, EPL_C_ADR_BROADCAST,
kEplNmtCmdStartNode);
Ret =
EplNmtMnuSendNmtCommand(EPL_C_ADR_BROADCAST,
kEplNmtCmdStartNode);
if (Ret != kEplSuccessful) {
goto Exit;
}
}
}
Exit:
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuProcessInternalEvent
//
// Description: processes internal node events
//
// Parameters: uiNodeId_p = node ID
// NodeNmtState_p = NMT state of CN
// NodeEvent_p = occured events
//
// Returns: tEplKernel = error code
//
//
// State:
//
//---------------------------------------------------------------------------
static tEplKernel EplNmtMnuProcessInternalEvent(unsigned int uiNodeId_p,
tEplNmtState NodeNmtState_p,
u16 wErrorCode_p,
tEplNmtMnuIntNodeEvent
NodeEvent_p)
{
tEplKernel Ret = kEplSuccessful;
tEplNmtState NmtState;
tEplNmtMnuNodeInfo *pNodeInfo;
tEplTimerArg TimerArg;
pNodeInfo = EPL_NMTMNU_GET_NODEINFO(uiNodeId_p);
NmtState = EplNmtuGetNmtState();
if (NmtState <= kEplNmtMsNotActive) { // MN is not active
goto Exit;
}
switch (NodeEvent_p) {
case kEplNmtMnuIntNodeEventIdentResponse:
{
u8 bNmtState;
EPL_NMTMNU_DBG_POST_TRACE_VALUE(NodeEvent_p,
uiNodeId_p,
pNodeInfo->m_NodeState);
if (pNodeInfo->m_NodeState !=
kEplNmtMnuNodeStateResetConf) {
pNodeInfo->m_NodeState =
kEplNmtMnuNodeStateIdentified;
}
// reset flags ISOCHRON and NMT_CMD_ISSUED
pNodeInfo->m_wFlags &= ~(EPL_NMTMNU_NODE_FLAG_ISOCHRON
|
EPL_NMTMNU_NODE_FLAG_NMT_CMD_ISSUED);
if ((NmtState == kEplNmtMsPreOperational1)
&&
((pNodeInfo->
m_wFlags & EPL_NMTMNU_NODE_FLAG_NOT_SCANNED) !=
0)) {
// decrement only signal slave count
EplNmtMnuInstance_g.m_uiSignalSlaveCount--;
pNodeInfo->m_wFlags &=
~EPL_NMTMNU_NODE_FLAG_NOT_SCANNED;
}
// update object 0x1F8F NMT_MNNodeExpState_AU8 to PreOp1 (even if local state >= PreOp2)
bNmtState = (u8) (kEplNmtCsPreOperational1 & 0xFF);
Ret =
EplObduWriteEntry(0x1F8F, uiNodeId_p, &bNmtState,
1);
// check NMT state of CN
Ret =
EplNmtMnuCheckNmtState(uiNodeId_p, pNodeInfo,
NodeNmtState_p, wErrorCode_p,
NmtState);
if (Ret != kEplSuccessful) {
if (Ret == kEplReject) {
Ret = kEplSuccessful;
}
break;
}
// request StatusResponse immediately,
// because we want a fast boot-up of CNs
Ret =
EplStatusuRequestStatusResponse(uiNodeId_p,
EplNmtMnuCbStatusResponse);
if (Ret != kEplSuccessful) {
EPL_NMTMNU_DBG_POST_TRACE_VALUE(NodeEvent_p,
uiNodeId_p,
Ret);
if (Ret == kEplInvalidOperation) { // the only situation when this should happen is, when
// StatusResponse was already requested from within
// the StatReq timer event.
// so ignore this error.
Ret = kEplSuccessful;
} else {
break;
}
}
if (pNodeInfo->m_NodeState !=
kEplNmtMnuNodeStateResetConf) {
// inform application
Ret =
EplNmtMnuInstance_g.
m_pfnCbNodeEvent(uiNodeId_p,
kEplNmtNodeEventFound,
NodeNmtState_p,
EPL_E_NO_ERROR,
(pNodeInfo->
m_dwNodeCfg &
EPL_NODEASSIGN_MANDATORY_CN)
!= 0);
if (Ret == kEplReject) { // interrupt boot process on user request
EPL_NMTMNU_DBG_POST_TRACE_VALUE
(NodeEvent_p, uiNodeId_p,
((pNodeInfo->m_NodeState << 8)
| Ret));
Ret = kEplSuccessful;
break;
} else if (Ret != kEplSuccessful) {
EPL_NMTMNU_DBG_POST_TRACE_VALUE
(NodeEvent_p, uiNodeId_p,
((pNodeInfo->m_NodeState << 8)
| Ret));
break;
}
}
// continue BootStep1
}
case kEplNmtMnuIntNodeEventBoot:
{
// $$$ check identification (vendor ID, product code, revision no, serial no)
if (pNodeInfo->m_NodeState ==
kEplNmtMnuNodeStateIdentified) {
// $$$ check software
// check/start configuration
// inform application
Ret =
EplNmtMnuInstance_g.
m_pfnCbNodeEvent(uiNodeId_p,
kEplNmtNodeEventCheckConf,
NodeNmtState_p,
EPL_E_NO_ERROR,
(pNodeInfo->
m_dwNodeCfg &
EPL_NODEASSIGN_MANDATORY_CN)
!= 0);
if (Ret == kEplReject) { // interrupt boot process on user request
EPL_NMTMNU_DBG_POST_TRACE_VALUE
(kEplNmtMnuIntNodeEventBoot,
uiNodeId_p,
((pNodeInfo->m_NodeState << 8)
| Ret));
Ret = kEplSuccessful;
break;
} else if (Ret != kEplSuccessful) {
EPL_NMTMNU_DBG_POST_TRACE_VALUE
(kEplNmtMnuIntNodeEventBoot,
uiNodeId_p,
((pNodeInfo->m_NodeState << 8)
| Ret));
break;
}
} else if (pNodeInfo->m_NodeState != kEplNmtMnuNodeStateResetConf) { // wrong CN state
// ignore event
break;
}
// $$$ d.k.: currently we assume configuration is OK
// continue BootStep1
}
case kEplNmtMnuIntNodeEventConfigured:
{
if ((pNodeInfo->m_NodeState !=
kEplNmtMnuNodeStateIdentified)
&& (pNodeInfo->m_NodeState != kEplNmtMnuNodeStateResetConf)) { // wrong CN state
// ignore event
break;
}
pNodeInfo->m_NodeState = kEplNmtMnuNodeStateConfigured;
if (NmtState == kEplNmtMsPreOperational1) {
if ((pNodeInfo->m_dwNodeCfg & EPL_NODEASSIGN_MANDATORY_CN) != 0) { // decrement mandatory CN counter
EplNmtMnuInstance_g.
m_uiMandatorySlaveCount--;
}
} else {
// put optional node to next step (BootStep2)
Ret =
EplNmtMnuNodeBootStep2(uiNodeId_p,
pNodeInfo);
}
break;
}
case kEplNmtMnuIntNodeEventNoIdentResponse:
{
if ((NmtState == kEplNmtMsPreOperational1)
&&
((pNodeInfo->
m_wFlags & EPL_NMTMNU_NODE_FLAG_NOT_SCANNED) !=
0)) {
// decrement only signal slave count
EplNmtMnuInstance_g.m_uiSignalSlaveCount--;
pNodeInfo->m_wFlags &=
~EPL_NMTMNU_NODE_FLAG_NOT_SCANNED;
}
if (pNodeInfo->m_NodeState !=
kEplNmtMnuNodeStateResetConf) {
pNodeInfo->m_NodeState =
kEplNmtMnuNodeStateUnknown;
}
// $$$ d.k. check start time for 0x1F89/2 MNTimeoutPreOp1_U32
// $$$ d.k. check individual timeout 0x1F89/6 MNIdentificationTimeout_U32
// if mandatory node and timeout elapsed -> halt boot procedure
// trigger IdentRequest again (if >= PreOp2, after delay)
if (NmtState >= kEplNmtMsPreOperational2) { // start timer
EPL_NMTMNU_SET_FLAGS_TIMERARG_IDENTREQ
(pNodeInfo, uiNodeId_p, TimerArg);
// TimerArg.m_EventSink = kEplEventSinkNmtMnu;
// TimerArg.m_ulArg = EPL_NMTMNU_TIMERARG_IDENTREQ | uiNodeId_p;
/*
EPL_NMTMNU_DBG_POST_TRACE_VALUE(kEplNmtMnuIntNodeEventNoIdentResponse,
uiNodeId_p,
((pNodeInfo->m_NodeState << 8)
| 0x80
| ((pNodeInfo->m_wFlags & EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ) >> 6)
| ((TimerArg.m_ulArg & EPL_NMTMNU_TIMERARG_COUNT_SR) >> 8)));
*/
Ret =
EplTimeruModifyTimerMs(&pNodeInfo->
m_TimerHdlStatReq,
EplNmtMnuInstance_g.
m_ulStatusRequestDelay,
TimerArg);
} else { // trigger IdentRequest immediately
Ret =
EplIdentuRequestIdentResponse(uiNodeId_p,
EplNmtMnuCbIdentResponse);
}
break;
}
case kEplNmtMnuIntNodeEventStatusResponse:
{
if ((NmtState >= kEplNmtMsPreOperational2)
&&
((pNodeInfo->
m_wFlags & EPL_NMTMNU_NODE_FLAG_NOT_SCANNED) !=
0)) {
// decrement only signal slave count if checked once for ReadyToOp, CheckCom, Operational
EplNmtMnuInstance_g.m_uiSignalSlaveCount--;
pNodeInfo->m_wFlags &=
~EPL_NMTMNU_NODE_FLAG_NOT_SCANNED;
}
// check NMT state of CN
Ret =
EplNmtMnuCheckNmtState(uiNodeId_p, pNodeInfo,
NodeNmtState_p, wErrorCode_p,
NmtState);
if (Ret != kEplSuccessful) {
if (Ret == kEplReject) {
Ret = kEplSuccessful;
}
break;
}
if (NmtState == kEplNmtMsPreOperational1) {
// request next StatusResponse immediately
Ret =
EplStatusuRequestStatusResponse(uiNodeId_p,
EplNmtMnuCbStatusResponse);
if (Ret != kEplSuccessful) {
EPL_NMTMNU_DBG_POST_TRACE_VALUE
(NodeEvent_p, uiNodeId_p, Ret);
}
} else if ((pNodeInfo->m_wFlags & EPL_NMTMNU_NODE_FLAG_ISOCHRON) == 0) { // start timer
// not isochronously accessed CN (e.g. async-only or stopped CN)
EPL_NMTMNU_SET_FLAGS_TIMERARG_STATREQ(pNodeInfo,
uiNodeId_p,
TimerArg);
// TimerArg.m_EventSink = kEplEventSinkNmtMnu;
// TimerArg.m_ulArg = EPL_NMTMNU_TIMERARG_STATREQ | uiNodeId_p;
/*
EPL_NMTMNU_DBG_POST_TRACE_VALUE(kEplNmtMnuIntNodeEventStatusResponse,
uiNodeId_p,
((pNodeInfo->m_NodeState << 8)
| 0x80
| ((pNodeInfo->m_wFlags & EPL_NMTMNU_NODE_FLAG_COUNT_STATREQ) >> 6)
| ((TimerArg.m_ulArg & EPL_NMTMNU_TIMERARG_COUNT_SR) >> 8)));
*/
Ret =
EplTimeruModifyTimerMs(&pNodeInfo->
m_TimerHdlStatReq,
EplNmtMnuInstance_g.
m_ulStatusRequestDelay,
TimerArg);
}
break;
}
case kEplNmtMnuIntNodeEventNoStatusResponse:
{
// function CheckNmtState sets node state to unknown if necessary
/*
if ((NmtState >= kEplNmtMsPreOperational2)
&& ((pNodeInfo->m_wFlags & EPL_NMTMNU_NODE_FLAG_NOT_SCANNED) != 0))
{
// decrement only signal slave count if checked once for ReadyToOp, CheckCom, Operational
EplNmtMnuInstance_g.m_uiSignalSlaveCount--;
pNodeInfo->m_wFlags &= ~EPL_NMTMNU_NODE_FLAG_NOT_SCANNED;
}
*/
// check NMT state of CN
Ret =
EplNmtMnuCheckNmtState(uiNodeId_p, pNodeInfo,
NodeNmtState_p, wErrorCode_p,
NmtState);
if (Ret != kEplSuccessful) {
if (Ret == kEplReject) {
Ret = kEplSuccessful;
}
break;
}
break;
}
case kEplNmtMnuIntNodeEventError:
{ // currently only issued on kEplNmtNodeCommandConfErr
if (pNodeInfo->m_NodeState != kEplNmtMnuNodeStateIdentified) { // wrong CN state
// ignore event
break;
}
// check NMT state of CN
Ret =
EplNmtMnuCheckNmtState(uiNodeId_p, pNodeInfo,
kEplNmtCsNotActive,
wErrorCode_p, NmtState);
if (Ret != kEplSuccessful) {
if (Ret == kEplReject) {
Ret = kEplSuccessful;
}
break;
}
break;
}
case kEplNmtMnuIntNodeEventExecReset:
{
if (pNodeInfo->m_NodeState != kEplNmtMnuNodeStateIdentified) { // wrong CN state
// ignore event
break;
}
pNodeInfo->m_NodeState = kEplNmtMnuNodeStateResetConf;
EPL_NMTMNU_DBG_POST_TRACE_VALUE(NodeEvent_p,
uiNodeId_p,
(((NodeNmtState_p &
0xFF) << 8)
|
kEplNmtCmdResetConfiguration));
// send NMT reset configuration to CN for activation of configuration
Ret =
EplNmtMnuSendNmtCommand(uiNodeId_p,
kEplNmtCmdResetConfiguration);
break;
}
case kEplNmtMnuIntNodeEventHeartbeat:
{
/*
if ((NmtState >= kEplNmtMsPreOperational2)
&& ((pNodeInfo->m_wFlags & EPL_NMTMNU_NODE_FLAG_NOT_SCANNED) != 0))
{
// decrement only signal slave count if checked once for ReadyToOp, CheckCom, Operational
EplNmtMnuInstance_g.m_uiSignalSlaveCount--;
pNodeInfo->m_wFlags &= ~EPL_NMTMNU_NODE_FLAG_NOT_SCANNED;
}
*/
// check NMT state of CN
Ret =
EplNmtMnuCheckNmtState(uiNodeId_p, pNodeInfo,
NodeNmtState_p, wErrorCode_p,
NmtState);
if (Ret != kEplSuccessful) {
if (Ret == kEplReject) {
Ret = kEplSuccessful;
}
break;
}
break;
}
case kEplNmtMnuIntNodeEventTimerIdentReq:
{
EPL_DBGLVL_NMTMN_TRACE1
("TimerStatReq->IdentReq(%02X)\n", uiNodeId_p);
// trigger IdentRequest again
Ret =
EplIdentuRequestIdentResponse(uiNodeId_p,
EplNmtMnuCbIdentResponse);
if (Ret != kEplSuccessful) {
EPL_NMTMNU_DBG_POST_TRACE_VALUE(NodeEvent_p,
uiNodeId_p,
(((NodeNmtState_p & 0xFF) << 8)
| Ret));
if (Ret == kEplInvalidOperation) { // this can happen because of a bug in EplTimeruLinuxKernel.c
// so ignore this error.
Ret = kEplSuccessful;
}
}
break;
}
case kEplNmtMnuIntNodeEventTimerStateMon:
{
// reset NMT state change flag
// because from now on the CN must have the correct NMT state
pNodeInfo->m_wFlags &=
~EPL_NMTMNU_NODE_FLAG_NMT_CMD_ISSUED;
// continue with normal StatReq processing
}
case kEplNmtMnuIntNodeEventTimerStatReq:
{
EPL_DBGLVL_NMTMN_TRACE1("TimerStatReq->StatReq(%02X)\n",
uiNodeId_p);
// request next StatusResponse
Ret =
EplStatusuRequestStatusResponse(uiNodeId_p,
EplNmtMnuCbStatusResponse);
if (Ret != kEplSuccessful) {
EPL_NMTMNU_DBG_POST_TRACE_VALUE(NodeEvent_p,
uiNodeId_p,
(((NodeNmtState_p & 0xFF) << 8)
| Ret));
if (Ret == kEplInvalidOperation) { // the only situation when this should happen is, when
// StatusResponse was already requested while processing
// event IdentResponse.
// so ignore this error.
Ret = kEplSuccessful;
}
}
break;
}
case kEplNmtMnuIntNodeEventTimerLonger:
{
switch (pNodeInfo->m_NodeState) {
case kEplNmtMnuNodeStateConfigured:
{ // node should be ReadyToOp but it is not
// check NMT state which shall be intentionally wrong, so that ERROR_TREATMENT will be started
Ret =
EplNmtMnuCheckNmtState(uiNodeId_p,
pNodeInfo,
kEplNmtCsNotActive,
EPL_E_NMT_BPO2,
NmtState);
if (Ret != kEplSuccessful) {
if (Ret == kEplReject) {
Ret = kEplSuccessful;
}
break;
}
break;
}
case kEplNmtMnuNodeStateReadyToOp:
{ // CheckCom finished successfully
pNodeInfo->m_NodeState =
kEplNmtMnuNodeStateComChecked;
if ((pNodeInfo->
m_wFlags &
EPL_NMTMNU_NODE_FLAG_NOT_SCANNED)
!= 0) {
// decrement only signal slave count if checked once for ReadyToOp, CheckCom, Operational
EplNmtMnuInstance_g.
m_uiSignalSlaveCount--;
pNodeInfo->m_wFlags &=
~EPL_NMTMNU_NODE_FLAG_NOT_SCANNED;
}
if ((pNodeInfo->
m_dwNodeCfg &
EPL_NODEASSIGN_MANDATORY_CN) !=
0) {
// decrement mandatory slave counter
EplNmtMnuInstance_g.
m_uiMandatorySlaveCount--;
}
if (NmtState != kEplNmtMsReadyToOperate) {
EPL_NMTMNU_DBG_POST_TRACE_VALUE
(NodeEvent_p, uiNodeId_p,
(((NodeNmtState_p & 0xFF)
<< 8)
| kEplNmtCmdStartNode));
// start optional CN
Ret =
EplNmtMnuSendNmtCommand
(uiNodeId_p,
kEplNmtCmdStartNode);
}
break;
}
default:
{
break;
}
}
break;
}
case kEplNmtMnuIntNodeEventNmtCmdSent:
{
u8 bNmtState;
// update expected NMT state with the one that results
// from the sent NMT command
bNmtState = (u8) (NodeNmtState_p & 0xFF);
// write object 0x1F8F NMT_MNNodeExpState_AU8
Ret =
EplObduWriteEntry(0x1F8F, uiNodeId_p, &bNmtState,
1);
if (Ret != kEplSuccessful) {
goto Exit;
}
if (NodeNmtState_p == kEplNmtCsNotActive) { // restart processing with IdentRequest
EPL_NMTMNU_SET_FLAGS_TIMERARG_IDENTREQ
(pNodeInfo, uiNodeId_p, TimerArg);
} else { // monitor NMT state change with StatusRequest after
// the corresponding delay;
// until then wrong NMT states will be ignored
EPL_NMTMNU_SET_FLAGS_TIMERARG_STATE_MON
(pNodeInfo, uiNodeId_p, TimerArg);
// set NMT state change flag
pNodeInfo->m_wFlags |=
EPL_NMTMNU_NODE_FLAG_NMT_CMD_ISSUED;
}
Ret =
EplTimeruModifyTimerMs(&pNodeInfo->
m_TimerHdlStatReq,
EplNmtMnuInstance_g.
m_ulStatusRequestDelay,
TimerArg);
// finish processing, because NmtState_p is the expected and not the current state
goto Exit;
}
default:
{
break;
}
}
// check if network is ready to change local NMT state and this was not done before
if ((EplNmtMnuInstance_g.m_wFlags & (EPL_NMTMNU_FLAG_HALTED | EPL_NMTMNU_FLAG_APP_INFORMED)) == 0) { // boot process is not halted
switch (NmtState) {
case kEplNmtMsPreOperational1:
{
if ((EplNmtMnuInstance_g.m_uiSignalSlaveCount ==
0)
&& (EplNmtMnuInstance_g.m_uiMandatorySlaveCount == 0)) { // all optional CNs scanned once and all mandatory CNs configured successfully
EplNmtMnuInstance_g.m_wFlags |=
EPL_NMTMNU_FLAG_APP_INFORMED;
// inform application
Ret =
EplNmtMnuInstance_g.
m_pfnCbBootEvent
(kEplNmtBootEventBootStep1Finish,
NmtState, EPL_E_NO_ERROR);
if (Ret != kEplSuccessful) {
if (Ret == kEplReject) {
// wait for application
Ret = kEplSuccessful;
}
break;
}
// enter PreOp2
Ret =
EplNmtuNmtEvent
(kEplNmtEventAllMandatoryCNIdent);
}
break;
}
case kEplNmtMsPreOperational2:
{
if ((EplNmtMnuInstance_g.m_uiSignalSlaveCount ==
0)
&& (EplNmtMnuInstance_g.m_uiMandatorySlaveCount == 0)) { // all optional CNs checked once for ReadyToOp and all mandatory CNs are ReadyToOp
EplNmtMnuInstance_g.m_wFlags |=
EPL_NMTMNU_FLAG_APP_INFORMED;
// inform application
Ret =
EplNmtMnuInstance_g.
m_pfnCbBootEvent
(kEplNmtBootEventBootStep2Finish,
NmtState, EPL_E_NO_ERROR);
if (Ret != kEplSuccessful) {
if (Ret == kEplReject) {
// wait for application
Ret = kEplSuccessful;
}
break;
}
// enter ReadyToOp
Ret =
EplNmtuNmtEvent
(kEplNmtEventEnterReadyToOperate);
}
break;
}
case kEplNmtMsReadyToOperate:
{
if ((EplNmtMnuInstance_g.m_uiSignalSlaveCount ==
0)
&& (EplNmtMnuInstance_g.m_uiMandatorySlaveCount == 0)) { // all CNs checked for errorless communication
EplNmtMnuInstance_g.m_wFlags |=
EPL_NMTMNU_FLAG_APP_INFORMED;
// inform application
Ret =
EplNmtMnuInstance_g.
m_pfnCbBootEvent
(kEplNmtBootEventCheckComFinish,
NmtState, EPL_E_NO_ERROR);
if (Ret != kEplSuccessful) {
if (Ret == kEplReject) {
// wait for application
Ret = kEplSuccessful;
}
break;
}
// enter Operational
Ret =
EplNmtuNmtEvent
(kEplNmtEventEnterMsOperational);
}
break;
}
case kEplNmtMsOperational:
{
if ((EplNmtMnuInstance_g.m_uiSignalSlaveCount ==
0)
&& (EplNmtMnuInstance_g.m_uiMandatorySlaveCount == 0)) { // all optional CNs scanned once and all mandatory CNs are OPERATIONAL
EplNmtMnuInstance_g.m_wFlags |=
EPL_NMTMNU_FLAG_APP_INFORMED;
// inform application
Ret =
EplNmtMnuInstance_g.
m_pfnCbBootEvent
(kEplNmtBootEventOperational,
NmtState, EPL_E_NO_ERROR);
if (Ret != kEplSuccessful) {
if (Ret == kEplReject) {
// ignore error code
Ret = kEplSuccessful;
}
break;
}
}
break;
}
default:
{
break;
}
}
}
Exit:
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuCheckNmtState
//
// Description: checks the NMT state, i.e. evaluates it with object 0x1F8F
// NMT_MNNodeExpState_AU8 and updates object 0x1F8E
// NMT_MNNodeCurrState_AU8.
// It manipulates m_NodeState in internal node info structure.
//
// Parameters: uiNodeId_p = node ID
// NodeNmtState_p = NMT state of CN
//
// Returns: tEplKernel = error code
// kEplReject = CN was in wrong state and has been reset
//
// State:
//
//---------------------------------------------------------------------------
static tEplKernel EplNmtMnuCheckNmtState(unsigned int uiNodeId_p,
tEplNmtMnuNodeInfo * pNodeInfo_p,
tEplNmtState NodeNmtState_p,
u16 wErrorCode_p,
tEplNmtState LocalNmtState_p)
{
tEplKernel Ret = kEplSuccessful;
tEplObdSize ObdSize;
u8 bNmtState;
u8 bNmtStatePrev;
tEplNmtState ExpNmtState;
ObdSize = 1;
// read object 0x1F8F NMT_MNNodeExpState_AU8
Ret = EplObduReadEntry(0x1F8F, uiNodeId_p, &bNmtState, &ObdSize);
if (Ret != kEplSuccessful) {
goto Exit;
}
// compute expected NMT state
ExpNmtState = (tEplNmtState) (bNmtState | EPL_NMT_TYPE_CS);
// compute u8 of current NMT state
bNmtState = ((u8) NodeNmtState_p & 0xFF);
if (ExpNmtState == kEplNmtCsNotActive) { // ignore the current state, because the CN shall be not active
Ret = kEplReject;
goto Exit;
} else if ((ExpNmtState == kEplNmtCsPreOperational2)
&& (NodeNmtState_p == kEplNmtCsReadyToOperate)) { // CN switched to ReadyToOp
// delete timer for timeout handling
Ret = EplTimeruDeleteTimer(&pNodeInfo_p->m_TimerHdlLonger);
if (Ret != kEplSuccessful) {
goto Exit;
}
pNodeInfo_p->m_NodeState = kEplNmtMnuNodeStateReadyToOp;
// update object 0x1F8F NMT_MNNodeExpState_AU8 to ReadyToOp
Ret = EplObduWriteEntry(0x1F8F, uiNodeId_p, &bNmtState, 1);
if (Ret != kEplSuccessful) {
goto Exit;
}
if ((pNodeInfo_p->m_dwNodeCfg & EPL_NODEASSIGN_MANDATORY_CN) != 0) { // node is a mandatory CN -> decrement counter
EplNmtMnuInstance_g.m_uiMandatorySlaveCount--;
}
if (LocalNmtState_p >= kEplNmtMsReadyToOperate) { // start procedure CheckCommunication for this node
Ret = EplNmtMnuNodeCheckCom(uiNodeId_p, pNodeInfo_p);
if (Ret != kEplSuccessful) {
goto Exit;
}
if ((LocalNmtState_p == kEplNmtMsOperational)
&& (pNodeInfo_p->m_NodeState ==
kEplNmtMnuNodeStateComChecked)) {
EPL_NMTMNU_DBG_POST_TRACE_VALUE(0, uiNodeId_p,
(((NodeNmtState_p & 0xFF) << 8)
|
kEplNmtCmdStartNode));
// immediately start optional CN, because communication is always OK (e.g. async-only CN)
Ret =
EplNmtMnuSendNmtCommand(uiNodeId_p,
kEplNmtCmdStartNode);
if (Ret != kEplSuccessful) {
goto Exit;
}
}
}
} else if ((ExpNmtState == kEplNmtCsReadyToOperate)
&& (NodeNmtState_p == kEplNmtCsOperational)) { // CN switched to OPERATIONAL
pNodeInfo_p->m_NodeState = kEplNmtMnuNodeStateOperational;
if ((pNodeInfo_p->m_dwNodeCfg & EPL_NODEASSIGN_MANDATORY_CN) != 0) { // node is a mandatory CN -> decrement counter
EplNmtMnuInstance_g.m_uiMandatorySlaveCount--;
}
} else if ((ExpNmtState != NodeNmtState_p)
&& !((ExpNmtState == kEplNmtCsPreOperational1)
&& (NodeNmtState_p == kEplNmtCsPreOperational2))) { // CN is not in expected NMT state (without the exceptions above)
u16 wbeErrorCode;
if ((pNodeInfo_p->
m_wFlags & EPL_NMTMNU_NODE_FLAG_NOT_SCANNED) != 0) {
// decrement only signal slave count if checked once
EplNmtMnuInstance_g.m_uiSignalSlaveCount--;
pNodeInfo_p->m_wFlags &=
~EPL_NMTMNU_NODE_FLAG_NOT_SCANNED;
}
if (pNodeInfo_p->m_NodeState == kEplNmtMnuNodeStateUnknown) { // CN is already in state unknown, which means that it got
// NMT reset command earlier
goto Exit;
}
// -> CN is in wrong NMT state
pNodeInfo_p->m_NodeState = kEplNmtMnuNodeStateUnknown;
if (wErrorCode_p == 0) { // assume wrong NMT state error
if ((pNodeInfo_p->m_wFlags & EPL_NMTMNU_NODE_FLAG_NMT_CMD_ISSUED) != 0) { // NMT command has been just issued;
// ignore wrong NMT state until timer expires;
// other errors like LOSS_PRES_TH are still processed
goto Exit;
}
wErrorCode_p = EPL_E_NMT_WRONG_STATE;
}
BENCHMARK_MOD_07_TOGGLE(9);
// $$$ start ERROR_TREATMENT and inform application
Ret = EplNmtMnuInstance_g.m_pfnCbNodeEvent(uiNodeId_p,
kEplNmtNodeEventError,
NodeNmtState_p,
wErrorCode_p,
(pNodeInfo_p->
m_dwNodeCfg &
EPL_NODEASSIGN_MANDATORY_CN)
!= 0);
if (Ret != kEplSuccessful) {
goto Exit;
}
EPL_NMTMNU_DBG_POST_TRACE_VALUE(0,
uiNodeId_p,
(((NodeNmtState_p & 0xFF) << 8)
| kEplNmtCmdResetNode));
// reset CN
// store error code in NMT command data for diagnostic purpose
AmiSetWordToLe(&wbeErrorCode, wErrorCode_p);
Ret =
EplNmtMnuSendNmtCommandEx(uiNodeId_p, kEplNmtCmdResetNode,
&wbeErrorCode,
sizeof(wbeErrorCode));
if (Ret == kEplSuccessful) {
Ret = kEplReject;
}
goto Exit;
}
// check if NMT_MNNodeCurrState_AU8 has to be changed
ObdSize = 1;
Ret = EplObduReadEntry(0x1F8E, uiNodeId_p, &bNmtStatePrev, &ObdSize);
if (Ret != kEplSuccessful) {
goto Exit;
}
if (bNmtState != bNmtStatePrev) {
// update object 0x1F8E NMT_MNNodeCurrState_AU8
Ret = EplObduWriteEntry(0x1F8E, uiNodeId_p, &bNmtState, 1);
if (Ret != kEplSuccessful) {
goto Exit;
}
Ret = EplNmtMnuInstance_g.m_pfnCbNodeEvent(uiNodeId_p,
kEplNmtNodeEventNmtState,
NodeNmtState_p,
wErrorCode_p,
(pNodeInfo_p->
m_dwNodeCfg &
EPL_NODEASSIGN_MANDATORY_CN)
!= 0);
if (Ret != kEplSuccessful) {
goto Exit;
}
}
Exit:
return Ret;
}
//---------------------------------------------------------------------------
//
// Function: EplNmtMnuReset
//
// Description: reset internal structures, e.g. timers
//
// Parameters: void
//
// Returns: tEplKernel = error code
//
// State:
//
//---------------------------------------------------------------------------
static tEplKernel EplNmtMnuReset(void)
{
tEplKernel Ret;
int iIndex;
Ret = EplTimeruDeleteTimer(&EplNmtMnuInstance_g.m_TimerHdlNmtState);
for (iIndex = 1; iIndex <= tabentries(EplNmtMnuInstance_g.m_aNodeInfo);
iIndex++) {
// delete timer handles
Ret =
EplTimeruDeleteTimer(&EPL_NMTMNU_GET_NODEINFO(iIndex)->
m_TimerHdlStatReq);
Ret =
EplTimeruDeleteTimer(&EPL_NMTMNU_GET_NODEINFO(iIndex)->
m_TimerHdlLonger);
}
return Ret;
}
#endif // #if(((EPL_MODULE_INTEGRATION) & (EPL_MODULE_NMT_MN)) != 0)
// EOF