From 1047ef08a4af15515bfd37ea70212bfc6b60baaa Mon Sep 17 00:00:00 2001 From: Robert Haschke Date: Wed, 20 Feb 2019 11:15:05 +0100 Subject: [PATCH] ComputeIK: fix typo --- core/src/stages/compute_ik.cpp | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/core/src/stages/compute_ik.cpp b/core/src/stages/compute_ik.cpp index 879b4947..8026582d 100644 --- a/core/src/stages/compute_ik.cpp +++ b/core/src/stages/compute_ik.cpp @@ -313,11 +313,11 @@ void ComputeIK::compute() marker.color.a *= 0.5; failure_markers.push_back(marker); }; - const auto& link_to_visualize = moveit::core::RobotModel::getRigidlyConnectedParentLinkModel(link) + const auto& links_to_visualize = moveit::core::RobotModel::getRigidlyConnectedParentLinkModel(link) ->getParentJointModel()->getDescendantLinkModels(); if (colliding) { SubTrajectory solution; - generateCollisionMarkers(sandbox_state, appender, link_to_visualize); + generateCollisionMarkers(sandbox_state, appender, links_to_visualize); std::copy(failure_markers.begin(), failure_markers.end(), std::back_inserter(solution.markers())); solution.markAsFailure(); // TODO: visualize collisions @@ -325,7 +325,7 @@ void ComputeIK::compute() spawn(InterfaceState(sandbox_scene), std::move(solution)); return; } else - generateVisualMarkers(sandbox_state, appender, link_to_visualize); + generateVisualMarkers(sandbox_state, appender, links_to_visualize); // determine joint values of robot pose to compare IK solution with for costs