Biorbd
Release_1.13.0
Toggle main menu visibility
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
10
using namespace
BIORBD_NAMESPACE;
11
12
internal_forces::muscles::StateDynamicsDeGroote::StateDynamicsDeGroote
(
13
const
utils::Scalar&
excitation
,
14
const
utils::Scalar&
activation
)
15
: internal_forces::muscles::
StateDynamics
(
excitation
,
activation
) {
16
setType
();
17
}
18
19
internal_forces::muscles::StateDynamicsDeGroote::StateDynamicsDeGroote
(
20
const
internal_forces::muscles::StateDynamicsDeGroote
& other)
21
: internal_forces::muscles::
StateDynamics
(other) {}
22
23
internal_forces::muscles::StateDynamicsDeGroote
24
internal_forces::muscles::StateDynamicsDeGroote::DeepCopy
()
const
{
25
internal_forces::muscles::StateDynamicsDeGroote
copy;
26
copy.
DeepCopy
(*
this
);
27
return
copy;
28
}
29
30
void
internal_forces::muscles::StateDynamicsDeGroote::DeepCopy
(
31
const
internal_forces::muscles::StateDynamicsDeGroote
& other) {
32
internal_forces::muscles::StateDynamics::DeepCopy
(other);
33
}
34
35
const
utils::Scalar&
36
internal_forces::muscles::StateDynamicsDeGroote::timeDerivativeActivation
(
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
54
*
m_activationDot
=
55
(((f + 0.5) / denom_activation) + ((-f + 0.5) / denom_deactivation)) *
56
diff;
57
return
*
m_activationDot
;
58
}
59
60
void
internal_forces::muscles::StateDynamicsDeGroote::setType
() {
61
*
m_stateType
= internal_forces::muscles::STATE_TYPE::DE_GROOTE;
62
}
BIORBD_NAMESPACE::internal_forces::muscles::Characteristics
Class Holds that muscle characteristics.
Definition
Characteristics.h:19
BIORBD_NAMESPACE::internal_forces::muscles::Characteristics::torqueActivation
const utils::Scalar & torqueActivation() const
Return the time activation constant.
Definition
Characteristics.cpp:165
BIORBD_NAMESPACE::internal_forces::muscles::Characteristics::torqueDeactivation
const utils::Scalar & torqueDeactivation() const
Return the time deactivation constant.
Definition
Characteristics.cpp:174
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsDeGroote
EMG with the capability to compute the time derivative.
Definition
StateDynamicsDeGroote.h:14
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsDeGroote::StateDynamicsDeGroote
StateDynamicsDeGroote(const utils::Scalar &excitation=0, const utils::Scalar &activation=0)
Construct the state dynamics.
Definition
StateDynamicsDeGroote.cpp:12
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsDeGroote::DeepCopy
StateDynamicsDeGroote DeepCopy() const
Deep copy of state dynamics.
Definition
StateDynamicsDeGroote.cpp:24
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsDeGroote::setType
virtual void setType()
Set the type to simple_state.
Definition
StateDynamicsDeGroote.cpp:60
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamics::timeDerivativeActivation
virtual const utils::Scalar & timeDerivativeActivation()
Return the previously computed activation time derivative.
Definition
StateDynamics.cpp:131
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamics::m_activationDot
std::shared_ptr< utils::Scalar > m_activationDot
The activation velocity.
Definition
StateDynamics.h:137
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamics::DeepCopy
StateDynamics DeepCopy() const
Deep copy of state dynamics.
Definition
StateDynamics.cpp:39
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamics::StateDynamics
StateDynamics(const utils::Scalar &excitation=0, const utils::Scalar &activation=0)
Construct the state dynamics.
Definition
StateDynamics.cpp:14
BIORBD_NAMESPACE::internal_forces::muscles::State::m_stateType
std::shared_ptr< STATE_TYPE > m_stateType
The state type.
Definition
State.h:127
BIORBD_NAMESPACE::internal_forces::muscles::State::m_activation
std::shared_ptr< utils::Scalar > m_activation
The muscle activation.
Definition
State.h:131
BIORBD_NAMESPACE::internal_forces::muscles::State::excitation
const utils::Scalar & excitation() const
Return the muscle excitation.
Definition
State.cpp:61
BIORBD_NAMESPACE::internal_forces::muscles::State::m_excitation
std::shared_ptr< utils::Scalar > m_excitation
The muscle excitation.
Definition
State.h:128
BIORBD_NAMESPACE::internal_forces::muscles::State::activation
const utils::Scalar & activation() const
Return the muscle activation.
Definition
State.cpp:117
src
InternalForces
Muscles
StateDynamicsDeGroote.cpp
Generated by
1.18.0