Added NMT reset callbacks, patch from Edward

[CanFestival-3.git] / src / nmtSlave.c

diff --git a/src/nmtSlave.c b/src/nmtSlave.c
index 99f131b335adf88d4200812b6d8cc594387c2981..e9bce15609f1a3bf66cacc0a1b7d63b7b8da7b3c 100644 (file)
--- a/src/nmtSlave.c
+++ b/src/nmtSlave.c
@@ -73,10 +73,22 @@ void proceedNMTstateChange(CO_Data* d, Message *m)
         break;
 
       case NMT_Reset_Node:
+         if(d->NMT_Slave_Node_Reset_Callback != NULL)
+            d->NMT_Slave_Node_Reset_Callback(d);
+#ifdef CO_ENABLE_LSS
+               if(getNodeId(d)!=d->lss_transfer.nodeID)
+                       setNodeId(d, d->lss_transfer.nodeID);
+#endif
         setState(d,Initialisation);
         break;
 
       case NMT_Reset_Comunication:
+         if(d->NMT_Slave_Communications_Reset_Callback != NULL)
+            d->NMT_Slave_Communications_Reset_Callback(d);
+#ifdef CO_ENABLE_LSS
+               if(getNodeId(d)!=d->lss_transfer.nodeID && getNodeId(d)>0 && getNodeId(d)<=127)
+                       setNodeId(d, d->lss_transfer.nodeID);
+#endif
         setState(d,Initialisation);
         break;