Biorbd Release_1.13.0
Loading...
Searching...
No Matches
KalmanReconsIMU.h
1#ifndef BIORBD_RIGIDBODY_KALMAN_RECONS_IMU_H
2#define BIORBD_RIGIDBODY_KALMAN_RECONS_IMU_H
3
4#include "biorbdConfig.h"
5
6#include "RigidBody/KalmanRecons.h"
7
8namespace BIORBD_NAMESPACE {
9namespace utils {
10class RotoTrans;
11}
12
13namespace rigidbody {
14class IMU;
15
20class BIORBD_API KalmanReconsIMU : public KalmanRecons {
21 public:
22 // Constructor
28
36 Model &model,
37 KalmanParam params = KalmanParam(100, 0.005, 1e-10));
38
45
51 void DeepCopy(const KalmanReconsIMU &other);
52
53 // Reconstruction of a frame
54
63 virtual void reconstructFrame(
64 Model &model,
65 const std::vector<IMU> &IMUobs,
69
79 virtual void reconstructFrame(
80 Model &model,
81 const utils::Vector &IMUobs,
85
89 virtual void reconstructFrame();
90
95 bool first();
96
97 protected:
105 utils::Matrix &InvTp,
106 utils::Vector &measure,
107 const std::vector<size_t> &occlusion);
108
109 std::shared_ptr<bool> m_firstIteration;
110};
111
112} // namespace rigidbody
113} // namespace BIORBD_NAMESPACE
114
115#endif // BIORBD_RIGIDBODY_KALMAN_RECONS_IMU_H
The actual musculoskeletal model that holds everything in biorbd.
Parameters of the reconstruction.
virtual void reconstructFrame(Model &model, const std::vector< IMU > &IMUobs, GeneralizedCoordinates *Q, GeneralizedVelocity *Qdot, GeneralizedAcceleration *Qddot)
Proceed to one iteration of the Kalman filter.
KalmanReconsIMU DeepCopy() const
Deep copy of the Kalman reconstruction from inertial measurement units (IMU) data.
bool first()
Return if the first iteration was done.
KalmanReconsIMU()
Initialize the Kalman filter and kalman reconstruction for inertial measurement units (IMU) data.
std::shared_ptr< bool > m_firstIteration
If first iteration was done.
virtual void manageOcclusionDuringIteration(utils::Matrix &InvTp, utils::Vector &measure, const std::vector< size_t > &occlusion)
Manage the occlusion during the iteration.
A wrapper for the Eigen::MatrixXd.
Definition Matrix.h:18
Homogenous matrix to describe translations and rotations simultaneously.
Definition RotoTrans.h:33
Wrapper of the Eigen VectorXd.
Definition Vector.h:21