maybe_named_landmark_pair.h

Go to the documentation of this file.

#pragma once
 
#include <libopynsim/utilities/landmark_pair_3d.h>
#include <libopynsim/utilities/simbody_x_oscar.h>
#include <liboscar/maths/vector.h>
#include <liboscar/utilities/c_string_view.h>
#include <SimTKcommon/SmallMatrix.h>
 
#include <concepts>
#include <optional>
#include <string>
#include <utility>
 
namespace opyn
{
    // a possibly-not-completely-paired landmark
    class MaybeNamedLandmarkPair final {
    public:
        MaybeNamedLandmarkPair(
            std::string name_,
            std::optional<osc::Vector3> maybeSourcePosition,
            std::optional<osc::Vector3> maybeDestinationPosition) :
 
            m_Name{std::move(name_)},
            m_MaybeSourcePosition{maybeSourcePosition},
            m_MaybeDestinationPosition{maybeDestinationPosition}
        {}
 
        osc::CStringView name() const { return m_Name; }
        osc::CStringView getName() const { return name(); }
 
        template<std::convertible_to<std::string_view> StringLike>
        void setName(StringLike&& newName) { m_Name = std::forward<StringLike>(newName); }
 
        bool hasSource() const { return m_MaybeSourcePosition.has_value(); }
        bool hasDestination() const { return m_MaybeDestinationPosition.has_value(); }
        bool isFullyPaired() const { return hasSource() && hasDestination(); }
        std::optional<opyn::LandmarkPair3D<float>> tryGetPairedLocations() const
        {
            if (m_MaybeSourcePosition && m_MaybeDestinationPosition) {
                return opyn::LandmarkPair3D<float>{osc::to<SimTK::fVec3>(*m_MaybeSourcePosition), osc::to<SimTK::fVec3>(*m_MaybeDestinationPosition)};
            }
            else {
                return std::nullopt;
            }
        }
 
        void setDestination(std::optional<osc::Vector3> p) { m_MaybeDestinationPosition = p; }
    private:
        std::string m_Name;
        std::optional<osc::Vector3> m_MaybeSourcePosition;
        std::optional<osc::Vector3> m_MaybeDestinationPosition;
    };
}