diff --git a/moveit_ros/moveit_servo/src/utils/common.cpp b/moveit_ros/moveit_servo/src/utils/common.cpp index 971972dcd7..e2f52ee0eb 100644 --- a/moveit_ros/moveit_servo/src/utils/common.cpp +++ b/moveit_ros/moveit_servo/src/utils/common.cpp @@ -446,8 +446,6 @@ std::vector jointVariablesToHalt(const Eigen::VectorXd& positions, const } } } - - ++joint_idx; } return variable_indices_to_halt; }