diff --git a/source/armarx/navigation/components/dynamic_scene_provider/HumanTracker.cpp b/source/armarx/navigation/components/dynamic_scene_provider/HumanTracker.cpp index 030c8b638d15496c62ac6dbb6350b8e8af63a064..ea338135d870ad626ea056e331dbb5bcdc8a82f3 100644 --- a/source/armarx/navigation/components/dynamic_scene_provider/HumanTracker.cpp +++ b/source/armarx/navigation/components/dynamic_scene_provider/HumanTracker.cpp @@ -30,8 +30,8 @@ namespace armarx::navigation::components::dynamic_scene_provider const human::Human newHuman = { .global_T_human = pose, - .linearVelocity = Eigen::Vector2f::Zero() //TODO more sophisticated guess - }; + .linearVelocity = Eigen::Vector2f::Zero(), //TODO more sophisticated guess + .detectionTime = measurements.detectionTime}; trackedHumans.push_back(newHuman); } @@ -44,11 +44,16 @@ namespace armarx::navigation::components::dynamic_scene_provider } + std::map<armem::human::HumanPose&, human::Human&> + HumanTracker::getAssociatedHumans(const Measurements& measurements) const + { + } + + void HumanTracker::reset() { trackedHumans.clear(); } - } // namespace armarx::navigation::components::dynamic_scene_provider diff --git a/source/armarx/navigation/components/dynamic_scene_provider/HumanTracker.h b/source/armarx/navigation/components/dynamic_scene_provider/HumanTracker.h index 612db06476c7945f9229203cf2d461f42e5a08a5..209fd345a4fe524937ad83b58970f05d110a957c 100644 --- a/source/armarx/navigation/components/dynamic_scene_provider/HumanTracker.h +++ b/source/armarx/navigation/components/dynamic_scene_provider/HumanTracker.h @@ -30,5 +30,8 @@ namespace armarx::navigation::components::dynamic_scene_provider private: std::vector<human::Human> trackedHumans; + + std::map<armem::human::HumanPose&, human::Human&> + getAssociatedHumans(const Measurements& measurements) const; }; } // namespace armarx::navigation::components::dynamic_scene_provider