diff --git a/source/RobotAPI/libraries/armem_robot_state/common/localization/TransformHelper.cpp b/source/RobotAPI/libraries/armem_robot_state/common/localization/TransformHelper.cpp index c8db83835ccc53f21e416b723745892a1455f801..5a3a4a0d4abd221dd9ce8385fbce98a747f36c09 100644 --- a/source/RobotAPI/libraries/armem_robot_state/common/localization/TransformHelper.cpp +++ b/source/RobotAPI/libraries/armem_robot_state/common/localization/TransformHelper.cpp @@ -284,14 +284,17 @@ namespace armarx::armem::common::robot_state::localization std::vector<::armarx::armem::robot_state::Transform> transforms; transforms.reserve(entity.history().size()); - const auto entitySnapshots = simox::alg::get_values(entity.history()); + // const auto entitySnapshots = simox::alg::get_values(entity.history()); + + const std::vector<wm::EntitySnapshot> entitySnapshots = {entity.getLatestSnapshot()}; + std::transform( entitySnapshots.begin(), entitySnapshots.end(), std::back_inserter(transforms), - [](const auto & entity) + [](const auto & entitySnapshot) { - return convertEntityToTransform(entity.getInstance(0)); + return convertEntityToTransform(entitySnapshot.getInstance(0)); }); ARMARX_DEBUG << "obtaining transform";