Biorbd Release_1.13.0
Loading...
Searching...
No Matches
StateDynamicsDeGroote.cpp
1#define BIORBD_API_EXPORTS
2#include "InternalForces/Muscles/StateDynamicsDeGroote.h"
3
4#include <math.h>
5
6#include "InternalForces/Muscles/Characteristics.h"
7#include "Utils/Error.h"
8#include "Utils/String.h"
9
10using namespace BIORBD_NAMESPACE;
11
13 const utils::Scalar& excitation,
14 const utils::Scalar& activation)
15 : internal_forces::muscles::StateDynamics(excitation, activation) {
16 setType();
17}
18
22
29
34
35const utils::Scalar&
37 const internal_forces::muscles::Characteristics& characteristics,
38 bool alreadyNormalized) {
39 // From DeGroote https://www.ncbi.nlm.nih.gov/pmc/articles/PMC5043004/
40
41 // Get activation and excitation and make difference
42 utils::Scalar diff; //(e - a)
43 utils::Scalar f; // activation dynamics
44 // std::tanh;
45
46 diff = *m_excitation - *m_activation;
47 f = 0.5 * tanh(0.1 * diff);
48
49 utils::Scalar denom_activation =
50 characteristics.torqueActivation() * (0.5 + 1.5 * *m_activation);
51 utils::Scalar denom_deactivation =
52 characteristics.torqueDeactivation() / (0.5 + 1.5 * *m_activation);
53
55 (((f + 0.5) / denom_activation) + ((-f + 0.5) / denom_deactivation)) *
56 diff;
57 return *m_activationDot;
58}
59
61 *m_stateType = internal_forces::muscles::STATE_TYPE::DE_GROOTE;
62}
const utils::Scalar & torqueActivation() const
Return the time activation constant.
const utils::Scalar & torqueDeactivation() const
Return the time deactivation constant.
EMG with the capability to compute the time derivative.
StateDynamicsDeGroote(const utils::Scalar &excitation=0, const utils::Scalar &activation=0)
Construct the state dynamics.
StateDynamicsDeGroote DeepCopy() const
Deep copy of state dynamics.
virtual const utils::Scalar & timeDerivativeActivation()
Return the previously computed activation time derivative.
std::shared_ptr< utils::Scalar > m_activationDot
The activation velocity.
StateDynamics DeepCopy() const
Deep copy of state dynamics.
StateDynamics(const utils::Scalar &excitation=0, const utils::Scalar &activation=0)
Construct the state dynamics.
std::shared_ptr< STATE_TYPE > m_stateType
The state type.
Definition State.h:127
std::shared_ptr< utils::Scalar > m_activation
The muscle activation.
Definition State.h:131
const utils::Scalar & excitation() const
Return the muscle excitation.
Definition State.cpp:61
std::shared_ptr< utils::Scalar > m_excitation
The muscle excitation.
Definition State.h:128
const utils::Scalar & activation() const
Return the muscle activation.
Definition State.cpp:117