Biorbd
Release_1.13.0
Toggle main menu visibility
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
8
namespace
BIORBD_NAMESPACE {
9
namespace
rigidbody {
10
class
Markers
;
11
class
NodeSegment
;
12
17
class
BIORBD_API
KalmanReconsMarkers
:
public
KalmanRecons
{
18
public
:
19
// Constructor
20
25
KalmanReconsMarkers
();
26
33
KalmanReconsMarkers
(
Model
&model,
KalmanParam
params =
KalmanParam
());
34
39
KalmanReconsMarkers
DeepCopy
()
const
;
40
45
void
DeepCopy
(
const
KalmanReconsMarkers
&other);
46
57
virtual
void
reconstructFrame
(
58
Model
&model,
59
const
Markers
&Tobs,
60
GeneralizedCoordinates
*Q,
61
GeneralizedVelocity
*Qdot,
62
GeneralizedAcceleration
*Qddot,
63
bool
removeAxes =
true
);
64
75
virtual
void
reconstructFrame
(
76
Model
&model,
77
const
std::vector<NodeSegment> &Tobs,
78
GeneralizedCoordinates
*Q,
79
GeneralizedVelocity
*Qdot,
80
GeneralizedAcceleration
*Qddot,
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
124
virtual
void
manageOcclusionDuringIteration
(
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
BIORBD_NAMESPACE::Model
The actual musculoskeletal model that holds everything in biorbd.
Definition
BiorbdModel.h:101
BIORBD_NAMESPACE::rigidbody::GeneralizedAcceleration
Class GeneralizedAcceleration.
Definition
GeneralizedAcceleration.h:15
BIORBD_NAMESPACE::rigidbody::GeneralizedCoordinates
Class GeneralizedCoordinates.
Definition
GeneralizedCoordinates.h:15
BIORBD_NAMESPACE::rigidbody::GeneralizedVelocity
Class GeneralizedVelocity.
Definition
GeneralizedVelocity.h:15
BIORBD_NAMESPACE::rigidbody::KalmanParam
Parameters of the reconstruction.
Definition
KalmanRecons.h:25
BIORBD_NAMESPACE::rigidbody::KalmanReconsMarkers::m_PpInitial
std::shared_ptr< utils::Matrix > m_PpInitial
Initial covariance matrix.
Definition
KalmanReconsMarkers.h:129
BIORBD_NAMESPACE::rigidbody::KalmanReconsMarkers::DeepCopy
KalmanReconsMarkers DeepCopy() const
Deep copy of the Kalman reconstruction.
Definition
KalmanReconsMarkers.cpp:35
BIORBD_NAMESPACE::rigidbody::KalmanReconsMarkers::initialize
virtual void initialize()
Initialization of the filter.
Definition
KalmanReconsMarkers.cpp:49
BIORBD_NAMESPACE::rigidbody::KalmanReconsMarkers::KalmanReconsMarkers
KalmanReconsMarkers()
Initialize the Kalman filter and Kalman reconstruction for Markers data.
Definition
KalmanReconsMarkers.cpp:20
BIORBD_NAMESPACE::rigidbody::KalmanReconsMarkers::manageOcclusionDuringIteration
virtual void manageOcclusionDuringIteration(utils::Matrix &InvTp, utils::Vector &measure, const std::vector< size_t > &occlusion)
Manage the occlusion during the iteration.
Definition
KalmanReconsMarkers.cpp:56
BIORBD_NAMESPACE::rigidbody::KalmanReconsMarkers::reconstructFrame
virtual void reconstructFrame(Model &model, const Markers &Tobs, GeneralizedCoordinates *Q, GeneralizedVelocity *Qdot, GeneralizedAcceleration *Qddot, bool removeAxes=true)
Reconstruct the kinematics from markers data.
Definition
KalmanReconsMarkers.cpp:70
BIORBD_NAMESPACE::rigidbody::KalmanReconsMarkers::first
bool first()
Return if the first iteration was done.
Definition
KalmanReconsMarkers.cpp:68
BIORBD_NAMESPACE::rigidbody::KalmanReconsMarkers::m_firstIteration
std::shared_ptr< bool > m_firstIteration
If first iteration was done.
Definition
KalmanReconsMarkers.h:130
BIORBD_NAMESPACE::rigidbody::KalmanRecons::KalmanRecons
KalmanRecons()
Kalman reconstruction.
Definition
KalmanRecons.cpp:13
BIORBD_NAMESPACE::rigidbody::Markers
Holder for the marker set.
Definition
Markers.h:26
BIORBD_NAMESPACE::rigidbody::NodeSegment
A point attached to a segment, generally speaking a skin marker.
Definition
NodeSegment.h:20
BIORBD_NAMESPACE::utils::Matrix
A wrapper for the Eigen::MatrixXd.
Definition
Matrix.h:18
BIORBD_NAMESPACE::utils::Vector
Wrapper of the Eigen VectorXd.
Definition
Vector.h:21
include
RigidBody
KalmanReconsMarkers.h
Generated by
1.18.0