Skip to content

Commit 01c1cc1

Browse files
committed
Fixes merge conflicts
1 parent 38299f6 commit 01c1cc1

File tree

1 file changed

+2
-19
lines changed

1 file changed

+2
-19
lines changed

moveit_core/robot_state/src/robot_state.cpp

Lines changed: 2 additions & 19 deletions
Original file line numberDiff line numberDiff line change
@@ -1671,32 +1671,15 @@ bool RobotState::setFromIK(const JointModelGroup* jmg, const EigenSTL::vector_Is
16711671
auto* pose_parent = getRigidlyConnectedParentLinkModel(pose_frame);
16721672
if (!pose_parent)
16731673
{
1674-
RCLCPP_ERROR_STREAM(getLogger(), "The following Pose Frame does not exist: " << pose_frame);
1674+
RCLCPP_ERROR_STREAM(LOGGER, "The following Pose Frame does not exist: " << pose_frame);
16751675
return false;
16761676
}
16771677
Eigen::Isometry3d pose_parent_to_frame = getFrameTransform(pose_frame);
16781678
auto* tip_parent = getRigidlyConnectedParentLinkModel(solver_tip_frame);
16791679
if (!tip_parent)
16801680
{
1681-
<<<<<<< HEAD
1682-
const moveit::core::LinkModel* link_model = getLinkModel(pose_frame);
1683-
if (!link_model)
1684-
{
1685-
RCLCPP_ERROR(LOGGER, "The following Pose Frame does not exist: %s", pose_frame.c_str());
1686-
return false;
1687-
}
1688-
const moveit::core::LinkTransformMap& fixed_links = link_model->getAssociatedFixedTransforms();
1689-
for (const std::pair<const LinkModel* const, Eigen::Isometry3d>& fixed_link : fixed_links)
1690-
if (Transforms::sameFrame(fixed_link.first->getName(), solver_tip_frame))
1691-
{
1692-
pose_frame = solver_tip_frame;
1693-
pose = pose * fixed_link.second;
1694-
break;
1695-
}
1696-
=======
1697-
RCLCPP_ERROR_STREAM(getLogger(), "The following Solver Tip Frame does not exist: " << solver_tip_frame);
1681+
RCLCPP_ERROR_STREAM(LOGGER, "The following Solver Tip Frame does not exist: " << solver_tip_frame);
16981682
return false;
1699-
>>>>>>> ab34495d2 (Allow RobotState::setFromIK to work with subframes (#3077))
17001683
}
17011684
Eigen::Isometry3d tip_parent_to_tip = getFrameTransform(solver_tip_frame);
17021685
if (pose_parent == tip_parent)

0 commit comments

Comments
 (0)