diff --git a/source/armarx/navigation/components/dynamic_scene_provider/HumanTracker.cpp b/source/armarx/navigation/components/dynamic_scene_provider/HumanTracker.cpp index a63f8a30c6dcf00575f2e8252605a008db584468..4adc1106292ecb0d7c94f39579caf15abec8e132 100644 --- a/source/armarx/navigation/components/dynamic_scene_provider/HumanTracker.cpp +++ b/source/armarx/navigation/components/dynamic_scene_provider/HumanTracker.cpp @@ -3,6 +3,7 @@ #include "ArmarXCore/core/exceptions/local/ExpressionException.h" +#include <armarx/navigation/conversions/eigen.h> #include <range/v3/range/conversion.hpp> #include <range/v3/view/transform.hpp> @@ -29,7 +30,7 @@ namespace armarx::navigation::components::dynamic_scene_provider centerPos /= size; core::Pose2D pose = core::Pose2D::Identity(); - pose.translation() = centerPos.head(2); + pose.translation() = conv::to2D(centerPos); //TODO: angle pose.linear() = Eigen::Rotation2Df(0).toRotationMatrix();