MBSim

Project Page
lsodar_integrator.h
00001 /* Copyright (C) 2004-2006  Martin Förg
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  *
00018  * Contact:
00019  *   martin.o.foerg@googlemail.com
00020  *
00021  */
00022 
00023 #ifndef _LSODAR_INTEGRATOR_H_
00024 #define _LSODAR_INTEGRATOR_H_
00025 
00026 #include "integrator.h"
00027 
00028 namespace MBSimIntegrator {
00029 
00033   class LSODARIntegrator : public Integrator {
00034     private:
00035 
00036       static void fzdot(int* zSize, double* t, double* z_, double* zd_);
00037       static void fsv(int* zSize, double* t, double* z_, int* nsv, double* sv_);
00038 
00040       double dtMax;
00042       double dtMin;
00044       fmatvec::Vec aTol;
00046       double rTol;
00048       double dt0;
00049 
00050       bool plotOnRoot;
00051 
00052       int zSize, iTol, istate, nsv, lrWork, liWork, integrationSteps;
00053       double t, tPlot, s0, time;
00054       fmatvec::Vec z, rWork;
00055       fmatvec::VecInt iWork, jsv;
00056       std::ofstream integPlot;
00057     public:
00058 
00059       LSODARIntegrator();
00060       ~LSODARIntegrator() {}
00061 
00062       void setMaximalStepSize(double dtMax_) {dtMax = dtMax_;}
00063       void setMinimalStepSize(double dtMin_) {dtMin = dtMin_;}
00064       void setAbsoluteTolerance(const fmatvec::Vec &aTol_) {aTol = aTol_;}
00065       void setAbsoluteTolerance(double aTol_) {aTol = fmatvec::Vec(1,fmatvec::INIT,aTol_);}
00066       void setRelativeTolerance(double rTol_) {rTol = rTol_;}
00067       void setInitialStepSize(double dt0_) {dt0 = dt0_;}
00068 
00069       void setPlotOnRoot(bool b) {plotOnRoot = b;}
00070 
00071       void integrate(MBSim::DynamicSystemSolver& system);
00072       void preIntegrate(MBSim::DynamicSystemSolver& system);
00073       void subIntegrate(MBSim::DynamicSystemSolver& system, double tStop);
00074       void postIntegrate(MBSim::DynamicSystemSolver& system);
00075 
00076       virtual void initializeUsingXML(xercesc::DOMElement *element);
00077       virtual xercesc::DOMElement* writeXMLFile(xercesc::DOMNode *element);
00078 
00079       virtual std::string getType() const { return "LSODARIntegrator"; }
00080   };
00081 
00082 }
00083 
00084 #endif