util.h

Go to the documentation of this file.

#pragma once
 
#include "types.h"
 
#include <optional>
#include <string>
 
#include <ArmarXCore/core/application/properties/forward_declarations.h>
 
namespace armarx::armem::human
{
    enum KeyPointCoordinateSystem
    {
        Camera, Global, GlobalFloorProjection, Robot
    };
 
    std::optional<Eigen::Vector3f> 
    computeMeanPosition(const HumanPose &humanPose,
                        KeyPointCoordinateSystem coordSystem = KeyPointCoordinateSystem::Camera);
                        
    struct NearestHumanParameters
    {
        struct Properties
        {
            Eigen::Vector3f positionMM = Eigen::Vector3f::Zero();
            KeyPointCoordinateSystem coordSystem = KeyPointCoordinateSystem::Camera;
            double distanceThresholdMM = -1.0;
            std::string modelIDs = std::string();
 
            void addTo(armarx::PropertyDefinitionsPtr &def,
                       const std::string &prefix = std::string());
 
        } properties;
 
        void updateFromProperties();
 
        Eigen::Vector3f positionMM = Eigen::Vector3f::Zero();
        KeyPointCoordinateSystem coordSystem = KeyPointCoordinateSystem::Camera;
        std::optional<double> distanceThresholdMM = std::nullopt;
        std::set<std::string> modelIDs = std::set<std::string>();
    };
 
    std::optional<HumanPose>
    getNearestHuman(const std::vector<HumanPose> &humanPoses, 
                    const NearestHumanParameters &parameters = NearestHumanParameters());
 
} // namespace armarx::armem::human