Skip to content

Commit

Permalink
Fix logic in CheckStartStateBoundsAdapter
Browse files Browse the repository at this point in the history
  • Loading branch information
sea-bass committed Nov 30, 2024
1 parent e7872eb commit 1c85808
Showing 1 changed file with 3 additions and 3 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -101,7 +101,7 @@ class CheckStartStateBounds : public planning_interface::PlanningRequestAdapter
// it is within the model's declared bounds (usually -Pi, Pi), since the values wrap around.
// It is possible that the encoder maintains values outside the range [-Pi, Pi], to inform
// how many times the joint was wrapped. Because of this, we remember the offsets for continuous
// joints, and we un-do them when the plan comes from the planner
// joints, and we undo them when the plan comes from the planner.
switch (jmodel->getType())
{
case moveit::core::JointModel::REVOLUTE:
Expand All @@ -115,8 +115,8 @@ class CheckStartStateBounds : public planning_interface::PlanningRequestAdapter
{
changed_req = true;
}
break;
}
break;
}
// Normalize yaw; no offset needs to be remembered
case moveit::core::JointModel::PLANAR:
Expand Down Expand Up @@ -170,7 +170,7 @@ class CheckStartStateBounds : public planning_interface::PlanningRequestAdapter
}
}

// If we made any changes, consider using them them
// If we made any changes, consider using them.
if (params.fix_start_state && changed_req)
{
RCLCPP_WARN(logger_, "Changing start state.");
Expand Down

0 comments on commit 1c85808

Please sign in to comment.