Biorbd
Release_1.13.0
Toggle main menu visibility
Loading...
Searching...
No Matches
LigamentSpringSecondOrder.cpp
1
#define BIORBD_API_EXPORTS
2
3
#include "InternalForces/Ligaments/LigamentSpringSecondOrder.h"
4
5
#include "InternalForces/Compound.h"
6
#include "InternalForces/Geometry.h"
7
#include "InternalForces/Ligaments/LigamentCharacteristics.h"
8
#include "InternalForces/Ligaments/LigamentsEnums.h"
9
#include "InternalForces/PathModifiers.h"
10
#include "RigidBody/GeneralizedCoordinates.h"
11
#include "RigidBody/GeneralizedVelocity.h"
12
#include "RigidBody/Joints.h"
13
#include "Utils/Error.h"
14
15
using namespace
BIORBD_NAMESPACE;
16
internal_forces::ligaments::LigamentSpringSecondOrder::
17
LigamentSpringSecondOrder
()
18
: internal_forces::ligaments::
Ligament
(),
19
m_stiffness
(std::make_shared<utils::Scalar>()),
20
m_epsilon
(std::make_shared<utils::Scalar>(1)) {
21
setType
();
22
}
23
24
internal_forces::ligaments::LigamentSpringSecondOrder::
25
LigamentSpringSecondOrder
(
26
const
utils::Scalar &
stiffness
,
27
const
utils::Scalar &
epsilon
,
28
const
utils::String
&
name
,
29
const
internal_forces::Geometry
&
position
,
30
const
internal_forces::ligaments::LigamentCharacteristics
31
&
characteristics
)
32
: internal_forces::ligaments::
Ligament
(
name
,
position
,
characteristics
),
33
m_stiffness
(std::make_shared<utils::Scalar>(
stiffness
)),
34
m_epsilon
(std::make_shared<utils::Scalar>(
epsilon
)) {
35
setType
();
36
}
37
38
internal_forces::ligaments::LigamentSpringSecondOrder::
39
LigamentSpringSecondOrder
(
40
const
utils::Scalar &
stiffness
,
41
const
utils::Scalar &
epsilon
,
42
const
utils::String
&
name
,
43
const
internal_forces::Geometry
&
position
,
44
const
internal_forces::ligaments::LigamentCharacteristics
45
&
characteristics
,
46
const
internal_forces::PathModifiers
&pathModifiers)
47
: internal_forces::ligaments::
Ligament
(
48
name
,
49
position
,
50
characteristics
,
51
pathModifiers),
52
m_stiffness
(std::make_shared<utils::Scalar>(
stiffness
)),
53
m_epsilon
(std::make_shared<utils::Scalar>(
epsilon
)) {
54
setType
();
55
}
56
57
internal_forces::ligaments::LigamentSpringSecondOrder
58
internal_forces::ligaments::LigamentSpringSecondOrder::DeepCopy
()
const
{
59
internal_forces::ligaments::LigamentSpringSecondOrder
copy;
60
copy.
DeepCopy
(*
this
);
61
return
copy;
62
}
63
void
internal_forces::ligaments::LigamentSpringSecondOrder::DeepCopy
(
64
const
internal_forces::ligaments::LigamentSpringSecondOrder
&other) {
65
internal_forces::ligaments::Ligament::DeepCopy
(other);
66
*
m_stiffness
= *other.
m_stiffness
;
67
*
m_epsilon
= *other.
m_epsilon
;
68
}
69
70
const
utils::Scalar &
71
internal_forces::ligaments::LigamentSpringSecondOrder::stiffness
()
const
{
72
return
*
m_stiffness
;
73
}
74
75
void
internal_forces::ligaments::LigamentSpringSecondOrder::setStiffness
(
76
const
utils::Scalar &val) {
77
*
m_stiffness
= val;
78
}
79
80
const
utils::Scalar &
81
internal_forces::ligaments::LigamentSpringSecondOrder::epsilon
()
const
{
82
return
*
m_epsilon
;
83
}
84
85
void
internal_forces::ligaments::LigamentSpringSecondOrder::setEpsilon
(
86
const
utils::Scalar &val) {
87
*
m_epsilon
= val;
88
}
89
90
internal_forces::ligaments::LigamentSpringSecondOrder::
91
LigamentSpringSecondOrder
(
const
internal_forces::ligaments::Ligament
&other)
92
: internal_forces::ligaments::
Ligament
(other) {
93
const
internal_forces::ligaments::LigamentSpringSecondOrder
&ligament_tp(
94
dynamic_cast<
const
internal_forces::ligaments::LigamentSpringSecondOrder
95
&
>
(other));
96
m_stiffness
= ligament_tp.
m_stiffness
;
97
m_epsilon
= ligament_tp.
m_epsilon
;
98
}
99
100
internal_forces::ligaments::LigamentSpringSecondOrder::
101
LigamentSpringSecondOrder
(
const
std::shared_ptr<Ligament> other)
102
: internal_forces::ligaments::
Ligament
(other) {
103
const
std::shared_ptr<internal_forces::ligaments::LigamentSpringSecondOrder>
104
ligament_tp(
105
std::dynamic_pointer_cast<
106
internal_forces::ligaments::LigamentSpringSecondOrder
>(other));
107
utils::Error::check
(
108
ligament_tp !=
nullptr
,
"ligament must be of a spring second order Type"
);
109
m_stiffness
= ligament_tp->m_stiffness;
110
m_epsilon
= ligament_tp->m_epsilon;
111
}
112
113
internal_forces::ligaments::LigamentSpringSecondOrder::
114
~LigamentSpringSecondOrder
() {}
115
116
void
internal_forces::ligaments::LigamentSpringSecondOrder::setType
() {
117
*
m_type
=
118
internal_forces::ligaments::LIGAMENT_TYPE::LIGAMENT_SPRING_SECOND_ORDER;
119
}
120
121
void
internal_forces::ligaments::LigamentSpringSecondOrder::computeFl
() {
122
utils::Scalar d =
123
position
().length() -
characteristics
().ligamentSlackLength();
124
*
m_Fl
= (*
m_stiffness
/ 2) * (d + std::sqrt(d * d + *
m_epsilon
* *
m_epsilon
));
125
}
BIORBD_NAMESPACE::internal_forces::Compound::name
const utils::String & name() const
Return the name of the muscle.
Definition
Compound.cpp:48
BIORBD_NAMESPACE::internal_forces::Geometry
Class Geometry of the muscle.
Definition
Geometry.h:31
BIORBD_NAMESPACE::internal_forces::PathModifiers
Holder of all the path modifiers of a muscle.
Definition
PathModifiers.h:18
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentCharacteristics
Class Holds that ligament characteristics.
Definition
LigamentCharacteristics.h:19
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringSecondOrder
Class LigamentSpringSecondOrder is a ligament with same behavior than second order spring defined by:...
Definition
LigamentSpringSecondOrder.h:20
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringSecondOrder::DeepCopy
LigamentSpringSecondOrder DeepCopy() const
Deep copy of a second order spring like ligament.
Definition
LigamentSpringSecondOrder.cpp:58
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringSecondOrder::~LigamentSpringSecondOrder
virtual ~LigamentSpringSecondOrder()
Destroy class properly.
Definition
LigamentSpringSecondOrder.cpp:114
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringSecondOrder::LigamentSpringSecondOrder
LigamentSpringSecondOrder()
Contruct a Ligament.
Definition
LigamentSpringSecondOrder.cpp:17
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringSecondOrder::setEpsilon
void setEpsilon(const utils::Scalar &epsilon)
Set the epsilon.
Definition
LigamentSpringSecondOrder.cpp:85
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringSecondOrder::stiffness
const utils::Scalar & stiffness() const
Get the stiffness.
Definition
LigamentSpringSecondOrder.cpp:71
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringSecondOrder::epsilon
const utils::Scalar & epsilon() const
Get the epsilon.
Definition
LigamentSpringSecondOrder.cpp:81
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringSecondOrder::m_stiffness
std::shared_ptr< utils::Scalar > m_stiffness
stiffness of the ligament
Definition
LigamentSpringSecondOrder.h:124
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringSecondOrder::computeFl
virtual void computeFl()
Compute the Force-length of the contractile element.
Definition
LigamentSpringSecondOrder.cpp:121
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringSecondOrder::setStiffness
void setStiffness(const utils::Scalar &stiffness)
Set the stiffness.
Definition
LigamentSpringSecondOrder.cpp:75
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringSecondOrder::setType
virtual void setType()
Set type to second order spring like ligament.
Definition
LigamentSpringSecondOrder.cpp:116
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringSecondOrder::m_epsilon
std::shared_ptr< utils::Scalar > m_epsilon
small parameter to avoid negative value
Definition
LigamentSpringSecondOrder.h:126
BIORBD_NAMESPACE::internal_forces::ligaments::Ligament
Base class of all ligament.
Definition
Ligament.h:26
BIORBD_NAMESPACE::internal_forces::ligaments::Ligament::position
const internal_forces::Geometry & position() const
Return the position of all the points attached to the ligament (0 being the origin).
Definition
Ligament.cpp:148
BIORBD_NAMESPACE::internal_forces::ligaments::Ligament::DeepCopy
void DeepCopy(const Ligament &other)
Deep copy of a ligament in new ligament.
Definition
Ligament.cpp:93
BIORBD_NAMESPACE::internal_forces::ligaments::Ligament::characteristics
const LigamentCharacteristics & characteristics() const
Return the ligament characteristics.
Definition
Ligament.cpp:237
BIORBD_NAMESPACE::internal_forces::ligaments::Ligament::m_Fl
std::shared_ptr< utils::Scalar > m_Fl
Force-Length.
Definition
Ligament.h:292
BIORBD_NAMESPACE::internal_forces::ligaments::Ligament::Ligament
Ligament()
Construct a ligament.
Definition
Ligament.cpp:20
BIORBD_NAMESPACE::internal_forces::ligaments::Ligament::m_type
std::shared_ptr< LIGAMENT_TYPE > m_type
The type of the ligament.
Definition
Ligament.h:274
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
BIORBD_NAMESPACE::utils::String
Wrapper around the std::string class with augmented functionality.
Definition
String.h:18
src
InternalForces
Ligaments
LigamentSpringSecondOrder.cpp
Generated by
1.18.0