|
mbsimflexiblebody
3.2.0
|
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
1.8.0