Biorbd Release_1.13.0
Loading...
Searching...
No Matches
KalmanReconsMarkers.h
1#ifndef BIORBD_RIGIDBODY_KALMAN_RECONS_MARKERS_HPP
2#define BIORBD_RIGIDBODY_KALMAN_RECONS_MARKERS_HPP
3
4#include "biorbdConfig.h"
5
6#include "RigidBody/KalmanRecons.h"
7
8namespace BIORBD_NAMESPACE {
9namespace rigidbody {
10class Markers;
11class NodeSegment;
12
17class BIORBD_API KalmanReconsMarkers : public KalmanRecons {
18 public:
19 // Constructor
20
26
34
40
45 void DeepCopy(const KalmanReconsMarkers &other);
46
57 virtual void reconstructFrame(
58 Model &model,
59 const Markers &Tobs,
63 bool removeAxes = true);
64
75 virtual void reconstructFrame(
76 Model &model,
77 const std::vector<NodeSegment> &Tobs,
81 bool removeAxes = true);
82
93 virtual void reconstructFrame(
94 Model &model,
95 const utils::Vector &Tobs,
96 GeneralizedCoordinates *Q = nullptr,
97 GeneralizedVelocity *Qdot = nullptr,
98 GeneralizedAcceleration *Qddot = nullptr,
99 bool removeAxes = true);
100
104 virtual void reconstructFrame();
105
110 bool first();
111
112 protected:
116 virtual void initialize();
117
125 utils::Matrix &InvTp,
126 utils::Vector &measure,
127 const std::vector<size_t> &occlusion);
128
129 std::shared_ptr<utils::Matrix> m_PpInitial;
130 std::shared_ptr<bool> m_firstIteration;
131};
132
133} // namespace rigidbody
134} // namespace BIORBD_NAMESPACE
135
136#endif // BIORBD_RIGIDBODY_KALMAN_RECONS_MARKERS_HPP
The actual musculoskeletal model that holds everything in biorbd.
Parameters of the reconstruction.
std::shared_ptr< utils::Matrix > m_PpInitial
Initial covariance matrix.
KalmanReconsMarkers DeepCopy() const
Deep copy of the Kalman reconstruction.
virtual void initialize()
Initialization of the filter.
KalmanReconsMarkers()
Initialize the Kalman filter and Kalman reconstruction for Markers data.
virtual void manageOcclusionDuringIteration(utils::Matrix &InvTp, utils::Vector &measure, const std::vector< size_t > &occlusion)
Manage the occlusion during the iteration.
virtual void reconstructFrame(Model &model, const Markers &Tobs, GeneralizedCoordinates *Q, GeneralizedVelocity *Qdot, GeneralizedAcceleration *Qddot, bool removeAxes=true)
Reconstruct the kinematics from markers data.
bool first()
Return if the first iteration was done.
std::shared_ptr< bool > m_firstIteration
If first iteration was done.
Holder for the marker set.
Definition Markers.h:26
A point attached to a segment, generally speaking a skin marker.
Definition NodeSegment.h:20
A wrapper for the Eigen::MatrixXd.
Definition Matrix.h:18
Wrapper of the Eigen VectorXd.
Definition Vector.h:21