Added NMT reset callbacks, patch from Edward

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

diff --git a/src/nmtSlave.c b/src/nmtSlave.c
index ff883bddeb5c48ee009d9d9b31cfb8a8039585dc..e9bce15609f1a3bf66cacc0a1b7d63b7b8da7b3c 100644 (file)
--- a/src/nmtSlave.c
+++ b/src/nmtSlave.c
@@ -73,6 +73,8 @@ 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);
@@ -81,6 +83,8 @@ void proceedNMTstateChange(CO_Data* d, Message *m)
         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);