mbsimflexiblebody  4.0.0
weight33RCM.h
00001 /* Copyright (C) 2004-2011 MBSim Development Team
00002  *
00003  * This library is free software; you can redistribute it and/or 
00004  * modify it under the terms of the GNU Lesser General Public 
00005  * License as published by the Free Software Foundation; either 
00006  * version 2.1 of the License, or (at your option) any later version. 
00007  *  
00008  * This library is distributed in the hope that it will be useful, 
00009  * but WITHOUT ANY WARRANTY; without even the implied warranty of 
00010  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU 
00011  * Lesser General Public License for more details. 
00012  *  
00013  * You should have received a copy of the GNU Lesser General Public 
00014  * License along with this library; if not, write to the Free Software 
00015  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301 USA
00016  *
00017  * Contact: thorsten.schindler@mytum.de
00018  */
00019 
00020 #ifndef WEIGHT33RCM_H_
00021 #define WEIGHT33RCM_H_
00022 
00023 #include "fmatvec/fmatvec.h"
00024 #include "mbsimFlexibleBody/pointer.h"
00025 
00026 namespace MBSimFlexibleBody {
00027 
00033   class Weight33RCM {
00034     public:
00038       Weight33RCM(double l0_,double l0h2_,double l0h3_,Trafo33RCMPtr tf_);
00041       virtual ~Weight33RCM();
00042 
00043       /* GETTER / SETTER */
00048       void setCurvature(double k10_,double k20_);
00049       
00053       void setGauss(int nGauss);
00054 
00055       const fmatvec::RowVec& getvxvt() const;
00056       const fmatvec::Vec& getvxvtH() const;
00057       const fmatvec::RowVec& getxvxvt() const;
00058       const fmatvec::Vec& getxvxvtH() const;
00059       const fmatvec::SymMat& getvxvtwxwt() const;
00060       const fmatvec::RowVec& getvvt() const;
00061       const fmatvec::Vec& getvvtH() const;
00062       const fmatvec::RowVec& getxvvt() const;
00063       const fmatvec::Vec& getxvvtH() const;
00064       const fmatvec::SymMat& getvvtwwt() const;
00065       
00066       const double& getIwh1() const;
00067       const double& getIwh2() const;
00068       const double& getIwh1t() const;   
00069       const double& getIwh2t() const;
00070       const double& getIxwh1() const;
00071       const double& getIxwh2() const;
00072       const double& getIxwh1t() const;
00073       const double& getIxwh2t() const;          
00074       const double& getIwh1twh1() const;
00075       const double& getIwh1twh2() const;
00076       const double& getIwh1twh1t() const;
00077       const double& getIwh1wh1() const;
00078       const double& getIwh1wh2t() const;                
00079       const double& getIwh1wh2() const;
00080       const double& getIwh2twh2t() const;
00081       const double& getIwh2twh2() const;
00082       const double& getIwh2wh2() const;
00083       const double& getIwh1twh2t() const;               
00084       const double& getIwh1xwh1x() const;
00085       const double& getIwh2xwh2x() const;
00086       const double& getIwh1xxwh1xx() const;
00087       const double& getIwh2xxwh2xx() const;
00088       const fmatvec::RowVec& getIwh1xxwxxwt() const;
00089       const fmatvec::RowVec& getIwh2xxwxxwt() const;
00090       const fmatvec::RowVec& getIwh1wwt() const;
00091       const fmatvec::RowVec& getIwh2wwt() const;
00092       const fmatvec::Vec& getIwh1wwtH() const;
00093       const fmatvec::Vec& getIwh2wwtH() const;
00094       const fmatvec::RowVec& getIwh1twwt() const;                       
00095       const fmatvec::RowVec& getIwh2twwt() const;
00096       const fmatvec::Vec& getIwh1twwtH() const;                 
00097       const fmatvec::Vec& getIwh2twwtH() const;
00098       const fmatvec::RowVec& getIwh1xwxwt() const;
00099       const fmatvec::RowVec& getIwh2xwxwt() const;
00100 
00101       const fmatvec::Vec& getw1coef() const;
00102       const fmatvec::Vec& getw2coef() const;
00103       const fmatvec::Vec& getw1tcoef() const;
00104       const fmatvec::Vec& getw2tcoef() const;
00105       const fmatvec::Mat& getw1coefqI() const;
00106       const fmatvec::Mat& getw2coefqI() const;
00107       const fmatvec::Vec& getwh1coef() const;
00108       const fmatvec::Vec& getwh2coef() const;
00109       const fmatvec::Vec& getwh1tcoef() const;
00110       const fmatvec::Vec& getwh2tcoef() const;          
00111       const fmatvec::Mat& getwh1coefqI() const;
00112       const fmatvec::Mat& getwh2coefqI() const;
00113       fmatvec::Mat getwh1coefqIH() const;
00114       fmatvec::Mat getwh2coefqIH() const;
00115       const fmatvec::Mat& getwh1tcoefqI() const;
00116       const fmatvec::Mat& getwh2tcoefqI() const;
00117       const fmatvec::Mat& getwh1coefqInunutH() const;
00118       const fmatvec::Mat& getwh2coefqInunutH() const;
00119 
00120       const fmatvec::Mat& gettSqI() const;
00121       const fmatvec::Mat& getnSqI() const;
00122       const fmatvec::Mat& getbSqI() const;
00123       const fmatvec::Mat& getnSqIH() const;
00124       const fmatvec::Mat& getbSqIH() const;
00125       const fmatvec::Mat& gettStqI() const;
00126       const fmatvec::Mat& getnStqI() const;
00127       const fmatvec::Mat& getbStqI() const;
00128 
00129       const double& getTtil() const;
00130       const fmatvec::RowVec& getTtilqI() const;
00131       const fmatvec::SymMat& getTtilqItqIt() const;
00132       const fmatvec::Vec& getTtilqItqIqIt() const;
00133 
00134       const fmatvec::Mat& getdpS() const;               
00135       const fmatvec::Mat& getdpSH() const;
00136       /***************************************************/
00137 
00138       /* BASIC INTEGRALS */
00139       double intv(const fmatvec::Vec& vt) const;
00140       double intvx(const fmatvec::Vec& vt) const;
00141       double intxv(const fmatvec::Vec& vt) const;
00142       double intxvx(const fmatvec::Vec& vt) const;
00143       double intvw(const fmatvec::Vec& vt,const fmatvec::Vec& wt) const;
00144       double intvxwx(const fmatvec::Vec& vt,const fmatvec::Vec& wt) const;              
00145       double intvxxvxx(const fmatvec::Vec& vt,double C) const;
00146       void intvvt();            
00147       void intvvtH();
00148       void intvxvt();           
00149       void intvxvtH();          
00150       void intxvvt();           
00151       void intxvvtH();
00152       void intxvxvt();          
00153       void intxvxvtH();         
00154       fmatvec::RowVec intvwwt(const fmatvec::Vec& vt) const;
00155       fmatvec::RowVec intvxwxwt(const fmatvec::Vec& vt) const;
00156       fmatvec::RowVec intvxxwxxwt(const fmatvec::Vec& vt,double C) const;
00157       void intvvtwwt();
00158       void intvxvtwxwt();
00159       /***************************************************/
00160 
00166       void computeint(const fmatvec::Vec& qG,const fmatvec::Vec& qGt);
00167       
00173       void computeintD(const fmatvec::Vec& qG,const fmatvec::Vec& qGt);
00174       
00179       void computewcoefPos(const fmatvec::Vec& qG);
00180       
00186       void computewcoefVel(const fmatvec::Vec& qG,const fmatvec::Vec& qGt);
00187       
00192       void computewhcoefPos(const fmatvec::Vec& qG);
00193       
00199       void computewhcoefVel(const fmatvec::Vec& qG,const fmatvec::Vec& qGt);
00200       
00204       void computewcoefPosD();
00205       
00210       void computewhcoefPosD(const fmatvec::Vec& qG);
00211       
00219       fmatvec::Vec computewcoef(double dL,double dR,double bL,double bR) const; 
00220       
00225       fmatvec::Vec computew(const fmatvec::Vec& wt,double x) const;
00226 
00227     private:
00231       Trafo33RCMPtr tf;
00232 
00236       double l0, l0h2, l0h3, l0h4, l0h5, l0h7, l0h9, l0h11;
00237 
00241       double k10, k20;
00242 
00246       fmatvec::RowVec Ivvt, Ivxvt, Ixvvt, Ixvxvt;
00247       fmatvec::SymMat Ivvtwwt, Ivxvtwxwt;
00248       fmatvec::Vec IvvtH, IvxvtH, IxvvtH, IxvxvtH;
00249 
00253       double Iwh1, Iwh2, Iwh1t, Iwh2t, Ixwh1, Ixwh2, Ixwh1t, Ixwh2t;
00254       double Iwh1twh1, Iwh1twh2, Iwh1twh1t, Iwh1wh1, Iwh1wh2t, Iwh1wh2, Iwh2twh2t;      
00255       double Iwh2twh2, Iwh2wh2, Iwh1twh2t;
00256       fmatvec::RowVec Iwh1wwt, Iwh1twwt, Iwh2wwt, Iwh2twwt;
00257       fmatvec::Vec Iwh1wwtH, Iwh1twwtH, Iwh2wwtH, Iwh2twwtH;
00258 
00259       double Iwh1xwh1x, Iwh2xwh2x, Iwh1xxwh1xx, Iwh2xxwh2xx;
00260       fmatvec::RowVec Iwh1xwxwt, Iwh2xwxwt;
00261       fmatvec::RowVec Iwh1xxwxxwt, Iwh2xxwxxwt;
00262 
00266       fmatvec::Vec w1coef, w2coef, w1tcoef, w2tcoef;
00267       fmatvec::Vec wh1coef, wh2coef, wh1tcoef, wh2tcoef;
00268       fmatvec::Mat w1coefqI, w2coefqI;
00269       fmatvec::Mat wh1coefqI, wh2coefqI, wh1tcoefqI, wh2tcoefqI;
00270       fmatvec::Mat wh1coefqInunutH, wh2coefqInunutH;
00271 
00275       fmatvec::Mat tSqI, nSqI, bSqI;
00276       fmatvec::Mat tStqI, nStqI, bStqI;
00277       fmatvec::Mat nSqIH, bSqIH;
00278       fmatvec::Mat ntilSqI, btilSqI;
00279       fmatvec::RowVec xintilqI, xibtilqI, etantilqI, etabtilqI;
00280 
00284       double omgt;
00285       fmatvec::RowVec omgtqI, omgtqIt;
00286       fmatvec::Vec omgtqItqIqIt;
00287 
00291       double Ttil;
00292       fmatvec::RowVec TtilqI;
00293       fmatvec::SymMat TtilqItqIt;
00294       fmatvec::Vec TtilqItqIqIt;
00295 
00299       fmatvec::Vec gp, xip; // cannot be initialised in constructor
00300       double bam;
00301 
00305       fmatvec::Mat dpS, dpSH;
00306 
00310       void computeint();
00311       
00315       void computewcoefPos();
00316       
00320       void computewcoefVel();
00321       
00325       void computewhcoefPos();
00326       
00330       void computewhcoefVel();
00331       
00335       void computewhcoefPosD();
00336       
00340       void computewhcoefVelD();
00341 
00344       void computeomgt(double x);
00345       
00349       void computeT();
00350       
00354       void computedpS();                        
00355   };
00356 
00357   inline void Weight33RCM::setCurvature(double k10_,double k20_) { k10 = k10_; k20 = k20_; }
00358   inline void Weight33RCM::intvvtH() { IvvtH = Ivvt.T(); }
00359   inline void Weight33RCM::intvxvtH() { IvxvtH = Ivxvt.T(); }   
00360   inline void Weight33RCM::intxvvtH() { IxvvtH = Ixvvt.T(); }
00361   inline void Weight33RCM::intxvxvtH() { IxvxvtH = Ixvxvt.T(); }
00362 
00363   inline const fmatvec::RowVec& Weight33RCM::getvxvt() const { return Ivxvt; }
00364   inline const fmatvec::Vec& Weight33RCM::getvxvtH() const { return IvxvtH; }
00365   inline const fmatvec::RowVec& Weight33RCM::getxvxvt() const { return Ixvxvt; }
00366   inline const fmatvec::Vec& Weight33RCM::getxvxvtH() const { return IxvxvtH; }
00367   inline const fmatvec::SymMat& Weight33RCM::getvxvtwxwt() const { return Ivxvtwxwt; }
00368   inline const fmatvec::RowVec& Weight33RCM::getvvt() const { return Ivvt; }
00369   inline const fmatvec::Vec& Weight33RCM::getvvtH() const { return IvvtH; }
00370   inline const fmatvec::RowVec& Weight33RCM::getxvvt() const { return Ixvvt; }
00371   inline const fmatvec::Vec& Weight33RCM::getxvvtH() const { return IxvvtH; }
00372   inline const fmatvec::SymMat& Weight33RCM::getvvtwwt() const { return Ivvtwwt; }
00373 
00374   inline const double& Weight33RCM::getIwh1() const { return Iwh1; }
00375   inline const double& Weight33RCM::getIwh2() const { return Iwh2; }
00376   inline const double& Weight33RCM::getIwh1t() const { return Iwh1t; }  
00377   inline const double& Weight33RCM::getIwh2t() const { return Iwh2t; }
00378   inline const double& Weight33RCM::getIxwh1() const { return Ixwh1; }
00379   inline const double& Weight33RCM::getIxwh2() const { return Ixwh2; }
00380   inline const double& Weight33RCM::getIxwh1t() const { return Ixwh1t; }
00381   inline const double& Weight33RCM::getIxwh2t() const { return Ixwh2t; }                
00382   inline const double& Weight33RCM::getIwh1twh1() const { return Iwh1twh1; }
00383   inline const double& Weight33RCM::getIwh1twh2() const { return Iwh1twh2; }
00384   inline const double& Weight33RCM::getIwh1twh1t() const { return Iwh1twh1t; }
00385   inline const double& Weight33RCM::getIwh1wh1() const { return Iwh1wh1; }
00386   inline const double& Weight33RCM::getIwh1wh2t() const { return Iwh1wh2t; }            
00387   inline const double& Weight33RCM::getIwh1wh2() const { return Iwh1wh2; }
00388   inline const double& Weight33RCM::getIwh2twh2t() const { return Iwh2twh2t; }
00389   inline const double& Weight33RCM::getIwh2twh2() const { return Iwh2twh2; }
00390   inline const double& Weight33RCM::getIwh2wh2() const { return Iwh2wh2; }
00391   inline const double& Weight33RCM::getIwh1twh2t() const { return Iwh1twh2t; }          
00392   inline const double& Weight33RCM::getIwh1xwh1x() const { return Iwh1xwh1x; }
00393   inline const double& Weight33RCM::getIwh2xwh2x() const { return Iwh2xwh2x; }
00394   inline const double& Weight33RCM::getIwh1xxwh1xx() const { return Iwh1xxwh1xx; }
00395   inline const double& Weight33RCM::getIwh2xxwh2xx() const { return Iwh2xxwh2xx; }      
00396   inline const fmatvec::RowVec& Weight33RCM::getIwh1xxwxxwt() const { return Iwh1xxwxxwt; }
00397   inline const fmatvec::RowVec& Weight33RCM::getIwh2xxwxxwt() const { return Iwh2xxwxxwt; }
00398   inline const fmatvec::RowVec& Weight33RCM::getIwh1wwt() const { return Iwh1wwt; }
00399   inline const fmatvec::RowVec& Weight33RCM::getIwh2wwt() const { return Iwh2wwt; }
00400   inline const fmatvec::Vec& Weight33RCM::getIwh1wwtH() const { return Iwh1wwtH; }
00401   inline const fmatvec::Vec& Weight33RCM::getIwh2wwtH() const { return Iwh2wwtH; }
00402   inline const fmatvec::RowVec& Weight33RCM::getIwh1twwt() const { return Iwh1twwt; }                   
00403   inline const fmatvec::RowVec& Weight33RCM::getIwh2twwt() const { return Iwh2twwt; }
00404   inline const fmatvec::Vec& Weight33RCM::getIwh1twwtH() const { return Iwh1twwtH; }                    
00405   inline const fmatvec::Vec& Weight33RCM::getIwh2twwtH() const { return Iwh2twwtH; }
00406   inline const fmatvec::RowVec& Weight33RCM::getIwh1xwxwt() const { return Iwh1xwxwt; }
00407   inline const fmatvec::RowVec& Weight33RCM::getIwh2xwxwt() const { return Iwh2xwxwt; }
00408 
00409   inline const fmatvec::Vec& Weight33RCM::getw1coef() const { return w1coef; }
00410   inline const fmatvec::Vec& Weight33RCM::getw2coef() const { return w2coef; }
00411   inline const fmatvec::Vec& Weight33RCM::getw1tcoef() const { return w1tcoef; }
00412   inline const fmatvec::Vec& Weight33RCM::getw2tcoef() const { return w2tcoef; }
00413   inline const fmatvec::Mat& Weight33RCM::getw1coefqI() const { return w1coefqI; }
00414   inline const fmatvec::Mat& Weight33RCM::getw2coefqI() const { return w2coefqI; }
00415   inline const fmatvec::Vec& Weight33RCM::getwh1coef() const { return wh1coef; }
00416   inline const fmatvec::Vec& Weight33RCM::getwh2coef() const { return wh2coef; }
00417   inline const fmatvec::Vec& Weight33RCM::getwh1tcoef() const { return wh1tcoef; }
00418   inline const fmatvec::Vec& Weight33RCM::getwh2tcoef() const { return wh2tcoef; }
00419   inline const fmatvec::Mat& Weight33RCM::getwh1coefqI() const { return wh1coefqI; }
00420   inline const fmatvec::Mat& Weight33RCM::getwh2coefqI() const { return wh2coefqI; }
00421   inline fmatvec::Mat Weight33RCM::getwh1coefqIH() const { return wh1coefqI.T(); }
00422   inline fmatvec::Mat Weight33RCM::getwh2coefqIH() const { return wh2coefqI.T(); }
00423   inline const fmatvec::Mat& Weight33RCM::getwh1tcoefqI() const { return wh1tcoefqI; }
00424   inline const fmatvec::Mat& Weight33RCM::getwh2tcoefqI() const { return wh2tcoefqI; }
00425   inline const fmatvec::Mat& Weight33RCM::getwh1coefqInunutH() const { return wh1coefqInunutH; }
00426   inline const fmatvec::Mat& Weight33RCM::getwh2coefqInunutH() const { return wh2coefqInunutH; }
00427 
00428   inline const fmatvec::Mat& Weight33RCM::gettSqI() const { return tSqI; }
00429   inline const fmatvec::Mat& Weight33RCM::getnSqI() const { return nSqI; }
00430   inline const fmatvec::Mat& Weight33RCM::getbSqI() const { return bSqI; }
00431   inline const fmatvec::Mat& Weight33RCM::getnSqIH() const { return nSqIH; }
00432   inline const fmatvec::Mat& Weight33RCM::getbSqIH() const { return bSqIH; }
00433   inline const fmatvec::Mat& Weight33RCM::gettStqI() const { return tStqI; }
00434   inline const fmatvec::Mat& Weight33RCM::getnStqI() const { return nStqI; }
00435   inline const fmatvec::Mat& Weight33RCM::getbStqI() const { return bStqI; }
00436 
00437   inline const double& Weight33RCM::getTtil() const { return Ttil; }
00438   inline const fmatvec::RowVec& Weight33RCM::getTtilqI() const { return TtilqI; }
00439   inline const fmatvec::SymMat& Weight33RCM::getTtilqItqIt() const { return TtilqItqIt; }
00440   inline const fmatvec::Vec& Weight33RCM::getTtilqItqIqIt() const { return TtilqItqIqIt; }
00441 
00442   inline const fmatvec::Mat& Weight33RCM::getdpS() const { return dpS; }
00443   inline const fmatvec::Mat& Weight33RCM::getdpSH() const { return dpSH; }
00444   /*******************************************************************/
00445 
00446 }
00447 
00448 #endif /*WEIGHT33RCM_H_*/
00449