Initial Commit

1 files changed, 784 insertions, 0 deletions

diff --git a/ucs2-lib/src/ucs_bc_diag.c b/ucs2-lib/src/ucs_bc_diag.c
new file mode 100644
index 0000000..c932c90
--- /dev/null
+++ b/ucs2-lib/src/ucs_bc_diag.c
@@ -0,0 +1,784 @@
+/*------------------------------------------------------------------------------------------------*/
+/* UNICENS V2.1.0-3491                                                                            */
+/* Copyright (c) 2017 Microchip Technology Germany II GmbH & Co. KG.                              */
+/*                                                                                                */
+/* This program is free software: you can redistribute it and/or modify                           */
+/* it under the terms of the GNU General Public License as published by                           */
+/* the Free Software Foundation, either version 2 of the License, or                              */
+/* (at your option) any later version.                                                            */
+/*                                                                                                */
+/* This program is distributed in the hope that it will be useful,                                */
+/* but WITHOUT ANY WARRANTY; without even the implied warranty of                                 */
+/* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the                                  */
+/* GNU General Public License for more details.                                                   */
+/*                                                                                                */
+/* You should have received a copy of the GNU General Public License                              */
+/* along with this program.  If not, see <http://www.gnu.org/licenses/>.                          */
+/*                                                                                                */
+/* You may also obtain this software under a propriety license from Microchip.                    */
+/* Please contact Microchip for further information.                                              */
+/*------------------------------------------------------------------------------------------------*/
+
+/*!
+ * \file
+ * \brief Implementation of the BackChannel Diagnosis.
+ *
+ * \cond UCS_INTERNAL_DOC
+ * \addtogroup G_BACKCHANNEL_DIAG
+ * @{
+
+ */
+
+/*------------------------------------------------------------------------------------------------*/
+/* Includes                                                                                       */
+/*------------------------------------------------------------------------------------------------*/
+#include "ucs_inic_pb.h"
+#include "ucs_bc_diag.h"
+#include "ucs_misc.h"
+
+
+/*------------------------------------------------------------------------------------------------*/
+/* Internal constants                                                                             */
+/*------------------------------------------------------------------------------------------------*/
+#define BCD_NUM_STATES               7U     /*!< \brief Number of state machine states */
+#define BCD_NUM_EVENTS              12U     /*!< \brief Number of state machine events */
+
+#define BCD_TIMEOUT_COMMAND        100U     /*!< \brief supervise EXC commands */
+
+#define BCD_SIGNATURE_VERSION        1U     /*!< \brief signature version used for BackChannel Diagnosis */
+
+#define BCD_T_SEND              0x0100U
+#define BCD_T_WAIT4DUT          0x1000U
+#define BCD_T_SWITCH            0x0100U
+#define BCD_T_BACK              0x2000U
+#define BCD_TIMEOUT2            0x3000U
+#define BCD_T_SIGNAL_ON         100U
+#define BCD_T_LOCK              100U
+#define BCD_T_LIGHT_PROGRESS    20U
+#define BCD_AUTOBACK            (true)
+#define ADMIN_BASE_ADDR         0x0F00U
+
+/*------------------------------------------------------------------------------------------------*/
+/* Service parameters                                                                             */
+/*------------------------------------------------------------------------------------------------*/
+/*! Priority of the BackChannel Diagnosis used by scheduler */
+static const uint8_t BCD_SRV_PRIO = 248U;   /* parasoft-suppress  MISRA2004-8_7 "Value shall be part of the module, not part of a function." */
+/*! Main event for the BackChannel Diagnosis */
+static const Srv_Event_t BCD_EVENT_SERVICE = 1U;
+
+
+/*------------------------------------------------------------------------------------------------*/
+/* Internal enumerators                                                                           */
+/*------------------------------------------------------------------------------------------------*/
+/*! \brief Possible events of the BackChannel Diagnosis state machine */
+typedef enum Bcd_Events_
+{
+    BCD_E_NIL                = 0U,      /*!< \brief NIL Event */
+    BCD_E_START              = 1U,      /*!< \brief API start command was called. */
+    BCD_E_DIAGMODE_END       = 2U,      /*!< \brief INIC.BCDiagEnd.Result successful. */
+    BCD_E_DIAG_MODE_STARTED  = 3U,      /*!< \brief INIC.BCDiag.Result successful. */
+    BCD_E_DIAG_MODE_FAILED   = 4U,      /*!< \brief INIC.BCDiag.Error received. */
+    BCD_E_TX_ENABLE_SUCCESS  = 5U,      /*!< \brief EXC.BCEnableTx successful */
+    BCD_E_TX_ENABLE_FAILED   = 6U,      /*!< \brief EXC.BCEnableTx failed. */
+    BCD_E_DIAG_RESULT_OK     = 7U,      /*!< \brief EXC.BCDIAG.Result Ok received. */
+    BCD_E_DIAG_RESULT_NOTOK  = 8U,      /*!< \brief EXC.BCDIAG.Result NotOk received. */
+    BCD_E_NET_OFF            = 9U,      /*!< \brief NetOff occurred. */
+    BCD_E_TIMEOUT            = 10U,     /*!< \brief Timeout occurred. */
+    BCD_E_ERROR              = 11U      /*!< \brief An unexpected error occurred. */
+
+} Bcd_Events_t;
+
+
+/*! \brief States of the BackChannel Diagnosis state machine */
+typedef enum Bcd_State_
+{
+    BCD_S_IDLE            =  0U,     /*!< \brief Idle state */
+    BCD_S_STARTED         =  1U,     /*!< \brief BackChannel Diagnosis started */
+    BCD_S_WAIT_ENABLED    =  2U,     /*!< \brief Wait for BCEnableTx.Result */
+    BCD_S_WAIT_SIG_PROP   =  3U,     /*!< \brief Wait for signal propagating through the following nodes */    
+    BCD_S_WAIT_SIGNAL_ON  =  4U,     /*!< \brief Wait for t_SignalOn to expire. */
+    BCD_S_WAIT_RESULT     =  5U,     /*!< \brief Wait for ENC.BCDiag.Result */
+    BCD_S_END             =  6U      /*!< \brief BackChannel Diagnosis ends. */
+} Bcd_State_t;
+
+
+/*------------------------------------------------------------------------------------------------*/
+/* Internal prototypes                                                                            */
+/*------------------------------------------------------------------------------------------------*/
+static void Bcd_Service(void *self);
+
+static void Bcd_InicBcdStartCb(void *self, void *result_ptr);
+static void Bcd_EnableTxResultCb(void *self, void *result_ptr);
+static void Bcd_DiagnosisResultCb(void *self, void *result_ptr);
+static void Bcd_InicBcdEndCb(void *self, void *result_ptr);
+
+static void Bcd_OnTerminateEventCb(void *self, void *result_ptr);
+static void Bcd_NetworkStatusCb(void *self, void *result_ptr);
+
+static void Bcd_A_Start(void *self);
+static void Bcd_A_EnableTx(void *self);
+static void Bcd_A_DiagStart(void *self);
+static void Bcd_A_NextSeg(void *self);
+static void Bcd_A_StopDiag(void *self);
+static void Bcd_A_Error(void *self);
+static void Bcd_A_EndDiag(void *self);
+static void Bcd_A_Timeout2(void *self);
+static void Bcd_A_WaitLight(void *self);
+
+
+static Ucs_Return_t Bcd_EnableTx(void *self, uint8_t port);
+
+static void Bcd_TimerCb(void *self);
+
+/*------------------------------------------------------------------------------------------------*/
+/* State transition table (used by finite state machine)                                          */
+/*------------------------------------------------------------------------------------------------*/
+/*! \brief State transition table */
+static const Fsm_StateElem_t bcd_trans_tab[BCD_NUM_STATES][BCD_NUM_EVENTS] =    /* parasoft-suppress  MISRA2004-8_7 "Value shall be part of the module, not part of a function." */
+{
+    { /* State BCD_S_IDLE */
+        /* BCD_E_NIL                */ {NULL,                   BCD_S_IDLE              },
+        /* BCD_E_START              */ {Bcd_A_Start,            BCD_S_STARTED           },
+        /* BCD_E_DIAGMODE_END       */ {NULL,                   BCD_S_IDLE              },
+        /* BCD_E_DIAG_MODE_STARTED  */ {NULL,                   BCD_S_IDLE              },
+        /* BCD_E_DIAG_MODE_FAILED   */ {NULL,                   BCD_S_IDLE              },
+        /* BCD_E_TX_ENABLE_SUCCESS  */ {NULL,                   BCD_S_IDLE              },
+        /* BCD_E_TX_ENABLE_FAILED   */ {NULL,                   BCD_S_IDLE              },
+        /* BCD_E_DIAG_RESULT_OK     */ {NULL,                   BCD_S_IDLE              },
+        /* BCD_E_DIAG_RESULT_NOTOK  */ {NULL,                   BCD_S_IDLE              },
+        /* BCD_E_NET_OFF            */ {NULL,                   BCD_S_IDLE              },
+        /* BCD_E_TIMEOUT            */ {NULL,                   BCD_S_IDLE              },
+        /* BCD_E_ERROR              */ {NULL,                   BCD_S_IDLE              }
+    },
+    { /* State BCD_S_STARTED */
+        /* BCD_E_NIL                */ {NULL,                   BCD_S_STARTED           },
+        /* BCD_E_START              */ {NULL,                   BCD_S_STARTED           },
+        /* BCD_E_DIAGMODE_END       */ {NULL,                   BCD_S_STARTED           },
+        /* BCD_E_DIAG_MODE_STARTED  */ {Bcd_A_EnableTx,         BCD_S_WAIT_ENABLED      },
+        /* BCD_E_DIAG_MODE_FAILED   */ {NULL,                   BCD_S_STARTED           },
+        /* BCD_E_TX_ENABLE_SUCCESS  */ {NULL,                   BCD_S_STARTED           },
+        /* BCD_E_TX_ENABLE_FAILED   */ {NULL,                   BCD_S_STARTED           },
+        /* BCD_E_DIAG_RESULT_OK     */ {NULL,                   BCD_S_STARTED           },
+        /* BCD_E_DIAG_RESULT_NOTOK  */ {NULL,                   BCD_S_STARTED           },
+        /* BCD_E_NET_OFF            */ {NULL,                   BCD_S_STARTED           },
+        /* BCD_E_TIMEOUT            */ {Bcd_A_Timeout2,         BCD_S_IDLE              },
+        /* BCD_E_ERROR              */ {Bcd_A_Error,            BCD_S_IDLE              }
+    },
+    { /* State BCD_S_WAIT_ENABLED */
+        /* BCD_E_NIL                */ {NULL,                   BCD_S_WAIT_ENABLED      },
+        /* BCD_E_START              */ {NULL,                   BCD_S_WAIT_ENABLED      },
+        /* BCD_E_DIAGMODE_END       */ {NULL,                   BCD_S_WAIT_ENABLED      },
+        /* BCD_E_DIAG_MODE_STARTED  */ {NULL,                   BCD_S_WAIT_ENABLED      },
+        /* BCD_E_DIAG_MODE_FAILED   */ {NULL,                   BCD_S_WAIT_ENABLED      },
+        /* BCD_E_TX_ENABLE_SUCCESS  */ {Bcd_A_WaitLight,        BCD_S_WAIT_SIG_PROP     },
+        /* BCD_E_TX_ENABLE_FAILED   */ {Bcd_A_Error,            BCD_S_IDLE              },
+        /* BCD_E_DIAG_RESULT_OK     */ {NULL,                   BCD_S_WAIT_ENABLED      },
+        /* BCD_E_DIAG_RESULT_NOTOK  */ {NULL,                   BCD_S_WAIT_ENABLED      },
+        /* BCD_E_NET_OFF            */ {NULL,                   BCD_S_WAIT_ENABLED      },
+        /* BCD_E_TIMEOUT            */ {Bcd_A_Timeout2,         BCD_S_IDLE              },
+        /* BCD_E_ERROR              */ {Bcd_A_Error,            BCD_S_IDLE              }
+    },
+    { /* State BCD_S_WAIT_SIG_PROP */
+        /* BCD_E_NIL                */ {NULL,                   BCD_S_WAIT_SIG_PROP     },
+        /* BCD_E_START              */ {NULL,                   BCD_S_WAIT_SIG_PROP     },
+        /* BCD_E_DIAGMODE_END       */ {NULL,                   BCD_S_WAIT_SIG_PROP     },
+        /* BCD_E_DIAG_MODE_STARTED  */ {NULL,                   BCD_S_WAIT_SIG_PROP     },
+        /* BCD_E_DIAG_MODE_FAILED   */ {NULL,                   BCD_S_WAIT_SIG_PROP     },
+        /* BCD_E_TX_ENABLE_SUCCESS  */ {NULL,                   BCD_S_WAIT_SIG_PROP     },
+        /* BCD_E_TX_ENABLE_FAILED   */ {NULL,                   BCD_S_WAIT_SIG_PROP     },
+        /* BCD_E_DIAG_RESULT_OK     */ {NULL,                   BCD_S_WAIT_SIG_PROP     },
+        /* BCD_E_DIAG_RESULT_NOTOK  */ {NULL,                   BCD_S_WAIT_SIG_PROP     },
+        /* BCD_E_NET_OFF            */ {NULL,                   BCD_S_WAIT_SIG_PROP     },
+        /* BCD_E_TIMEOUT            */ {Bcd_A_DiagStart,        BCD_S_WAIT_RESULT       },
+        /* BCD_E_ERROR              */ {Bcd_A_Error,            BCD_S_IDLE              }
+    },
+    { /* State BCD_S_WAIT_SIGNAL_ON */
+        /* BCD_E_NIL                */ {NULL,                   BCD_S_WAIT_SIGNAL_ON    },
+        /* BCD_E_START              */ {NULL,                   BCD_S_WAIT_SIGNAL_ON    },
+        /* BCD_E_DIAGMODE_END       */ {NULL,                   BCD_S_WAIT_SIGNAL_ON    },
+        /* BCD_E_DIAG_MODE_STARTED  */ {NULL,                   BCD_S_WAIT_SIGNAL_ON    },
+        /* BCD_E_DIAG_MODE_FAILED   */ {NULL,                   BCD_S_WAIT_SIGNAL_ON    },
+        /* BCD_E_TX_ENABLE_SUCCESS  */ {NULL,                   BCD_S_WAIT_SIGNAL_ON    },
+        /* BCD_E_TX_ENABLE_FAILED   */ {NULL,                   BCD_S_WAIT_SIGNAL_ON    },
+        /* BCD_E_DIAG_RESULT_OK     */ {NULL,                   BCD_S_WAIT_SIGNAL_ON    },
+        /* BCD_E_DIAG_RESULT_NOTOK  */ {NULL,                   BCD_S_WAIT_SIGNAL_ON    },
+        /* BCD_E_NET_OFF            */ {NULL,                   BCD_S_WAIT_SIGNAL_ON    },
+        /* BCD_E_TIMEOUT            */ {Bcd_A_EnableTx,         BCD_S_WAIT_ENABLED      },
+        /* BCD_E_ERROR              */ {Bcd_A_Error,            BCD_S_IDLE              }
+    },
+    { /* State BCD_S_WAIT_RESULT */
+        /* BCD_E_NIL                */ {NULL,                   BCD_S_WAIT_RESULT       },
+        /* BCD_E_START              */ {NULL,                   BCD_S_WAIT_RESULT       },
+        /* BCD_E_DIAGMODE_END       */ {NULL,                   BCD_S_WAIT_RESULT       },
+        /* BCD_E_DIAG_MODE_STARTED  */ {NULL,                   BCD_S_WAIT_RESULT       },
+        /* BCD_E_DIAG_MODE_FAILED   */ {NULL,                   BCD_S_WAIT_RESULT       },
+        /* BCD_E_TX_ENABLE_SUCCESS  */ {NULL,                   BCD_S_WAIT_RESULT       },
+        /* BCD_E_TX_ENABLE_FAILED   */ {NULL,                   BCD_S_WAIT_RESULT       },
+        /* BCD_E_DIAG_RESULT_OK     */ {Bcd_A_NextSeg,          BCD_S_WAIT_SIGNAL_ON    },
+        /* BCD_E_DIAG_RESULT_NOTOK  */ {Bcd_A_StopDiag,         BCD_S_END               },
+        /* BCD_E_NET_OFF            */ {NULL,                   BCD_S_WAIT_RESULT       },
+        /* BCD_E_TIMEOUT            */ {Bcd_A_Timeout2,         BCD_S_IDLE              },
+        /* BCD_E_ERROR              */ {Bcd_A_Error,            BCD_S_IDLE              }
+    },
+    { /* State BCD_S_END    */
+        /* BCD_E_NIL                */ {NULL,                   BCD_S_END               },
+        /* BCD_E_START              */ {NULL,                   BCD_S_END               },
+        /* BCD_E_DIAGMODE_END       */ {Bcd_A_EndDiag,          BCD_S_IDLE              },
+        /* BCD_E_DIAG_MODE_STARTED  */ {NULL,                   BCD_S_END               },
+        /* BCD_E_DIAG_MODE_FAILED   */ {NULL,                   BCD_S_END               },
+        /* BCD_E_TX_ENABLE_SUCCESS  */ {NULL,                   BCD_S_END               },
+        /* BCD_E_TX_ENABLE_FAILED   */ {NULL,                   BCD_S_END               },
+        /* BCD_E_DIAG_RESULT_OK     */ {NULL,                   BCD_S_END               },
+        /* BCD_E_DIAG_RESULT_NOTOK  */ {NULL,                   BCD_S_END               },
+        /* BCD_E_NET_OFF            */ {NULL,                   BCD_S_END               },
+        /* BCD_E_TIMEOUT            */ {Bcd_A_Timeout2,         BCD_S_IDLE              },
+        /* BCD_E_ERROR              */ {Bcd_A_Error,            BCD_S_IDLE              }
+    }
+};
+
+
+/*! \brief Constructor of class CBackChannelDiag.
+ *  \param self         Reference to CBackChannelDiag instance
+ *  \param inic         Reference to CInic instance
+ *  \param base         Reference to CBase instance
+ *  \param exc          Reference to CExc instance
+ */
+ /*  \param init_ptr    Report callback function*/
+void Bcd_Ctor(CBackChannelDiag *self, CInic *inic, CBase *base, CExc *exc)
+{
+    MISC_MEM_SET((void *)self, 0, sizeof(*self));
+
+    self->inic       = inic;
+    self->exc        = exc;
+    self->base       = base;
+
+    Fsm_Ctor(&self->fsm, self, &(bcd_trans_tab[0][0]), BCD_NUM_EVENTS, BCD_E_NIL);
+
+
+    Sobs_Ctor(&self->bcd_inic_bcd_start, self, &Bcd_InicBcdStartCb);
+    Sobs_Ctor(&self->bcd_inic_bcd_end,   self, &Bcd_InicBcdEndCb);
+    Sobs_Ctor(&self->bcd_enabletx,       self, &Bcd_EnableTxResultCb);
+    Sobs_Ctor(&self->bcd_diagnosis,      self, &Bcd_DiagnosisResultCb);
+
+
+    /* register termination events */
+    Mobs_Ctor(&self->bcd_terminate, self, EH_M_TERMINATION_EVENTS, &Bcd_OnTerminateEventCb);
+    Eh_AddObsrvInternalEvent(&self->base->eh, &self->bcd_terminate);
+
+    /* Register NetOn and MPR events */
+    Obs_Ctor(&self->bcd_nwstatus, self, &Bcd_NetworkStatusCb);
+    Inic_AddObsrvNwStatus(self->inic,  &self->bcd_nwstatus);
+    self->neton = false;
+
+    /* Initialize Node Discovery service */
+    Srv_Ctor(&self->service, BCD_SRV_PRIO, self, &Bcd_Service);
+    /* Add Node Discovery service to scheduler */
+    (void)Scd_AddService(&self->base->scd, &self->service);
+
+}
+
+
+/*! \brief Service function of the Node Discovery service.
+ *  \param self    Reference to Node Discovery object
+ */
+static void Bcd_Service(void *self)
+{
+    CBackChannelDiag *self_ = (CBackChannelDiag *)self;
+    Srv_Event_t event_mask;
+    Srv_GetEvent(&self_->service, &event_mask);
+    if(BCD_EVENT_SERVICE == (event_mask & BCD_EVENT_SERVICE))   /* Is event pending? */
+    {
+        Fsm_State_t result;
+        Srv_ClearEvent(&self_->service, BCD_EVENT_SERVICE);
+        TR_INFO((self_->base->ucs_user_ptr, "[BCD]", "FSM __ %d %d", 2U, self_->fsm.current_state, self_->fsm.event_occured));
+        result = Fsm_Service(&self_->fsm);
+        TR_ASSERT(self_->base->ucs_user_ptr, "[BCD]", (result != FSM_STATE_ERROR));
+        TR_INFO((self_->base->ucs_user_ptr, "[BCD]", "FSM -> %d", 1U, self_->fsm.current_state));
+        MISC_UNUSED(result);
+    }
+}
+
+
+/**************************************************************************************************/
+/* API functions                                                                                  */
+/**************************************************************************************************/
+/*! \brief Program a node
+ *
+ *  \param *self        Reference to BackChannel Diagnosis object
+ *  \param *report_fptr Reference to result callback used by BackChannel Diagnosis
+*/
+void Bcd_Start(CBackChannelDiag *self, Ucs_Bcd_ReportCb_t report_fptr)
+{
+    self->report_fptr = report_fptr;
+
+    Fsm_SetEvent(&self->fsm, BCD_E_START);
+    Srv_SetEvent(&self->service, BCD_EVENT_SERVICE);
+
+    TR_INFO((self->base->ucs_user_ptr, "[BCD]", "Bcd_Start", 0U));
+
+}
+
+
+
+/**************************************************************************************************/
+/*  FSM Actions                                                                                   */
+/**************************************************************************************************/
+static void Bcd_A_Start(void *self)
+{
+    Ucs_Return_t ret_val;
+    CBackChannelDiag *self_ = (CBackChannelDiag *)self;
+
+    /* send INIC.BCDiag.StartResult */
+    ret_val = Inic_BCDiagnosis(self_->inic,  &self_->bcd_inic_bcd_start);
+
+    if (ret_val == UCS_RET_SUCCESS)
+    {
+        Tm_SetTimer(&self_->base->tm,
+                    &self_->timer,
+                    &Bcd_TimerCb,
+                    self_,
+                    BCD_TIMEOUT_COMMAND,
+                    0U);
+    }
+    else
+    {
+        Fsm_SetEvent(&self_->fsm, BCD_E_ERROR);
+        Srv_SetEvent(&self_->service, BCD_EVENT_SERVICE);
+    }
+
+    self_->current_segment = 0U;
+
+    TR_ASSERT(self_->base->ucs_user_ptr, "[BCD]", ret_val == UCS_RET_SUCCESS);
+    MISC_UNUSED(ret_val);
+}
+
+static void Bcd_A_EnableTx(void *self)
+{
+    Ucs_Return_t ret_val;
+    CBackChannelDiag *self_ = (CBackChannelDiag *)self;
+
+    /* send ENC.EnableTx */
+    ret_val = Bcd_EnableTx(self, 0U);
+
+    if (ret_val == UCS_RET_SUCCESS)
+    {
+        Tm_SetTimer(&self_->base->tm,
+                    &self_->timer,
+                    &Bcd_TimerCb,
+                    self_,
+                    BCD_TIMEOUT_COMMAND,
+                    0U);
+    }
+    else
+    {
+        Fsm_SetEvent(&self_->fsm, BCD_E_ERROR);
+        Srv_SetEvent(&self_->service, BCD_EVENT_SERVICE);
+    }
+
+    TR_ASSERT(self_->base->ucs_user_ptr, "[BCD]", ret_val == UCS_RET_SUCCESS);
+    MISC_UNUSED(ret_val);
+}
+
+/*! Starts the diagnosis command for one certain segment.
+ *
+ * \param *self The instance
+ */
+static void Bcd_A_DiagStart(void *self)
+{
+    Ucs_Return_t ret_val;
+    uint16_t t_send     = BCD_T_SEND;
+    uint16_t t_wait4dut = BCD_T_WAIT4DUT;
+    uint16_t t_switch   = BCD_T_SWITCH;
+    uint16_t t_back     = BCD_T_BACK;
+    bool     autoback   = BCD_AUTOBACK; 
+
+    CBackChannelDiag *self_ = (CBackChannelDiag *)self;
+
+    ret_val = Exc_BCDiag_Start(self_->exc,
+                               self_->current_segment,
+                               ADMIN_BASE_ADDR + self_->current_segment,
+                               t_send,
+                               t_wait4dut,
+                               t_switch,
+                               t_back,
+                               autoback,
+                               &self_->bcd_diagnosis);
+
+    if (ret_val == UCS_RET_SUCCESS)
+    {
+        Tm_SetTimer(&self_->base->tm,
+                    &self_->timer,
+                    &Bcd_TimerCb,
+                    self_,
+                    BCD_TIMEOUT2,
+                    0U);
+
+    }
+    else
+    {
+        Fsm_SetEvent(&self_->fsm, BCD_E_ERROR);
+        Srv_SetEvent(&self_->service, BCD_EVENT_SERVICE);
+    }
+
+
+    MISC_UNUSED(ret_val);
+}
+
+
+static void Bcd_A_NextSeg(void *self)
+{
+    CBackChannelDiag *self_ = (CBackChannelDiag *)self;
+
+    self_->report_fptr(UCS_BCD_RES_SUCCESS, 
+                       (uint8_t)(self_->bcd_result.admin_addr - ADMIN_BASE_ADDR), 
+                       self_->base->ucs_user_ptr);
+    self_->current_segment += 1U;       /* switch to next segment. */
+
+    Tm_SetTimer(&self_->base->tm,
+                &self_->timer,
+                &Bcd_TimerCb,
+                self_,
+                BCD_T_SIGNAL_ON,
+                0U);
+}
+
+static void Bcd_A_StopDiag(void *self)
+{
+    Ucs_Return_t ret_val;
+    CBackChannelDiag *self_ = (CBackChannelDiag *)self;
+
+    switch(self_->bcd_result.diag_result)
+    {
+    case DUT_MASTER:
+        self_->report_fptr(UCS_BCD_RES_NO_RING_BREAK, 
+                           (uint8_t)(self_->bcd_result.admin_addr - ADMIN_BASE_ADDR), 
+                           self_->base->ucs_user_ptr);
+        break;
+
+    case DUT_NO_ANSWER:
+        self_->report_fptr(UCS_BCD_RES_RING_BREAK, 
+                           (uint8_t)(self_->bcd_result.admin_addr - ADMIN_BASE_ADDR), 
+                           self_->base->ucs_user_ptr);
+        break;
+
+    case DUT_TIMEOUT:
+        self_->report_fptr(UCS_BCD_RES_TIMEOUT1,  
+                           (uint8_t)(self_->bcd_result.admin_addr - ADMIN_BASE_ADDR), 
+                           self_->base->ucs_user_ptr);
+        break;
+
+    default:
+        break;
+    }
+
+    /* finish Back Channel Diagnosis Mode: send INIC.BCDiagEnd.StartResult */
+    ret_val = Inic_BCDiagEnd(self_->inic,  &self_->bcd_inic_bcd_end);
+
+    if (ret_val == UCS_RET_SUCCESS)
+    {
+        Tm_SetTimer(&self_->base->tm,
+                    &self_->timer,
+                    &Bcd_TimerCb,
+                    self_,
+                    BCD_TIMEOUT_COMMAND,
+                    0U);
+    }
+    else
+    {
+        Fsm_SetEvent(&self_->fsm, BCD_E_ERROR);
+        Srv_SetEvent(&self_->service, BCD_EVENT_SERVICE);
+    }
+
+    MISC_UNUSED(ret_val);
+}
+
+
+static void Bcd_A_EndDiag(void *self)
+{
+    CBackChannelDiag *self_ = (CBackChannelDiag *)self;
+
+    if (self_->report_fptr != NULL)
+    {
+        self_->report_fptr(UCS_BCD_RES_END, UCS_BCD_DUMMY_SEGMENT, self_->base->ucs_user_ptr);
+    }
+}
+
+static void Bcd_A_Timeout2(void *self)
+{
+    CBackChannelDiag *self_ = (CBackChannelDiag *)self;
+
+    if (self_->report_fptr != NULL)
+    {
+        self_->report_fptr(UCS_BCD_RES_TIMEOUT2, UCS_BCD_DUMMY_SEGMENT, self_->base->ucs_user_ptr);
+    }
+}
+
+static void Bcd_A_WaitLight(void *self)
+{
+    CBackChannelDiag *self_ = (CBackChannelDiag *)self;
+
+    Tm_SetTimer(&self_->base->tm,
+                &self_->timer,
+                &Bcd_TimerCb,
+                self_,
+                BCD_T_LOCK + (BCD_T_LIGHT_PROGRESS * (self_->current_segment + 1U)),
+                0U);
+}
+
+
+
+
+/*! \brief An unecpected error occurred
+ *
+ * \param *self Reference to BackChannelDiagnosis object
+ */
+static void Bcd_A_Error(void *self)
+{
+    CBackChannelDiag *self_ = (CBackChannelDiag *)self;
+
+    if (self_->report_fptr != NULL)
+    {
+        self_->report_fptr(UCS_BCD_RES_ERROR, UCS_BCD_DUMMY_SEGMENT, self_->base->ucs_user_ptr);
+    }
+
+}
+
+
+/**************************************************************************************************/
+/*  Callback functions                                                                            */
+/**************************************************************************************************/
+
+/*! \brief  Function is called on reception of the Welcome.Result messsage
+ *  \param  self        Reference to BackChannelDiagnosis object
+ *  \param  result_ptr  Pointer to the result of the Welcome message
+ */
+static void Bcd_InicBcdStartCb(void *self, void *result_ptr)
+{
+    CBackChannelDiag *self_        = (CBackChannelDiag *)self;
+    Exc_StdResult_t *result_ptr_ = (Exc_StdResult_t *)result_ptr;
+
+    Tm_ClearTimer(&self_->base->tm, &self_->timer);
+
+    if (result_ptr_->result.code == UCS_RES_SUCCESS)
+    {
+        Fsm_SetEvent(&self_->fsm, BCD_E_DIAG_MODE_STARTED);
+        TR_INFO((self_->base->ucs_user_ptr, "[BCD]", "Bcd_InicBcdStartCb BCD_E_DIAG_MODE_STARTED", 0U));
+    }
+    else
+    {
+        uint8_t i;
+
+        Fsm_SetEvent(&self_->fsm, BCD_E_DIAG_MODE_FAILED);
+        TR_INFO((self_->base->ucs_user_ptr, "[BCD]", "Bcd_InicBcdStartCb Error (code) 0x%x", 1U, result_ptr_->result.code));
+        for (i=0U; i< result_ptr_->result.info_size; ++i)
+        {
+            TR_INFO((self_->base->ucs_user_ptr, "[BCD]", "Bcd_InicBcdStartCb Error (info) 0x%x", 1U, result_ptr_->result.info_ptr[i]));
+        }
+    }
+
+    Srv_SetEvent(&self_->service, BCD_EVENT_SERVICE);
+}
+
+
+
+/*! \brief  Function is called on reception of the BCEnableTx.Result messsage
+ *  \param  self        Reference to BackChannelDiagnosis object
+ *  \param  result_ptr  Pointer to the result of the BCEnableTx message
+ */
+static void Bcd_EnableTxResultCb(void *self, void *result_ptr)
+{
+    CBackChannelDiag *self_        = (CBackChannelDiag *)self;
+    Exc_StdResult_t *result_ptr_ = (Exc_StdResult_t *)result_ptr;
+
+    Tm_ClearTimer(&self_->base->tm, &self_->timer);
+
+    if (result_ptr_->result.code == UCS_RES_SUCCESS)
+    {
+        /*        self_->signature_status = *(Exc_SignatureStatus_t *)(result_ptr_->data_info);*/
+        Fsm_SetEvent(&self_->fsm, BCD_E_TX_ENABLE_SUCCESS);
+        TR_INFO((self_->base->ucs_user_ptr, "[BCD]", "Bcd_EnableTxResultCb BCD_E_TX_ENABLE_SUCCESS", 0U));
+    }
+    else
+    {
+        Fsm_SetEvent(&self_->fsm, BCD_E_TX_ENABLE_FAILED);
+        TR_INFO((self_->base->ucs_user_ptr, "[ND]", "Bcd_EnableTxResultCb Error  0x%x", 1U, result_ptr_->result.code));
+    }
+
+    Srv_SetEvent(&self_->service, BCD_EVENT_SERVICE);
+}
+
+
+/*! \brief  Function is called on reception of the ENC.BCDiag.Result messsage
+ *  \param  self        Reference to BackChannelDiagnosis object
+ *  \param  result_ptr  Pointer to the result of the BCDiag message
+ */
+static void Bcd_DiagnosisResultCb(void *self, void *result_ptr)
+{
+    CBackChannelDiag *self_      = (CBackChannelDiag *)self;
+    Exc_StdResult_t *result_ptr_ = (Exc_StdResult_t *)result_ptr;
+
+    Tm_ClearTimer(&self_->base->tm, &self_->timer);
+
+    if (result_ptr_->result.code == UCS_RES_SUCCESS)
+    {
+        self_->bcd_result = *((Exc_BCDiagResult *)(result_ptr_->data_info));
+        switch (self_->bcd_result.diag_result)
+        {
+        case DUT_SLAVE:
+            /* node reported working segment */
+            Fsm_SetEvent(&self_->fsm, BCD_E_DIAG_RESULT_OK);
+            TR_INFO((self_->base->ucs_user_ptr, "[BCD]", "Bcd_DiagnosisResultCb DUT_SLAVE", 0U));
+            break;
+
+        case DUT_MASTER:        /* all segments are ok */
+        case DUT_NO_ANSWER:     /* ring break found */
+        case DUT_TIMEOUT:       /* no communication on back channel */
+            Fsm_SetEvent(&self_->fsm, BCD_E_DIAG_RESULT_NOTOK);
+            TR_INFO((self_->base->ucs_user_ptr, "[BCD]", "Bcd_DiagnosisResultCb others", 0U));
+            break;
+
+        default:
+            /* report error */
+            break;
+        }
+    }
+    else
+    {
+        Fsm_SetEvent(&self_->fsm, BCD_E_ERROR);
+        TR_INFO((self_->base->ucs_user_ptr, "[ND]", "Bcd_DiagnosisResultCb Error  0x%x", 1U, result_ptr_->result.code));
+    }
+
+    Srv_SetEvent(&self_->service, BCD_EVENT_SERVICE);
+}
+
+
+/*! \brief  Function is called on reception of the INIC.BCDiagEnd.Result messsage
+ *  \param  self        Reference to BackChannel Diagnosis object
+ *  \param  result_ptr  Pointer to the result of the Welcome message
+ */
+static void Bcd_InicBcdEndCb(void *self, void *result_ptr)
+{
+    CBackChannelDiag *self_        = (CBackChannelDiag *)self;
+    Exc_StdResult_t *result_ptr_ = (Exc_StdResult_t *)result_ptr;
+
+    Tm_ClearTimer(&self_->base->tm, &self_->timer);
+
+    if (result_ptr_->result.code == UCS_RES_SUCCESS)
+    {
+        Fsm_SetEvent(&self_->fsm, BCD_E_DIAGMODE_END);
+        TR_INFO((self_->base->ucs_user_ptr, "[BCD]", "Bcd_InicBcdEndCb BCD_E_DIAGMODE_END", 0U));
+    }
+    else
+    {
+        Fsm_SetEvent(&self_->fsm, BCD_E_ERROR);
+        TR_INFO((self_->base->ucs_user_ptr, "[ND]", "Bcd_InicBcdEndCb Error  0x%x", 1U, result_ptr_->result.code));
+    }
+
+    Srv_SetEvent(&self_->service, BCD_EVENT_SERVICE);
+}
+
+
+/*!  Function is called on severe internal errors
+ *
+ * \param *self         Reference to Node Discovery object
+ * \param *result_ptr   Reference to data
+ */
+static void Bcd_OnTerminateEventCb(void *self, void *result_ptr)
+{
+    CBackChannelDiag *self_ = (CBackChannelDiag *)self;
+
+    MISC_UNUSED(result_ptr);
+
+    if (self_->fsm.current_state != BCD_S_IDLE)
+    {
+        Tm_ClearTimer(&self_->base->tm, &self_->timer);
+        if (self_->report_fptr != NULL)
+        {
+            self_->report_fptr(UCS_BCD_RES_ERROR, UCS_BCD_DUMMY_SEGMENT, self_->base->ucs_user_ptr);
+        }
+    }
+}
+
+
+/*! \brief Callback function for the INIC.NetworkStatus status and error messages
+ *
+ * \param *self         Reference to Node Discovery object
+ * \param *result_ptr   Pointer to the result of the INIC.NetworkStatus message
+ */
+static void Bcd_NetworkStatusCb(void *self, void *result_ptr)
+{
+    CBackChannelDiag *self_ = (CBackChannelDiag *)self;
+    Inic_StdResult_t *result_ptr_ = (Inic_StdResult_t *)result_ptr;
+
+    if (result_ptr_->result.code == UCS_RES_SUCCESS)
+    {
+        TR_INFO((self_->base->ucs_user_ptr, "[BCD]", "Bcd_NetworkStatusCb  0x%x", 1U, result_ptr_->result.code));
+        /* check for NetOn/NetOff events */
+        if (    (self_->neton == true)
+             && ((((Inic_NetworkStatus_t *)(result_ptr_->data_info))->availability) == UCS_NW_NOT_AVAILABLE) )
+        {
+            self_->neton = false;
+            Fsm_SetEvent(&self_->fsm, BCD_E_NET_OFF);
+            Srv_SetEvent(&self_->service, BCD_EVENT_SERVICE);
+        }
+        /* check for NetOn/NetOff events */
+        else if (    (self_->neton == false)
+             && ((((Inic_NetworkStatus_t *)(result_ptr_->data_info))->availability) == UCS_NW_AVAILABLE) )
+        {
+/*            self_->neton = true;
+            self_->hello_neton_request = true;
+            Fsm_SetEvent(&self_->fsm, BCD_E_CHECK);*/
+        }
+        /* check for MPR event */
+        else if (   (((Inic_NetworkStatus_t *)(result_ptr_->data_info))->events & UCS_NETWORK_EVENT_NCE)
+            == UCS_NETWORK_EVENT_NCE)
+        {
+/*            self_->hello_mpr_request = true;
+            Fsm_SetEvent(&self_->fsm, BCD_E_CHECK);*/
+        }
+    }
+
+}
+
+
+/*! \brief Timer callback used for supervising INIC command timeouts.
+ *  \param self    Reference to Node Discovery object
+ */
+static void Bcd_TimerCb(void *self)
+{
+    CBackChannelDiag *self_ = (CBackChannelDiag *)self;
+
+    Fsm_SetEvent(&self_->fsm, BCD_E_TIMEOUT);
+    TR_INFO((self_->base->ucs_user_ptr, "[BCD]", "Bcd_TimerCb BCD_E_TIMEOUT", 0U));
+
+    Srv_SetEvent(&self_->service, BCD_EVENT_SERVICE);
+}
+
+
+/**************************************************************************************************/
+/*  Helper functions                                                                              */
+/**************************************************************************************************/
+static Ucs_Return_t Bcd_EnableTx(void *self, uint8_t port)
+{
+    Ucs_Return_t ret_val;
+    CBackChannelDiag *self_ = (CBackChannelDiag *)self;
+
+    /* send INIC.BCDiag.StartResult */
+    ret_val = Exc_BCEnableTx_StartResult(self_->exc, port, &self_->bcd_enabletx);
+
+    TR_ASSERT(self_->base->ucs_user_ptr, "[BCD]", ret_val == UCS_RET_SUCCESS);
+    return ret_val;
+}
+
+
+
+
+/*!
+ * @}
+ * \endcond
+ */
+
+/*------------------------------------------------------------------------------------------------*/
+/* End of file                                                                                    */
+/*------------------------------------------------------------------------------------------------*/
+