Biorbd
Release_1.13.0
Toggle main menu visibility
Loading...
Searching...
No Matches
StateDynamicsBuchanan.cpp
1
#define BIORBD_API_EXPORTS
2
#include "InternalForces/Muscles/StateDynamicsBuchanan.h"
3
4
#include <math.h>
5
6
using namespace
BIORBD_NAMESPACE;
7
8
internal_forces::muscles::StateDynamicsBuchanan::StateDynamicsBuchanan
(
9
const
utils::Scalar& neuralCommand,
10
const
utils::Scalar&
excitation
)
11
: internal_forces::muscles::
StateDynamics
(
excitation
, 0),
12
m_neuralCommand
(std::make_shared<utils::Scalar>(neuralCommand)),
13
m_shapeFactor
(std::make_shared<utils::Scalar>(-3)),
14
m_excitationDot
(std::make_shared<utils::Scalar>(0)) {
15
setType
();
16
// Update activation
17
internal_forces::muscles::StateDynamicsBuchanan::activation
();
18
}
19
20
internal_forces::muscles::StateDynamicsBuchanan::StateDynamicsBuchanan
(
21
const
internal_forces::muscles::State
& other)
22
: internal_forces::muscles::
StateDynamics
(other) {
23
const
auto
& buchanan =
24
dynamic_cast<
const
internal_forces::muscles::StateDynamicsBuchanan
&
>
(
25
other);
26
m_neuralCommand
= buchanan.m_neuralCommand;
27
m_shapeFactor
= buchanan.m_shapeFactor;
28
m_excitationDot
= buchanan.m_excitationDot;
29
}
30
31
internal_forces::muscles::StateDynamicsBuchanan::~StateDynamicsBuchanan
() {
32
// dtor
33
}
34
35
internal_forces::muscles::StateDynamicsBuchanan
36
internal_forces::muscles::StateDynamicsBuchanan::DeepCopy
()
const
{
37
internal_forces::muscles::StateDynamicsBuchanan
copy;
38
copy.
DeepCopy
(*
this
);
39
return
copy;
40
}
41
42
void
internal_forces::muscles::StateDynamicsBuchanan::DeepCopy
(
43
const
internal_forces::muscles::StateDynamicsBuchanan
& other) {
44
internal_forces::muscles::StateDynamics::DeepCopy
(other);
45
*
m_neuralCommand
= *other.
m_neuralCommand
;
46
*
m_shapeFactor
= *other.
m_shapeFactor
;
47
*
m_excitationDot
= *other.
m_excitationDot
;
48
}
49
50
void
internal_forces::muscles::StateDynamicsBuchanan::shapeFactor
(
51
const
utils::Scalar& shape_factor) {
52
*
m_shapeFactor
= shape_factor;
53
54
// Update activation
55
setActivation
(0);
56
}
57
58
const
utils::Scalar&
59
internal_forces::muscles::StateDynamicsBuchanan::shapeFactor
()
const
{
60
return
*
m_shapeFactor
;
61
}
62
63
const
utils::Scalar&
64
internal_forces::muscles::StateDynamicsBuchanan::timeDerivativeExcitation
(
65
const
internal_forces::muscles::Characteristics
& characteristics,
66
bool
alreadyNormalized) {
67
// Move excitation to activation to use properly
68
// internal_forces::muscles::StateDynamics::timeDerivativeActivation
69
utils::Scalar activationTp = *
m_activation
;
70
*
m_activation
= *
m_excitation
;
71
utils::Scalar excitationTp = *
m_excitation
;
72
*
m_excitation
= *
m_neuralCommand
;
73
74
// Compute excitationDot
75
*
m_excitationDot
=
76
internal_forces::muscles::StateDynamics::timeDerivativeActivation
(
77
characteristics, alreadyNormalized);
78
// Set back activationDot to 0 (since it is suppose to calculate
79
// excitationDot)
80
*
m_activationDot
= 0;
81
*
m_excitation
= excitationTp;
82
*
m_activation
= activationTp;
83
84
return
*
m_excitationDot
;
85
}
86
87
void
internal_forces::muscles::StateDynamicsBuchanan::setExcitation
(
88
const
utils::Scalar& val,
89
bool
) {
90
internal_forces::muscles::StateDynamics::setExcitation
(val);
91
92
// Update activation
93
setActivation
(0);
94
}
95
96
void
internal_forces::muscles::StateDynamicsBuchanan::setNeuralCommand
(
97
const
utils::Scalar& val) {
98
*
m_neuralCommand
= val;
99
}
100
101
void
internal_forces::muscles::StateDynamicsBuchanan::setActivation
(
102
const
utils::Scalar&,
103
bool
) {
104
utils::Scalar expShapeFactor(exp(*
m_shapeFactor
));
105
*
m_activation
=
106
(pow(expShapeFactor, *
m_excitation
) - 1) / (expShapeFactor - 1);
107
}
108
109
void
internal_forces::muscles::StateDynamicsBuchanan::setType
() {
110
*
m_stateType
= internal_forces::muscles::STATE_TYPE::BUCHANAN;
111
}
BIORBD_NAMESPACE::internal_forces::muscles::Characteristics
Class Holds that muscle characteristics.
Definition
Characteristics.h:19
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsBuchanan
Time derivative of activation as described by Buchanan (https://www.sciencedirect....
Definition
StateDynamicsBuchanan.h:15
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsBuchanan::StateDynamicsBuchanan
StateDynamicsBuchanan(const utils::Scalar &neuralCommand=0, const utils::Scalar &excitation=0)
Construct state dynamics.
Definition
StateDynamicsBuchanan.cpp:8
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsBuchanan::timeDerivativeExcitation
virtual const utils::Scalar & timeDerivativeExcitation(const Characteristics &characteristics, bool alreadyNormalized)
Compute and return the excitation velocity.
Definition
StateDynamicsBuchanan.cpp:64
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsBuchanan::setExcitation
virtual void setExcitation(const utils::Scalar &val, bool turnOffWarnings=false)
Set the muscle excitation.
Definition
StateDynamicsBuchanan.cpp:87
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsBuchanan::~StateDynamicsBuchanan
~StateDynamicsBuchanan()
Destroy class properly.
Definition
StateDynamicsBuchanan.cpp:31
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsBuchanan::setType
virtual void setType()
Set type to Buchanan.
Definition
StateDynamicsBuchanan.cpp:109
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsBuchanan::DeepCopy
StateDynamicsBuchanan DeepCopy() const
Deep copy of state dynamics Buchanan.
Definition
StateDynamicsBuchanan.cpp:36
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsBuchanan::setActivation
virtual void setActivation(const utils::Scalar ¬Used, bool turnOffWarnings=false)
Set the muscle activation.
Definition
StateDynamicsBuchanan.cpp:101
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsBuchanan::m_shapeFactor
std::shared_ptr< utils::Scalar > m_shapeFactor
The shape factor (Buchanan2004, march 22nd, 2018).
Definition
StateDynamicsBuchanan.h:107
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsBuchanan::shapeFactor
const utils::Scalar & shapeFactor() const
Return the shape factor.
Definition
StateDynamicsBuchanan.cpp:59
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsBuchanan::setNeuralCommand
virtual void setNeuralCommand(const utils::Scalar &val)
Set the neural command.
Definition
StateDynamicsBuchanan.cpp:96
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsBuchanan::m_neuralCommand
std::shared_ptr< utils::Scalar > m_neuralCommand
The muscle neural command.
Definition
StateDynamicsBuchanan.h:105
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamicsBuchanan::m_excitationDot
std::shared_ptr< utils::Scalar > m_excitationDot
The excitation velocity.
Definition
StateDynamicsBuchanan.h:108
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::setExcitation
virtual void setExcitation(const utils::Scalar &val, bool turnOffWarnings=false)
Set the muscle excitation.
Definition
StateDynamics.cpp:135
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
EMG holder to interact with the muscle.
Definition
State.h:17
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
StateDynamicsBuchanan.cpp
Generated by
1.18.0