Biorbd
Release_1.13.0
Toggle main menu visibility
Loading...
Searching...
No Matches
FatigueDynamicStateXia.cpp
1
#define BIORBD_API_EXPORTS
2
#include "InternalForces/Muscles/FatigueDynamicStateXia.h"
3
4
#include <cmath>
5
6
#include "InternalForces/Muscles/Characteristics.h"
7
#include "InternalForces/Muscles/FatigueParameters.h"
8
#include "InternalForces/Muscles/StateDynamics.h"
9
#include "Utils/Error.h"
10
11
using namespace
BIORBD_NAMESPACE;
12
13
internal_forces::muscles::FatigueDynamicStateXia::FatigueDynamicStateXia
(
14
const
utils::Scalar& active,
15
const
utils::Scalar& fatigued,
16
const
utils::Scalar& resting)
17
: internal_forces::muscles::
FatigueDynamicState
(active, fatigued, resting) {
18
setType
();
19
}
20
21
internal_forces::muscles::FatigueDynamicStateXia::FatigueDynamicStateXia
(
22
const
std::shared_ptr<FatigueState> other)
23
: internal_forces::muscles::
FatigueDynamicState
(other) {}
24
25
internal_forces::muscles::FatigueDynamicStateXia
26
internal_forces::muscles::FatigueDynamicStateXia::DeepCopy
()
const
{
27
internal_forces::muscles::FatigueDynamicStateXia
copy;
28
copy.
DeepCopy
(*
this
);
29
return
copy;
30
}
31
32
void
internal_forces::muscles::FatigueDynamicStateXia::DeepCopy
(
33
const
internal_forces::muscles::FatigueDynamicStateXia
& other) {
34
internal_forces::muscles::FatigueDynamicState::DeepCopy
(other);
35
}
36
37
void
internal_forces::muscles::FatigueDynamicStateXia::timeDerivativeState
(
38
const
internal_forces::muscles::StateDynamics
& emg,
39
const
internal_forces::muscles::Characteristics
& characteristics) {
40
#ifdef BIORBD_USE_CASADI_MATH
41
utils::Error::raise
(
42
"timeDerivativeState for FatigueDynamicStateXia is not implemented yet"
);
43
#else
44
// Getting the command
45
utils::Scalar targetCommand(emg.
activation
());
46
utils::Scalar command(0);
47
if
(*
m_activeFibers
< targetCommand) {
48
if
(*
m_restingFibers
> targetCommand - *
m_activeFibers
) {
49
command = characteristics.
fatigueParameters
().
developFactor
() *
50
(targetCommand - *
m_activeFibers
);
51
}
else
{
52
command = characteristics.
fatigueParameters
().
developFactor
() *
53
*
m_restingFibers
;
54
}
55
}
else
{
56
command = characteristics.
fatigueParameters
().
recoveryFactor
() *
57
(targetCommand - *
m_activeFibers
);
58
}
59
60
// Applying the command to the fibers
61
*
m_activeFibersDot
=
62
command -
63
characteristics.
fatigueParameters
().
fatigueRate
() * *
m_activeFibers
;
64
*
m_restingFibersDot
=
65
-command +
66
characteristics.
fatigueParameters
().
recoveryRate
() * *
m_fatiguedFibers
;
67
*
m_fatiguedFibersDot
=
68
characteristics.
fatigueParameters
().
fatigueRate
() * *
m_activeFibers
-
69
characteristics.
fatigueParameters
().
recoveryRate
() * *
m_fatiguedFibers
;
70
71
utils::Error::check
(
72
fabs(*
m_activeFibersDot
+ *
m_restingFibersDot
+ *
m_fatiguedFibersDot
) <=
73
1e-7,
74
"Sum of time derivates of fatigue states must be equal to 0"
);
75
#endif
76
}
77
78
void
internal_forces::muscles::FatigueDynamicStateXia::setType
() {
79
*
m_type
= internal_forces::muscles::STATE_FATIGUE_TYPE::DYNAMIC_XIA;
80
}
BIORBD_NAMESPACE::internal_forces::muscles::Characteristics
Class Holds that muscle characteristics.
Definition
Characteristics.h:19
BIORBD_NAMESPACE::internal_forces::muscles::Characteristics::fatigueParameters
const FatigueParameters & fatigueParameters() const
Return the fatigue parameters.
Definition
Characteristics.cpp:192
BIORBD_NAMESPACE::internal_forces::muscles::FatigueDynamicStateXia
Implementation of Xia (https://www.sciencedirect.com/science/article/pii/S0021929008003692) dynamic f...
Definition
FatigueDynamicStateXia.h:17
BIORBD_NAMESPACE::internal_forces::muscles::FatigueDynamicStateXia::FatigueDynamicStateXia
FatigueDynamicStateXia(const utils::Scalar &active=1, const utils::Scalar &fatigued=0, const utils::Scalar &resting=0)
Construct FatigueDynamicStateXia.
Definition
FatigueDynamicStateXia.cpp:13
BIORBD_NAMESPACE::internal_forces::muscles::FatigueDynamicStateXia::setType
virtual void setType()
Set type of fatigue dynamic state xia.
Definition
FatigueDynamicStateXia.cpp:78
BIORBD_NAMESPACE::internal_forces::muscles::FatigueDynamicStateXia::DeepCopy
FatigueDynamicStateXia DeepCopy() const
Deep copy of the fatigue dynamic state xia.
Definition
FatigueDynamicStateXia.cpp:26
BIORBD_NAMESPACE::internal_forces::muscles::FatigueDynamicStateXia::timeDerivativeState
virtual void timeDerivativeState(const StateDynamics &emg, const Characteristics &characteristics)
Time derivative state of the current states.
Definition
FatigueDynamicStateXia.cpp:37
BIORBD_NAMESPACE::internal_forces::muscles::FatigueDynamicState::m_fatiguedFibersDot
std::shared_ptr< utils::Scalar > m_fatiguedFibersDot
The fatigued fibers derivative.
Definition
FatigueDynamicState.h:74
BIORBD_NAMESPACE::internal_forces::muscles::FatigueDynamicState::FatigueDynamicState
FatigueDynamicState(const utils::Scalar &active=0, const utils::Scalar &fatigued=0, const utils::Scalar &resting=1)
Construct the fatigue dynamic state.
Definition
FatigueDynamicState.cpp:8
BIORBD_NAMESPACE::internal_forces::muscles::FatigueDynamicState::m_activeFibersDot
std::shared_ptr< utils::Scalar > m_activeFibersDot
The active fibers derivative.
Definition
FatigueDynamicState.h:72
BIORBD_NAMESPACE::internal_forces::muscles::FatigueDynamicState::m_restingFibersDot
std::shared_ptr< utils::Scalar > m_restingFibersDot
The resting fibers derivative.
Definition
FatigueDynamicState.h:76
BIORBD_NAMESPACE::internal_forces::muscles::FatigueParameters::recoveryFactor
const utils::Scalar & recoveryFactor() const
Return the recovery factor.
Definition
FatigueParameters.cpp:63
BIORBD_NAMESPACE::internal_forces::muscles::FatigueParameters::fatigueRate
const utils::Scalar & fatigueRate() const
Return the fatigue rate.
Definition
FatigueParameters.cpp:35
BIORBD_NAMESPACE::internal_forces::muscles::FatigueParameters::recoveryRate
const utils::Scalar & recoveryRate() const
Return the recovery rate.
Definition
FatigueParameters.cpp:44
BIORBD_NAMESPACE::internal_forces::muscles::FatigueParameters::developFactor
const utils::Scalar & developFactor() const
Return the develop factor.
Definition
FatigueParameters.cpp:54
BIORBD_NAMESPACE::internal_forces::muscles::FatigueState::DeepCopy
FatigueState DeepCopy() const
Deep copy of the fatigue state.
Definition
FatigueState.cpp:50
BIORBD_NAMESPACE::internal_forces::muscles::FatigueState::m_type
std::shared_ptr< STATE_FATIGUE_TYPE > m_type
Type of the muscle fatigue model.
Definition
FatigueState.h:112
BIORBD_NAMESPACE::internal_forces::muscles::FatigueState::m_fatiguedFibers
std::shared_ptr< utils::Scalar > m_fatiguedFibers
Proportion of fatigued muscle fibers.
Definition
FatigueState.h:103
BIORBD_NAMESPACE::internal_forces::muscles::FatigueState::m_activeFibers
std::shared_ptr< utils::Scalar > m_activeFibers
Proportion of active muscle fibers.
Definition
FatigueState.h:101
BIORBD_NAMESPACE::internal_forces::muscles::FatigueState::m_restingFibers
std::shared_ptr< utils::Scalar > m_restingFibers
Proportion of resting muscle fibers.
Definition
FatigueState.h:105
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamics
EMG with the capability to compute the time derivative.
Definition
StateDynamics.h:15
BIORBD_NAMESPACE::internal_forces::muscles::State::activation
const utils::Scalar & activation() const
Return the muscle activation.
Definition
State.cpp:117
BIORBD_NAMESPACE::utils::Error::raise
static void raise(const String &message)
Throw an error message.
Definition
Error.cpp:6
BIORBD_NAMESPACE::utils::Error::check
static void check(bool cond, const String &message)
Assert that raises the error message if false.
Definition
Error.cpp:10
src
InternalForces
Muscles
FatigueDynamicStateXia.cpp
Generated by
1.18.0