Biorbd
Release_1.13.0
Toggle main menu visibility
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
8
namespace
BIORBD_NAMESPACE {
9
namespace
utils {
10
class
RotoTrans
;
11
}
12
13
namespace
rigidbody {
14
class
IMU
;
15
20
class
BIORBD_API
KalmanReconsIMU
:
public
KalmanRecons
{
21
public
:
22
// Constructor
27
KalmanReconsIMU
();
28
35
KalmanReconsIMU
(
36
Model
&model,
37
KalmanParam
params =
KalmanParam
(100, 0.005, 1e-10));
38
44
KalmanReconsIMU
DeepCopy
()
const
;
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,
66
GeneralizedCoordinates
*Q,
67
GeneralizedVelocity
*Qdot,
68
GeneralizedAcceleration
*Qddot);
69
79
virtual
void
reconstructFrame
(
80
Model
&model,
81
const
utils::Vector
&IMUobs,
82
GeneralizedCoordinates
*Q,
83
GeneralizedVelocity
*Qdot,
84
GeneralizedAcceleration
*Qddot);
85
89
virtual
void
reconstructFrame
();
90
95
bool
first
();
96
97
protected
:
104
virtual
void
manageOcclusionDuringIteration
(
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
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::IMU
Class IMU.
Definition
IMU.h:25
BIORBD_NAMESPACE::rigidbody::KalmanParam
Parameters of the reconstruction.
Definition
KalmanRecons.h:25
BIORBD_NAMESPACE::rigidbody::KalmanReconsIMU::reconstructFrame
virtual void reconstructFrame(Model &model, const std::vector< IMU > &IMUobs, GeneralizedCoordinates *Q, GeneralizedVelocity *Qdot, GeneralizedAcceleration *Qddot)
Proceed to one iteration of the Kalman filter.
Definition
KalmanReconsIMU.cpp:58
BIORBD_NAMESPACE::rigidbody::KalmanReconsIMU::DeepCopy
KalmanReconsIMU DeepCopy() const
Deep copy of the Kalman reconstruction from inertial measurement units (IMU) data.
Definition
KalmanReconsIMU.cpp:32
BIORBD_NAMESPACE::rigidbody::KalmanReconsIMU::first
bool first()
Return if the first iteration was done.
Definition
KalmanReconsIMU.cpp:56
BIORBD_NAMESPACE::rigidbody::KalmanReconsIMU::KalmanReconsIMU
KalmanReconsIMU()
Initialize the Kalman filter and kalman reconstruction for inertial measurement units (IMU) data.
Definition
KalmanReconsIMU.cpp:19
BIORBD_NAMESPACE::rigidbody::KalmanReconsIMU::m_firstIteration
std::shared_ptr< bool > m_firstIteration
If first iteration was done.
Definition
KalmanReconsIMU.h:109
BIORBD_NAMESPACE::rigidbody::KalmanReconsIMU::manageOcclusionDuringIteration
virtual void manageOcclusionDuringIteration(utils::Matrix &InvTp, utils::Vector &measure, const std::vector< size_t > &occlusion)
Manage the occlusion during the iteration.
Definition
KalmanReconsIMU.cpp:44
BIORBD_NAMESPACE::rigidbody::KalmanRecons::KalmanRecons
KalmanRecons()
Kalman reconstruction.
Definition
KalmanRecons.cpp:13
BIORBD_NAMESPACE::utils::Matrix
A wrapper for the Eigen::MatrixXd.
Definition
Matrix.h:18
BIORBD_NAMESPACE::utils::RotoTrans
Homogenous matrix to describe translations and rotations simultaneously.
Definition
RotoTrans.h:33
BIORBD_NAMESPACE::utils::Vector
Wrapper of the Eigen VectorXd.
Definition
Vector.h:21
include
RigidBody
KalmanReconsIMU.h
Generated by
1.18.0