diff --git a/source/RobotAPI/components/units/RobotUnit/NJointControllers/NJointHolonomicPlatformVelocityControllerWithRamp.cpp b/source/RobotAPI/components/units/RobotUnit/NJointControllers/NJointHolonomicPlatformVelocityControllerWithRamp.cpp index 92ee52c4340c573a5b069b06511ecef51085f7cc..2d06696ea496f1f30deab1dded6d5b3a64c43172 100644 --- a/source/RobotAPI/components/units/RobotUnit/NJointControllers/NJointHolonomicPlatformVelocityControllerWithRamp.cpp +++ b/source/RobotAPI/components/units/RobotUnit/NJointControllers/NJointHolonomicPlatformVelocityControllerWithRamp.cpp @@ -92,10 +92,20 @@ namespace armarx rtGetControlStruct().velocityY, rtGetControlStruct().velocityRotation); - Eigen::VectorXf result = ramp.update(x, timeSinceLastIteration.toSecondsDouble()); - target->velocityX = result(0); - target->velocityY = result(1); - target->velocityRotation = result(2); + if (x == Eigen::Vector3f::Zero()) + { + target->velocityX = 0; + target->velocityY = 0; + target->velocityRotation = 0; + } + else + { + + Eigen::VectorXf result = ramp.update(x, timeSinceLastIteration.toSecondsDouble()); + target->velocityX = result(0); + target->velocityY = result(1); + target->velocityRotation = result(2); + } } } diff --git a/source/RobotAPI/components/units/RobotUnit/RobotUnitModules/RobotUnitModuleUnits.cpp b/source/RobotAPI/components/units/RobotUnit/RobotUnitModules/RobotUnitModuleUnits.cpp index 80c426cc938f4d9e3ee9f70ab287b50a0bbbac05..34168e9a242f8c43da13eb43e2a809594ebbc226 100644 --- a/source/RobotAPI/components/units/RobotUnit/RobotUnitModules/RobotUnitModuleUnits.cpp +++ b/source/RobotAPI/components/units/RobotUnit/RobotUnitModules/RobotUnitModuleUnits.cpp @@ -502,8 +502,10 @@ namespace armarx::RobotUnitModule } else { - ARMARX_ERROR << "Invalid Platform velocity controller specified " - << ""; //platformControllerType; + ARMARX_ERROR << "Invalid Platform velocity controller specified '" + << NJointHolonomicPlatformVelocityControllerTypesNames.to_name( + platformControllerType) + << "'"; } NJointHolonomicPlatformRelativePositionControllerConfigPtr configRelativePositionCtrlCfg =