Add initialization of NJointTaskSpaceImpedanceDMPController::controllerSensorData

source/RobotAPI/libraries/RobotAPINJointControllers/DMPController/NJointTaskSpaceImpedanceDMPController.cpp

@@ -84,6 +84,13 @@ namespace armarx
         NJointTaskSpaceImpedanceDMPControllerInterfaceData initInterfaceData;
         initInterfaceData.currentTcpPose = Eigen::Matrix4f::Identity();
         interfaceData.reinitAllBuffers(initInterfaceData);
+
+        NJointTaskSpaceImpedanceDMPControllerSensorData initControllerSensorData;
+        initControllerSensorData.currentPose = Eigen::Matrix4f::Identity();
+        initControllerSensorData.currentTime = 0;
+        initControllerSensorData.deltaT = 0;
+        initControllerSensorData.currentTwist.setZero();
+        controllerSensorData.reinitAllBuffers(initControllerSensorData);
     }
 
     std::string NJointTaskSpaceImpedanceDMPController::getClassName(const Ice::Current&) const