11#include < math.h>
22#include < cmath>
33#include < iostream>
4- #include " PyreneActuator .hh"
4+ #include " pyreneActuator .hh"
55#define pi M_PI
66
7- const double PyreneActuator ::K = 10.6 ;
8- const double PyreneActuator ::J_j = 0.5878 ;
9- const double PyreneActuator ::F_vj = 0.4757 ;
10- const double PyreneActuator ::F_sj = 0.5403 ;
11- const double PyreneActuator ::offset_j = -0.3012 ;
12- const double PyreneActuator ::J_m = 0.21 ;
13- const double PyreneActuator ::F_vm = 5.6714 ;
14- const double PyreneActuator ::F_sm = 4.0420 ;
15- const double PyreneActuator ::offset_m = 0.5572 ;
16- const double PyreneActuator ::M = 4.5667 ;
17- const double PyreneActuator ::c_y = 1.1005 /M;
18- const double PyreneActuator ::c_x = -0.0981 /M;
19- const double PyreneActuator ::mu = 1000.0 ;
20- const double PyreneActuator ::g = 9.81 ;
7+ const double pyreneActuator ::K = 10.6 ;
8+ const double pyreneActuator ::J_j = 0.5878 ;
9+ const double pyreneActuator ::F_vj = 0.4757 ;
10+ const double pyreneActuator ::F_sj = 0.5403 ;
11+ const double pyreneActuator ::offset_j = -0.3012 ;
12+ const double pyreneActuator ::J_m = 0.21 ;
13+ const double pyreneActuator ::F_vm = 5.6714 ;
14+ const double pyreneActuator ::F_sm = 4.0420 ;
15+ const double pyreneActuator ::offset_m = 0.5572 ;
16+ const double pyreneActuator ::M = 4.5667 ;
17+ const double pyreneActuator ::c_y = 1.1005 /M;
18+ const double pyreneActuator ::c_x = -0.0981 /M;
19+ const double pyreneActuator ::mu = 1000.0 ;
20+ const double pyreneActuator ::g = 9.81 ;
2121
2222/*
2323 * x0 -> actuator position
2424 * x1 -> actuator speed
2525 */
2626
27- PyreneActuator::PyreneActuator ()
27+ pyreneActuator::pyreneActuator ()
2828{
2929 stateNb=2 ;
3030 commandNb=1 ;
@@ -55,25 +55,25 @@ PyreneActuator::PyreneActuator()
5555 upperCommandBounds << 1.0 ;
5656}
5757
58- void PyreneActuator ::setLoadParam (const double & mass, const double & coordX, const double & coordY)
58+ void pyreneActuator ::setLoadParam (const double & mass, const double & coordX, const double & coordY)
5959{
6060 L = mass;
6161 l_y = coordY;
6262 l_x = coordX;
6363}
6464
65- void PyreneActuator ::setLoadMass (const double & mass)
65+ void pyreneActuator ::setLoadMass (const double & mass)
6666{
6767 L = mass;
6868 std::cout << " L : " << L << std::endl;
6969}
7070
71- void PyreneActuator ::removeLoad ()
71+ void pyreneActuator ::removeLoad ()
7272{
7373 L = 0.0 ;
7474}
7575
76- PyreneActuator ::stateVec_t PyreneActuator ::computeStateDeriv (double &, const stateVec_t& X,
76+ pyreneActuator ::stateVec_t pyreneActuator ::computeStateDeriv (double &, const stateVec_t& X,
7777 const commandVec_t &U)
7878{
7979 stateVec_t dX;
@@ -84,7 +84,7 @@ PyreneActuator::stateVec_t PyreneActuator::computeStateDeriv(double&, const stat
8484 return dX;
8585}
8686
87- PyreneActuator ::stateVec_t PyreneActuator ::computeNextState (double & dt, const stateVec_t& X,
87+ pyreneActuator ::stateVec_t pyreneActuator ::computeNextState (double & dt, const stateVec_t& X,
8888 const commandVec_t& U)
8989{
9090 stateVec_t x_next,k1,k2,k3,k4;
@@ -97,7 +97,7 @@ PyreneActuator::stateVec_t PyreneActuator::computeNextState(double& dt, const st
9797}
9898
9999
100- void PyreneActuator ::computeModelDeriv (double & dt, const stateVec_t& X,const commandVec_t& U)
100+ void pyreneActuator ::computeModelDeriv (double & dt, const stateVec_t& X,const commandVec_t& U)
101101{
102102 double dh = 1e-7 ;
103103 stateVec_t Xp, Xm;
@@ -113,17 +113,17 @@ void PyreneActuator::computeModelDeriv(double& dt, const stateVec_t& X,const com
113113 }
114114}
115115
116- PyreneActuator ::stateMat_t PyreneActuator ::computeTensorContxx (const stateVec_t& )
116+ pyreneActuator ::stateMat_t pyreneActuator ::computeTensorContxx (const stateVec_t& )
117117{
118118 return QxxCont;
119119}
120120
121- PyreneActuator ::commandMat_t PyreneActuator ::computeTensorContuu (const stateVec_t& )
121+ pyreneActuator ::commandMat_t pyreneActuator ::computeTensorContuu (const stateVec_t& )
122122{
123123 return QuuCont;
124124}
125125
126- PyreneActuator ::commandR_stateC_t PyreneActuator ::computeTensorContux (const stateVec_t& )
126+ pyreneActuator ::commandR_stateC_t pyreneActuator ::computeTensorContux (const stateVec_t& )
127127{
128128 return QuxCont;
129129}
0 commit comments