Biorbd Release_1.13.0
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
10namespace BIORBD_NAMESPACE {
11class Model;
12
13namespace utils {
14class Vector;
15}
16
17namespace rigidbody {
21} // namespace rigidbody
22
23namespace internal_forces {
24namespace muscles {
25class StateDynamics;
26
30class BIORBD_API StaticOptimization {
31 public:
48 Model& model,
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
74 Model& model,
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
100 Model& model,
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
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
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
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:
238 std::vector<rigidbody::GeneralizedCoordinates>
240 std::vector<rigidbody::GeneralizedVelocity>
242 std::vector<rigidbody::GeneralizedTorque>
244 std::shared_ptr<utils::Vector>
246 unsigned int m_pNormFactor;
249 std::vector<Ipopt::SmartPtr<Ipopt::TNLP>>
252};
253
254} // namespace muscles
255} // namespace internal_forces
256} // namespace BIORBD_NAMESPACE
257
258#endif // BIORBD_MUSCLES_STATIC_OPTIMIZATION_H
The actual musculoskeletal model that holds everything in biorbd.
EMG with the capability to compute the time derivative.
std::vector< utils::Vector > finalSolution()
Return the final solution.
void run(bool useLinearizedState=true, double tolerance=1e-7, int maxIter=1000, bool checkDerivatives=false)
Run the static optimization.
std::vector< Ipopt::SmartPtr< Ipopt::TNLP > > m_staticOptimProblem
The static optimization problem.
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.
std::shared_ptr< utils::Vector > m_initialActivationGuess
Initial activation guess.
std::vector< utils::Vector > finalResidual()
Return the final residuals.
std::vector< rigidbody::GeneralizedCoordinates > m_allQ
All the generalized coordinates.
bool m_alreadyRun
If already ran the static optimization.
std::vector< rigidbody::GeneralizedVelocity > m_allQdot
All the generalized velocities.
std::vector< rigidbody::GeneralizedTorque > m_allTorqueTarget
All the torque targets.
Wrapper of the Eigen VectorXd.
Definition Vector.h:21