Biorbd
Release_1.13.0
Toggle main menu visibility
Loading...
Searching...
No Matches
LigamentSpringLinear.cpp
1
#define BIORBD_API_EXPORTS
2
3
#include "InternalForces/Ligaments/LigamentSpringLinear.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
#ifdef USE_SMOOTH_IF_ELSE
16
#include "Utils/CasadiExpand.h"
17
#endif
18
19
using namespace
BIORBD_NAMESPACE;
20
internal_forces::ligaments::LigamentSpringLinear::LigamentSpringLinear
()
21
: internal_forces::ligaments::
Ligament
(),
22
m_stiffness
(std::make_shared<utils::Scalar>()) {
23
setType
();
24
}
25
26
internal_forces::ligaments::LigamentSpringLinear::LigamentSpringLinear
(
27
const
utils::Scalar &
stiffness
,
28
const
utils::String
&
name
,
29
const
internal_forces::Geometry
&
position
,
30
const
internal_forces::ligaments::LigamentCharacteristics
&
characteristics
)
31
: internal_forces::ligaments::
Ligament
(
name
,
position
,
characteristics
),
32
m_stiffness
(std::make_shared<utils::Scalar>(
stiffness
)) {
33
setType
();
34
}
35
36
internal_forces::ligaments::LigamentSpringLinear::LigamentSpringLinear
(
37
const
utils::Scalar &
stiffness
,
38
const
utils::String
&
name
,
39
const
internal_forces::Geometry
&
position
,
40
const
internal_forces::ligaments::LigamentCharacteristics
&
characteristics
,
41
const
internal_forces::PathModifiers
&pathModifiers)
42
: internal_forces::ligaments::
Ligament
(
43
name
,
44
position
,
45
characteristics
,
46
pathModifiers),
47
m_stiffness
(std::make_shared<utils::Scalar>(
stiffness
)) {
48
setType
();
49
}
50
51
internal_forces::ligaments::LigamentSpringLinear::LigamentSpringLinear
(
52
const
std::shared_ptr<Ligament> other)
53
: internal_forces::ligaments::
Ligament
(other) {
54
const
std::shared_ptr<internal_forces::ligaments::LigamentSpringLinear>
55
ligament_tp(
56
std::dynamic_pointer_cast<
57
internal_forces::ligaments::LigamentSpringLinear
>(other));
58
utils::Error::check
(
59
ligament_tp !=
nullptr
,
"ligament must be of a spring linear Type"
);
60
m_stiffness
= ligament_tp->m_stiffness;
61
}
62
63
internal_forces::ligaments::LigamentSpringLinear
64
internal_forces::ligaments::LigamentSpringLinear::DeepCopy
()
const
{
65
internal_forces::ligaments::LigamentSpringLinear
copy;
66
copy.
DeepCopy
(*
this
);
67
return
copy;
68
}
69
70
void
internal_forces::ligaments::LigamentSpringLinear::DeepCopy
(
71
const
internal_forces::ligaments::LigamentSpringLinear
&other) {
72
internal_forces::ligaments::Ligament::DeepCopy
(other);
73
*
m_stiffness
= *other.
m_stiffness
;
74
}
75
76
const
utils::Scalar &
77
internal_forces::ligaments::LigamentSpringLinear::stiffness
()
const
{
78
return
*
m_stiffness
;
79
}
80
81
void
internal_forces::ligaments::LigamentSpringLinear::setStiffness
(
82
const
utils::Scalar &val) {
83
*
m_stiffness
= val;
84
}
85
86
internal_forces::ligaments::LigamentSpringLinear::LigamentSpringLinear
(
87
const
internal_forces::ligaments::Ligament
&other)
88
: internal_forces::ligaments::
Ligament
(other) {
89
const
internal_forces::ligaments::LigamentSpringLinear
&ligament_tp(
90
dynamic_cast<
const
internal_forces::ligaments::LigamentSpringLinear
&
>
(
91
other));
92
m_stiffness
= ligament_tp.
m_stiffness
;
93
}
94
95
internal_forces::ligaments::LigamentSpringLinear::~LigamentSpringLinear
() {}
96
97
void
internal_forces::ligaments::LigamentSpringLinear::setType
() {
98
*
m_type
= internal_forces::ligaments::LIGAMENT_TYPE::LIGAMENT_SPRING_LINEAR;
99
}
100
101
void
internal_forces::ligaments::LigamentSpringLinear::computeFl
() {
102
#ifdef BIORBD_USE_CASADI_MATH
103
*
m_Fl
= IF_ELSE_NAMESPACE::if_else_zero(
104
IF_ELSE_NAMESPACE::gt(
105
position
().
length
(),
characteristics
().ligamentSlackLength()),
106
*
m_stiffness
*
107
(
position
().
length
() -
characteristics
().ligamentSlackLength()));
108
#else
109
if
(
position
().
length
() >
characteristics
().ligamentSlackLength()) {
110
*
m_Fl
= *
m_stiffness
*
111
(
position
().length() -
characteristics
().ligamentSlackLength());
112
}
else
{
113
*
m_Fl
= 0;
114
}
115
#endif
116
}
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::LigamentSpringLinear
Class LigamentSpringLinear is a ligament with same behavior than linear spring defined by: k(l-l0) wi...
Definition
LigamentSpringLinear.h:17
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringLinear::computeFl
virtual void computeFl()
Compute the Force-length of the contractile element.
Definition
LigamentSpringLinear.cpp:101
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringLinear::setStiffness
void setStiffness(const utils::Scalar &stiffness)
Set the ligament stiffness.
Definition
LigamentSpringLinear.cpp:81
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringLinear::m_stiffness
std::shared_ptr< utils::Scalar > m_stiffness
stiffness of the ligament
Definition
LigamentSpringLinear.h:105
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringLinear::stiffness
const utils::Scalar & stiffness() const
Return the ligament stiffness.
Definition
LigamentSpringLinear.cpp:77
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringLinear::setType
virtual void setType()
Set type to linear spring like ligament.
Definition
LigamentSpringLinear.cpp:97
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringLinear::~LigamentSpringLinear
virtual ~LigamentSpringLinear()
Destroy class properly.
Definition
LigamentSpringLinear.cpp:95
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringLinear::DeepCopy
LigamentSpringLinear DeepCopy() const
Deep copy of a linear spring like ligament.
Definition
LigamentSpringLinear.cpp:64
BIORBD_NAMESPACE::internal_forces::ligaments::LigamentSpringLinear::LigamentSpringLinear
LigamentSpringLinear()
Contruct a Ligament.
Definition
LigamentSpringLinear.cpp:20
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::length
const utils::Scalar & length(rigidbody::Joints &updatedModel, const rigidbody::GeneralizedCoordinates &Q, bool updateLigamentKinematics=true)
Get the length of the ligament.
Definition
Ligament.cpp:152
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
LigamentSpringLinear.cpp
Generated by
1.18.0