diff --git a/moveit_core/kinematic_constraints/src/utils.cpp b/moveit_core/kinematic_constraints/src/utils.cpp index 7a18428a52a..12c96bd9329 100644 --- a/moveit_core/kinematic_constraints/src/utils.cpp +++ b/moveit_core/kinematic_constraints/src/utils.cpp @@ -155,8 +155,8 @@ moveit_msgs::msg::Constraints constructGoalConstraints(const moveit::core::Robot { goal.joint_constraints[i].joint_name = jmg->getVariableNames()[i]; goal.joint_constraints[i].position = vals[i]; - goal.joint_constraints[i].tolerance_above = tolerance_below; - goal.joint_constraints[i].tolerance_below = tolerance_above; + goal.joint_constraints[i].tolerance_above = tolerance_above; + goal.joint_constraints[i].tolerance_below = tolerance_below; goal.joint_constraints[i].weight = 1.0; }