From 8c2a359367322a704af45989bc8ed0c3e78cd118 Mon Sep 17 00:00:00 2001 From: Jose Luis Blanco-Claraco Date: Fri, 19 Apr 2024 19:49:10 +0200 Subject: [PATCH] Fix usage of (new explicit) TPoint3D constructors --- mrpt_path_planning/src/algos/render_tree.cpp | 13 ++++++------- 1 file changed, 6 insertions(+), 7 deletions(-) diff --git a/mrpt_path_planning/src/algos/render_tree.cpp b/mrpt_path_planning/src/algos/render_tree.cpp index 38e85b4..fccf0ad 100644 --- a/mrpt_path_planning/src/algos/render_tree.cpp +++ b/mrpt_path_planning/src/algos/render_tree.cpp @@ -29,7 +29,8 @@ auto mpp::render_tree( ret->setName("render_tree"); auto& scene = *ret; - const auto poseHeight = [&ro](const mrpt::poses::CPose3D& p) { + const auto poseHeight = [&ro](const mrpt::poses::CPose3D& p) + { if (ro.phi2z_scale == 0) return p; else @@ -39,7 +40,8 @@ auto mpp::render_tree( return r; } }; - const auto poseHeightT = [&ro](const mrpt::math::TPose3D& p) { + const auto poseHeightT = [&ro](const mrpt::math::TPose3D& p) + { if (ro.phi2z_scale == 0) return p; else @@ -377,13 +379,10 @@ auto mpp::render_tree( obj->setName("GOAL"); obj->enableShowName(); obj->setColor_u8(ro.color_goal); - obj->setLocation(pi.stateGoal.state.point()); + obj->setLocation(mrpt::math::TPoint3D(pi.stateGoal.state.point())); scene.insert(obj); } - else - { - THROW_EXCEPTION("Unknown type for goal.state"); - } + else { THROW_EXCEPTION("Unknown type for goal.state"); } // Log msg: if (!ro.log_msg.empty())