Biorbd
Release_1.13.0
Toggle main menu visibility
Loading...
Searching...
No Matches
StaticOptimization.h
1
#ifndef BIORBD_MUSCLES_STATIC_OPTIMIZATION_H
2
#define BIORBD_MUSCLES_STATIC_OPTIMIZATION_H
3
4
#include "biorbdConfig.h"
5
6
#include <IpTNLP.hpp>
7
#include <memory>
8
#include <vector>
9
10
namespace
BIORBD_NAMESPACE {
11
class
Model
;
12
13
namespace
utils {
14
class
Vector
;
15
}
16
17
namespace
rigidbody {
18
class
GeneralizedCoordinates
;
19
class
GeneralizedVelocity
;
20
class
GeneralizedTorque
;
21
}
// namespace rigidbody
22
23
namespace
internal_forces {
24
namespace
muscles {
25
class
StateDynamics
;
26
30
class
BIORBD_API
StaticOptimization
{
31
public
:
47
StaticOptimization
(
48
Model
& model,
49
const
rigidbody::GeneralizedCoordinates
& Q,
50
const
rigidbody::GeneralizedVelocity
& Qdot,
51
const
rigidbody::GeneralizedTorque
& torqueTarget,
52
double
initialActivationGuess = 0.01,
53
unsigned
int
pNormFactor = 2,
54
bool
useResidualTorque =
true
,
55
int
verbose = 0,
56
double
objectiveScaling = 1);
57
73
StaticOptimization
(
74
Model
& model,
75
const
rigidbody::GeneralizedCoordinates
& Q,
76
const
rigidbody::GeneralizedVelocity
& Qdot,
77
const
rigidbody::GeneralizedTorque
& torqueTarget,
78
const
utils::Vector
& initialActivationGuess,
79
unsigned
int
pNormFactor = 2,
80
bool
useResidualTorque =
true
,
81
int
verbose = 0,
82
double
objectiveScaling = 1);
83
99
StaticOptimization
(
100
Model
& model,
101
const
rigidbody::GeneralizedCoordinates
& Q,
102
const
rigidbody::GeneralizedVelocity
& Qdot,
103
const
rigidbody::GeneralizedTorque
& torqueTarget,
104
const
std::vector<StateDynamics>& initialActivationGuess,
105
unsigned
int
pNormFactor = 2,
106
bool
useResidualTorque =
true
,
107
int
verbose = 0,
108
double
objectiveScaling = 1);
109
125
StaticOptimization
(
126
Model
& model,
127
const
std::vector<rigidbody::GeneralizedCoordinates>& allQ,
128
const
std::vector<rigidbody::GeneralizedVelocity>& allQdot,
129
const
std::vector<rigidbody::GeneralizedTorque>& allTorqueTarget,
130
double
initialActivationGuess = 0.01,
131
unsigned
int
pNormFactor = 2,
132
bool
useResidualTorque =
true
,
133
int
verbose = 0,
134
double
objectiveScaling = 1);
135
151
StaticOptimization
(
152
Model
& model,
153
const
std::vector<rigidbody::GeneralizedCoordinates>& allQ,
154
const
std::vector<rigidbody::GeneralizedVelocity>& allQdot,
155
const
std::vector<rigidbody::GeneralizedTorque>& allTorqueTarget,
156
const
utils::Vector
& initialActivationGuess,
157
unsigned
int
pNormFactor = 2,
158
bool
useResidualTorque =
true
,
159
int
verbose = 0,
160
double
objectiveScaling = 1);
161
177
StaticOptimization
(
178
Model
& model,
179
const
std::vector<rigidbody::GeneralizedCoordinates>& allQ,
180
const
std::vector<rigidbody::GeneralizedVelocity>& allQdot,
181
const
std::vector<rigidbody::GeneralizedTorque>& allTorqueTarget,
182
const
std::vector<StateDynamics>& initialActivationGuess,
183
unsigned
int
pNormFactor = 2,
184
bool
useResidualTorque =
true
,
185
int
verbose = 0,
186
double
objectiveScaling = 1);
187
203
void
run
(
204
bool
useLinearizedState =
true
,
205
double
tolerance = 1e-7,
206
int
maxIter = 1000,
207
bool
checkDerivatives =
false
);
208
213
std::vector<utils::Vector>
finalSolution
();
214
220
utils::Vector
finalSolution
(
unsigned
int
index);
221
226
std::vector<utils::Vector>
finalResidual
();
227
233
utils::Vector
finalResidual
(
unsigned
int
index);
234
235
protected
:
236
Model
&
m_model
;
237
bool
m_useResidualTorque
;
238
std::vector<rigidbody::GeneralizedCoordinates>
239
m_allQ
;
240
std::vector<rigidbody::GeneralizedVelocity>
241
m_allQdot
;
242
std::vector<rigidbody::GeneralizedTorque>
243
m_allTorqueTarget
;
244
std::shared_ptr<utils::Vector>
245
m_initialActivationGuess
;
246
unsigned
int
m_pNormFactor
;
247
int
m_verbose
;
248
double
m_objectiveScaling
;
249
std::vector<Ipopt::SmartPtr<Ipopt::TNLP>>
250
m_staticOptimProblem
;
251
bool
m_alreadyRun
;
252
};
253
254
}
// namespace muscles
255
}
// namespace internal_forces
256
}
// namespace BIORBD_NAMESPACE
257
258
#endif
// BIORBD_MUSCLES_STATIC_OPTIMIZATION_H
BIORBD_NAMESPACE::Model
The actual musculoskeletal model that holds everything in biorbd.
Definition
BiorbdModel.h:101
BIORBD_NAMESPACE::internal_forces::muscles::StateDynamics
EMG with the capability to compute the time derivative.
Definition
StateDynamics.h:15
BIORBD_NAMESPACE::internal_forces::muscles::StaticOptimization::m_pNormFactor
unsigned int m_pNormFactor
The p-norm factor.
Definition
StaticOptimization.h:246
BIORBD_NAMESPACE::internal_forces::muscles::StaticOptimization::finalSolution
std::vector< utils::Vector > finalSolution()
Return the final solution.
Definition
StaticOptimization.cpp:277
BIORBD_NAMESPACE::internal_forces::muscles::StaticOptimization::run
void run(bool useLinearizedState=true, double tolerance=1e-7, int maxIter=1000, bool checkDerivatives=false)
Run the static optimization.
Definition
StaticOptimization.cpp:209
BIORBD_NAMESPACE::internal_forces::muscles::StaticOptimization::m_verbose
int m_verbose
Verbose level.
Definition
StaticOptimization.h:247
BIORBD_NAMESPACE::internal_forces::muscles::StaticOptimization::m_staticOptimProblem
std::vector< Ipopt::SmartPtr< Ipopt::TNLP > > m_staticOptimProblem
The static optimization problem.
Definition
StaticOptimization.h:250
BIORBD_NAMESPACE::internal_forces::muscles::StaticOptimization::StaticOptimization
StaticOptimization(Model &model, const rigidbody::GeneralizedCoordinates &Q, const rigidbody::GeneralizedVelocity &Qdot, const rigidbody::GeneralizedTorque &torqueTarget, double initialActivationGuess=0.01, unsigned int pNormFactor=2, bool useResidualTorque=true, int verbose=0, double objectiveScaling=1)
Construct static optimization.
Definition
StaticOptimization.cpp:19
BIORBD_NAMESPACE::internal_forces::muscles::StaticOptimization::m_initialActivationGuess
std::shared_ptr< utils::Vector > m_initialActivationGuess
Initial activation guess.
Definition
StaticOptimization.h:245
BIORBD_NAMESPACE::internal_forces::muscles::StaticOptimization::m_objectiveScaling
double m_objectiveScaling
Scaling factor of the objective.
Definition
StaticOptimization.h:248
BIORBD_NAMESPACE::internal_forces::muscles::StaticOptimization::m_model
Model & m_model
A reference to the model.
Definition
StaticOptimization.h:236
BIORBD_NAMESPACE::internal_forces::muscles::StaticOptimization::finalResidual
std::vector< utils::Vector > finalResidual()
Return the final residuals.
Definition
StaticOptimization.cpp:313
BIORBD_NAMESPACE::internal_forces::muscles::StaticOptimization::m_allQ
std::vector< rigidbody::GeneralizedCoordinates > m_allQ
All the generalized coordinates.
Definition
StaticOptimization.h:239
BIORBD_NAMESPACE::internal_forces::muscles::StaticOptimization::m_alreadyRun
bool m_alreadyRun
If already ran the static optimization.
Definition
StaticOptimization.h:251
BIORBD_NAMESPACE::internal_forces::muscles::StaticOptimization::m_allQdot
std::vector< rigidbody::GeneralizedVelocity > m_allQdot
All the generalized velocities.
Definition
StaticOptimization.h:241
BIORBD_NAMESPACE::internal_forces::muscles::StaticOptimization::m_allTorqueTarget
std::vector< rigidbody::GeneralizedTorque > m_allTorqueTarget
All the torque targets.
Definition
StaticOptimization.h:243
BIORBD_NAMESPACE::internal_forces::muscles::StaticOptimization::m_useResidualTorque
bool m_useResidualTorque
To use residual torque.
Definition
StaticOptimization.h:237
BIORBD_NAMESPACE::rigidbody::GeneralizedCoordinates
Class GeneralizedCoordinates.
Definition
GeneralizedCoordinates.h:15
BIORBD_NAMESPACE::rigidbody::GeneralizedTorque
Class GeneralizedTorque.
Definition
GeneralizedTorque.h:15
BIORBD_NAMESPACE::rigidbody::GeneralizedVelocity
Class GeneralizedVelocity.
Definition
GeneralizedVelocity.h:15
BIORBD_NAMESPACE::utils::Vector
Wrapper of the Eigen VectorXd.
Definition
Vector.h:21
include
InternalForces
Muscles
StaticOptimization.h
Generated by
1.18.0