KalmanReconsMarkers.h

#ifndef BIORBD_RIGIDBODY_KALMAN_RECONS_MARKERS_HPP
#define BIORBD_RIGIDBODY_KALMAN_RECONS_MARKERS_HPP
 
#include "biorbdConfig.h"
#include "RigidBody/KalmanRecons.h"
 
 
namespace biorbd {
namespace rigidbody {
class Markers;
class NodeSegment;
 
class BIORBD_API KalmanReconsMarkers : public biorbd::rigidbody::KalmanRecons
{
public:
 
    // Constructor
 
    KalmanReconsMarkers();
 
    KalmanReconsMarkers(
            biorbd::Model& model,
            biorbd::rigidbody::KalmanParam params = biorbd::rigidbody::KalmanParam());
 
    biorbd::rigidbody::KalmanReconsMarkers DeepCopy() const;
 
    void DeepCopy(const biorbd::rigidbody::KalmanReconsMarkers& other);
 
    virtual void reconstructFrame(
            biorbd::Model &model,
            const biorbd::rigidbody::Markers &Tobs,
            biorbd::rigidbody::GeneralizedCoordinates *Q,
            biorbd::rigidbody::GeneralizedVelocity *Qdot,
            biorbd::rigidbody::GeneralizedAcceleration *Qddot,
            bool removeAxes=true);
 
    virtual void reconstructFrame(
            biorbd::Model &model,
            const std::vector<biorbd::rigidbody::NodeSegment> &Tobs,
            biorbd::rigidbody::GeneralizedCoordinates *Q,
            biorbd::rigidbody::GeneralizedVelocity *Qdot,
            biorbd::rigidbody::GeneralizedAcceleration *Qddot,
            bool removeAxes=true);
 
    virtual void reconstructFrame(
            biorbd::Model &model,
            const biorbd::utils::Vector &Tobs,
            biorbd::rigidbody::GeneralizedCoordinates *Q = nullptr,
            biorbd::rigidbody::GeneralizedVelocity *Qdot = nullptr,
            biorbd::rigidbody::GeneralizedAcceleration *Qddot = nullptr,
            bool removeAxes=true);
 
    virtual void reconstructFrame();
 
    bool first();
 
protected:
    virtual void initialize();
 
    virtual void manageOcclusionDuringIteration(
            biorbd::utils::Matrix& InvTp,
            biorbd::utils::Vector &measure,
            const std::vector<unsigned int> &occlusion);
 
    std::shared_ptr<biorbd::utils::Matrix> m_PpInitial; 
    std::shared_ptr<bool> m_firstIteration; 
};
 
}}
 
#endif // BIORBD_RIGIDBODY_KALMAN_RECONS_MARKERS_HPP