MBSim

Project Page
dopri5_integrator.h
1 /* Copyright (C) 2004-2006 Martin Förg
2 
3  * This library is free software; you can redistribute it and/or
4  * modify it under the terms of the GNU Lesser General Public
5  * License as published by the Free Software Foundation; either
6  * version 2.1 of the License, or (at your option) any later version.
7  *
8  * This library is distributed in the hope that it will be useful,
9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11  * Lesser General Public License for more details.
12  *
13  * You should have received a copy of the GNU Lesser General Public
14  * License along with this library; if not, write to the Free Software
15  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
16 
17  *
18  * Contact:
19  * martin.o.foerg@googlemail.com
20  *
21  */
22 
23 #ifndef _DOPRI5_INTEGRATOR_H_
24 #define _DOPRI5_INTEGRATOR_H_
25 
26 #include "integrator.h"
27 
28 namespace MBSim {
29 
33  class DOPRI5Integrator : public Integrator {
34 
35  private:
36 
37  static void fzdot(int* n, double* t, double* z, double* zd, double* rpar, int* ipar);
38  static void plot(int* nr, double* told, double* t,double* z, int* n, double* con, int* icomp, int* nd, double* rpar, int* ipar, int* irtrn);
39 
40  static double tPlot;
41  static double dtOut;
42  static fmatvec::Vec zInp;
43  static bool output_;
44  static std::ofstream integPlot;
45  static double s0;
46  static double time;
47  //static int integrationSteps;
48 
50  fmatvec::Vec aTol;
52  fmatvec::Vec rTol;
54  double dt0;
56  int maxSteps;
58  double dtMax;
59 
60  public:
61 
63  ~DOPRI5Integrator() {}
64 
65  void setAbsoluteTolerance(const fmatvec::Vec &aTol_) {aTol.resize() = aTol_;}
66  void setAbsoluteTolerance(double aTol_) {aTol.resize() = fmatvec::Vec(1,fmatvec::INIT,aTol_);}
67  void setRelativeTolerance(const fmatvec::Vec &rTol_) {rTol.resize() = rTol_;}
68  void setRelativeTolerance(double rTol_) {rTol.resize() = fmatvec::Vec(1,fmatvec::INIT,rTol_);}
69  void setInitialStepSize(double dt0_) {dt0 = dt0_;}
70  void setMaxStepNumber(int maxSteps_) {maxSteps = maxSteps_;}
71  void setMaximalStepSize(double dtMax_) {dtMax = dtMax_;}
72 
73  void integrate(DynamicSystemSolver& system);
74 
75  virtual void initializeUsingXML(TiXmlElement *element);
76  };
77 
78 }
79 
80 #endif