Biorbd Release_1.13.0
Loading...
Searching...
No Matches
MuscleGroup.cpp
1#define BIORBD_API_EXPORTS
2#include "InternalForces/Muscles/MuscleGroup.h"
3
4#include "InternalForces/Muscles/HillDeGrooteActiveOnlyType.h"
5#include "InternalForces/Muscles/HillDeGrooteType.h"
6#include "InternalForces/Muscles/HillDeGrooteTypeFatigable.h"
7#include "InternalForces/Muscles/HillThelenActiveOnlyType.h"
8#include "InternalForces/Muscles/HillThelenType.h"
9#include "InternalForces/Muscles/HillThelenTypeFatigable.h"
10#include "InternalForces/Muscles/HillType.h"
11#include "InternalForces/Muscles/IdealizedActuator.h"
12#include "InternalForces/Muscles/StateDynamicsBuchanan.h"
13#include "InternalForces/Muscles/StateDynamicsDeGroote.h"
14#include "Utils/Error.h"
15
16using namespace BIORBD_NAMESPACE;
18 : m_mus(
19 std::make_shared<std::vector<
20 std::shared_ptr<internal_forces::muscles::Muscle>>>()),
21 m_name(std::make_shared<utils::String>()),
22 m_originName(std::make_shared<utils::String>()),
23 m_insertName(std::make_shared<utils::String>()) {}
24
31
33 const utils::String &name,
34 const utils::String &originName,
35 const utils::String &insertionName)
36 : m_mus(
37 std::make_shared<std::vector<
38 std::shared_ptr<internal_forces::muscles::Muscle>>>()),
39 m_name(std::make_shared<utils::String>(name)),
40 m_originName(std::make_shared<utils::String>(originName)),
41 m_insertName(std::make_shared<utils::String>(insertionName)) {}
42
44
51
54 m_mus->resize(other.m_mus->size());
55 for (size_t i = 0; i < other.m_mus->size(); ++i) {
56 if ((*other.m_mus)[i]->type() ==
57 internal_forces::muscles::MUSCLE_TYPE::IDEALIZED_ACTUATOR) {
58 (*m_mus)[i] =
59 std::make_shared<internal_forces::muscles::IdealizedActuator>(
60 (*other.m_mus)[i]);
61 } else if (
62 (*other.m_mus)[i]->type() ==
63 internal_forces::muscles::MUSCLE_TYPE::HILL) {
64 (*m_mus)[i] = std::make_shared<internal_forces::muscles::HillType>(
65 (*other.m_mus)[i]);
66 } else if (
67 (*other.m_mus)[i]->type() ==
68 internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN) {
69 (*m_mus)[i] = std::make_shared<internal_forces::muscles::HillThelenType>(
70 (*other.m_mus)[i]);
71 } else if (
72 (*other.m_mus)[i]->type() ==
73 internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE) {
74 (*m_mus)[i] =
75 std::make_shared<internal_forces::muscles::HillDeGrooteType>(
76 (*other.m_mus)[i]);
77 } else if (
78 (*other.m_mus)[i]->type() ==
79 internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN_ACTIVE) {
80 (*m_mus)[i] =
81 std::make_shared<internal_forces::muscles::HillThelenActiveOnlyType>(
82 (*other.m_mus)[i]);
83 } else if (
84 (*other.m_mus)[i]->type() ==
85 internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN_FATIGABLE) {
86 (*m_mus)[i] =
87 std::make_shared<internal_forces::muscles::HillThelenTypeFatigable>(
88 (*other.m_mus)[i]);
89 } else if (
90 (*other.m_mus)[i]->type() ==
91 internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE_ACTIVE) {
92 (*m_mus)[i] = std::make_shared<
94 (*other.m_mus)[i]);
95 } else if (
96 (*other.m_mus)[i]->type() ==
97 internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE_FATIGABLE) {
98 (*m_mus)[i] =
99 std::make_shared<internal_forces::muscles::HillDeGrooteTypeFatigable>(
100 (*other.m_mus)[i]);
101 } else {
103 "DeepCopy was not prepared to copy " +
105 internal_forces::muscles::MUSCLE_TYPE_toStr(
106 (*other.m_mus)[i]->type())) +
107 " type");
108 }
109 }
110 *m_mus = *other.m_mus;
111 *m_name = *other.m_name;
112 *m_originName = *other.m_originName;
113 *m_insertName = *other.m_insertName;
114}
115
117 const utils::String &name,
118 internal_forces::muscles::MUSCLE_TYPE type,
120 const internal_forces::muscles::Characteristics &characteristics,
121 internal_forces::muscles::STATE_TYPE stateType,
122 internal_forces::muscles::STATE_FATIGUE_TYPE dynamicFatigueType) {
123 std::shared_ptr<internal_forces::muscles::Muscle> muscle;
124 std::shared_ptr<internal_forces::muscles::StateDynamics> state;
125
126 // Cast the dynamic type
127 if (stateType == internal_forces::muscles::STATE_TYPE::SIMPLE_STATE) {
128 state = std::make_shared<internal_forces::muscles::StateDynamics>();
129 } else if (stateType == internal_forces::muscles::STATE_TYPE::DYNAMIC) {
130 state = std::make_shared<internal_forces::muscles::StateDynamics>();
131 } else if (stateType == internal_forces::muscles::STATE_TYPE::BUCHANAN) {
132 state = std::make_shared<internal_forces::muscles::StateDynamicsBuchanan>();
133 } else if (stateType == internal_forces::muscles::STATE_TYPE::DE_GROOTE) {
134 state = std::make_shared<internal_forces::muscles::StateDynamicsDeGroote>();
135 } else {
136 state = std::make_shared<internal_forces::muscles::StateDynamics>();
137 }
138
139 if (type == internal_forces::muscles::MUSCLE_TYPE::IDEALIZED_ACTUATOR) {
140 muscle = std::make_shared<internal_forces::muscles::IdealizedActuator>(
141 name, geometry, characteristics, *state);
142 } else if (type == internal_forces::muscles::MUSCLE_TYPE::HILL) {
143 muscle = std::make_shared<internal_forces::muscles::HillType>(
144 name, geometry, characteristics, *state);
145 } else if (type == internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE) {
146 muscle = std::make_shared<internal_forces::muscles::HillDeGrooteType>(
147 name, geometry, characteristics, *state);
148 } else if (type == internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN) {
149 muscle = std::make_shared<internal_forces::muscles::HillThelenType>(
150 name, geometry, characteristics, *state);
151 } else if (
152 type == internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN_ACTIVE) {
153 muscle =
154 std::make_shared<internal_forces::muscles::HillThelenActiveOnlyType>(
155 name, geometry, characteristics, *state);
156 } else if (
157 type == internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN_FATIGABLE) {
158 muscle =
159 std::make_shared<internal_forces::muscles::HillThelenTypeFatigable>(
160 name, geometry, characteristics, *state, dynamicFatigueType);
161 } else if (
162 type == internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE_ACTIVE) {
163 muscle =
164 std::make_shared<internal_forces::muscles::HillDeGrooteActiveOnlyType>(
165 name, geometry, characteristics, *state);
166 } else if (
167 type == internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE_FATIGABLE) {
168 muscle =
169 std::make_shared<internal_forces::muscles::HillDeGrooteTypeFatigable>(
170 name, geometry, characteristics, *state, dynamicFatigueType);
171 } else {
172 utils::Error::raise("Wrong muscle type");
173 }
175}
176
178 const utils::String &name,
179 internal_forces::muscles::MUSCLE_TYPE type,
181 const internal_forces::muscles::Characteristics &characteristics,
182 internal_forces::muscles::STATE_FATIGUE_TYPE dynamicFatigueType) {
183 std::shared_ptr<internal_forces::muscles::Muscle> muscle;
184 if (type == internal_forces::muscles::MUSCLE_TYPE::IDEALIZED_ACTUATOR) {
185 muscle = std::make_shared<internal_forces::muscles::IdealizedActuator>(
186 name, geometry, characteristics);
187 } else if (type == internal_forces::muscles::MUSCLE_TYPE::HILL) {
188 muscle = std::make_shared<internal_forces::muscles::HillType>(
189 name, geometry, characteristics);
190 } else if (type == internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE) {
191 muscle = std::make_shared<internal_forces::muscles::HillDeGrooteType>(
192 name, geometry, characteristics);
193 } else if (type == internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN) {
194 muscle = std::make_shared<internal_forces::muscles::HillThelenType>(
195 name, geometry, characteristics);
196 } else if (
197 type == internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN_ACTIVE) {
198 muscle =
199 std::make_shared<internal_forces::muscles::HillThelenActiveOnlyType>(
200 name, geometry, characteristics);
201 } else if (
202 type == internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN_FATIGABLE) {
203 muscle =
204 std::make_shared<internal_forces::muscles::HillThelenTypeFatigable>(
205 name, geometry, characteristics, dynamicFatigueType);
206 } else if (
207 type == internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE_ACTIVE) {
208 muscle =
209 std::make_shared<internal_forces::muscles::HillDeGrooteActiveOnlyType>(
210 name, geometry, characteristics);
211 } else if (
212 type == internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE_FATIGABLE) {
213 muscle =
214 std::make_shared<internal_forces::muscles::HillDeGrooteTypeFatigable>(
215 name, geometry, characteristics, dynamicFatigueType);
216 } else {
217 utils::Error::raise("Wrong muscle type");
218 }
220}
221
223 const utils::String &name,
224 internal_forces::muscles::MUSCLE_TYPE type,
226 const internal_forces::muscles::Characteristics &characteristics,
227 const internal_forces::PathModifiers &pathModifiers,
228 internal_forces::muscles::STATE_TYPE stateType,
229 internal_forces::muscles::STATE_FATIGUE_TYPE dynamicFatigueType) {
230 std::shared_ptr<internal_forces::muscles::Muscle> muscle;
231 std::shared_ptr<internal_forces::muscles::StateDynamics> state;
232
233 // Cast the dynamic type
234 if (stateType == internal_forces::muscles::STATE_TYPE::SIMPLE_STATE) {
235 state = std::make_shared<internal_forces::muscles::StateDynamics>();
236 } else if (stateType == internal_forces::muscles::STATE_TYPE::BUCHANAN) {
237 state = std::make_shared<internal_forces::muscles::StateDynamicsBuchanan>();
238 } else if (stateType == internal_forces::muscles::STATE_TYPE::DE_GROOTE) {
239 state = std::make_shared<internal_forces::muscles::StateDynamicsDeGroote>();
240 } else {
241 state = std::make_shared<internal_forces::muscles::StateDynamics>();
242 }
243
244 if (type == internal_forces::muscles::MUSCLE_TYPE::IDEALIZED_ACTUATOR)
245 muscle = std::make_shared<internal_forces::muscles::IdealizedActuator>(
246 name, geometry, characteristics, pathModifiers, *state);
247 else if (type == internal_forces::muscles::MUSCLE_TYPE::HILL)
248 muscle = std::make_shared<internal_forces::muscles::HillType>(
249 name, geometry, characteristics, pathModifiers, *state);
250 else if (type == internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE)
251 muscle = std::make_shared<internal_forces::muscles::HillDeGrooteType>(
252 name, geometry, characteristics, pathModifiers, *state);
253 else if (type == internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN)
254 muscle = std::make_shared<internal_forces::muscles::HillThelenType>(
255 name, geometry, characteristics, pathModifiers, *state);
256 else if (type == internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN_ACTIVE)
257 muscle =
258 std::make_shared<internal_forces::muscles::HillThelenActiveOnlyType>(
259 name, geometry, characteristics, pathModifiers, *state);
260 else if (type == internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN_FATIGABLE)
261 muscle =
262 std::make_shared<internal_forces::muscles::HillThelenTypeFatigable>(
263 name,
264 geometry,
265 characteristics,
266 pathModifiers,
267 *state,
268 dynamicFatigueType);
269 else if (type == internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE_ACTIVE)
270 muscle =
271 std::make_shared<internal_forces::muscles::HillDeGrooteActiveOnlyType>(
272 name, geometry, characteristics, pathModifiers, *state);
273 else if (
274 type == internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE_FATIGABLE)
275 muscle =
276 std::make_shared<internal_forces::muscles::HillDeGrooteTypeFatigable>(
277 name,
278 geometry,
279 characteristics,
280 pathModifiers,
281 *state,
282 dynamicFatigueType);
283 else {
284 utils::Error::raise("Wrong muscle type");
285 }
287}
288
290 const utils::String &name,
291 internal_forces::muscles::MUSCLE_TYPE type,
293 const internal_forces::muscles::Characteristics &characteristics,
294 const internal_forces::PathModifiers &pathModifiers,
295 internal_forces::muscles::STATE_FATIGUE_TYPE dynamicFatigueType) {
296 std::shared_ptr<internal_forces::muscles::Muscle> muscle;
297
298 if (type == internal_forces::muscles::MUSCLE_TYPE::IDEALIZED_ACTUATOR) {
299 muscle = std::make_shared<internal_forces::muscles::IdealizedActuator>(
300 name, geometry, characteristics, pathModifiers);
301 } else if (type == internal_forces::muscles::MUSCLE_TYPE::HILL) {
302 muscle = std::make_shared<internal_forces::muscles::HillType>(
303 name, geometry, characteristics, pathModifiers);
304 } else if (type == internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE) {
305 muscle = std::make_shared<internal_forces::muscles::HillDeGrooteType>(
306 name, geometry, characteristics, pathModifiers);
307 } else if (type == internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN) {
308 muscle = std::make_shared<internal_forces::muscles::HillThelenType>(
309 name, geometry, characteristics, pathModifiers);
310 } else if (
311 type == internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN_ACTIVE) {
312 muscle =
313 std::make_shared<internal_forces::muscles::HillThelenActiveOnlyType>(
314 name, geometry, characteristics, pathModifiers);
315 } else if (
316 type == internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN_FATIGABLE) {
317 muscle =
318 std::make_shared<internal_forces::muscles::HillThelenTypeFatigable>(
319 name, geometry, characteristics, pathModifiers, dynamicFatigueType);
320 } else if (
321 type == internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE_ACTIVE) {
322 muscle =
323 std::make_shared<internal_forces::muscles::HillDeGrooteActiveOnlyType>(
324 name, geometry, characteristics, pathModifiers);
325 } else if (
326 type == internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE_FATIGABLE) {
327 muscle =
328 std::make_shared<internal_forces::muscles::HillDeGrooteTypeFatigable>(
329 name, geometry, characteristics, pathModifiers, dynamicFatigueType);
330 } else {
331 utils::Error::raise("Wrong muscle type");
332 }
334}
335
339 muscleID(muscle.name()) == -1,
340 "This muscle name was already defined for this muscle group");
341
342 // Add muscle according to its type
343 if (muscle.type() ==
344 internal_forces::muscles::MUSCLE_TYPE::IDEALIZED_ACTUATOR) {
345 m_mus->push_back(
346 std::make_shared<internal_forces::muscles::IdealizedActuator>(muscle));
347 } else if (
348 muscle.type() ==
349 internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN_FATIGABLE) {
350 m_mus->push_back(
351 std::make_shared<internal_forces::muscles::HillThelenTypeFatigable>(
352 muscle));
353 } else if (
354 muscle.type() ==
355 internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE_FATIGABLE) {
356 m_mus->push_back(
357 std::make_shared<internal_forces::muscles::HillDeGrooteTypeFatigable>(
358 muscle));
359 } else if (
360 muscle.type() == internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN) {
361 m_mus->push_back(
362 std::make_shared<internal_forces::muscles::HillThelenType>(muscle));
363 } else if (
364 muscle.type() ==
365 internal_forces::muscles::MUSCLE_TYPE::HILL_THELEN_ACTIVE) {
366 m_mus->push_back(
367 std::make_shared<internal_forces::muscles::HillThelenActiveOnlyType>(
368 muscle));
369 } else if (
370 muscle.type() ==
371 internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE_ACTIVE) {
372 m_mus->push_back(
373 std::make_shared<internal_forces::muscles::HillDeGrooteActiveOnlyType>(
374 muscle));
375 } else if (
376 muscle.type() == internal_forces::muscles::MUSCLE_TYPE::HILL_DE_GROOTE) {
377 m_mus->push_back(
378 std::make_shared<internal_forces::muscles::HillDeGrooteType>(muscle));
379 } else if (muscle.type() == internal_forces::muscles::MUSCLE_TYPE::HILL) {
380 m_mus->push_back(
381 std::make_shared<internal_forces::muscles::HillType>(muscle));
382 } else {
383 utils::Error::raise("Muscle type not found");
384 }
385 return;
386}
387
389 size_t idx) {
391 idx < nbMuscles(), "Idx asked is higher than number of muscles");
392 return *(*m_mus)[idx];
393}
397 idx < nbMuscles(), "Idx asked is higher than number of muscles");
398 return *(*m_mus)[idx];
399}
400
402 return m_mus->size();
403}
404
405std::vector<std::shared_ptr<internal_forces::muscles::Muscle>> &
409
410const std::vector<std::shared_ptr<internal_forces::muscles::Muscle>> &
414
416 const utils::String &nameToFind) {
417 for (size_t i = 0; i < m_mus->size(); ++i) {
418 if (!nameToFind.compare((*m_mus)[i]->name())) {
419 return static_cast<int>(i);
420 }
421 }
422 // If we get here, there is no muscle of that name in this group
423 return -1;
424}
425
432
440
const utils::String & name() const
Return the name of the muscle.
Definition Compound.cpp:48
Holder of all the path modifiers of a muscle.
Muscle of Hill type augmented by Thelen (https://simtk-confluence.stanford.edu/display/OpenSim/Thelen...
A muscle group is muscle that share parents for both origin and insertion.
Definition MuscleGroup.h:28
const utils::String & origin() const
Return the origin segment name.
std::shared_ptr< utils::String > m_name
The muscle group name.
void setOrigin(const utils::String &name)
Set the origin segment name where the origin lies.
size_t nbMuscles() const
Return the number of muscles in the group.
virtual void addMuscle(const utils::String &name, MUSCLE_TYPE type, const MuscleGeometry &geometry, const Characteristics &characteristics, STATE_TYPE stateType=STATE_TYPE::NO_STATE_TYPE, STATE_FATIGUE_TYPE dynamicFatigueType=STATE_FATIGUE_TYPE::NO_FATIGUE_STATE_TYPE)
To add a muscle to the group.
std::vector< std::shared_ptr< Muscle > > & muscles()
Return the muscles in the group.
const utils::String & insertion() const
Return the insertion segment name.
std::shared_ptr< std::vector< std::shared_ptr< Muscle > > > m_mus
The set of muscles.
void setName(const utils::String &name)
Set the name of the muscle group.
int muscleID(const utils::String &name)
Return the muscle index.
void setInsertion(const utils::String &name)
Set the insertion segment name where the origin lies.
std::shared_ptr< utils::String > m_originName
The origin name.
MuscleGroup DeepCopy() const
Deep copy of a muscle group.
Muscle & muscle(size_t idx)
Return the muscle of a specific index in the group.
std::shared_ptr< utils::String > m_insertName
The insertion name.
const utils::String & name() const
Return the name of the muscle group.
MUSCLE_TYPE type() const
Return the type of the muscle.
Definition Muscle.cpp:129
static void raise(const String &message)
Throw an error message.
Definition Error.cpp:6
static void check(bool cond, const String &message)
Assert that raises the error message if false.
Definition Error.cpp:10
Wrapper around the std::string class with augmented functionality.
Definition String.h:18