MBSim

Project Page
radau5_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 _RADAU5_INTEGRATOR_H_
24 #define _RADAU5_INTEGRATOR_H_
25 
26 #include "integrator.h"
27 
28 namespace MBSim {
29 
32  class RADAU5Integrator : public Integrator {
33 
34  private:
35 
36  static void fzdot(int* n, double* t, double* z, double* zd, double* rpar, int* ipar);
37  static void plot(int* nr, double* told, double* t, double* z, double* cont, int* lrc, int* n, double* rpar, int* ipar, int* irtrn);
38 
39  static double tPlot;
40  static double dtOut;
41  static fmatvec::Vec zInp;
42  static std::ofstream integPlot;
43  static double s0;
44  static double time;
45  static bool output_;
46 
48  fmatvec::Vec aTol;
50  fmatvec::Vec rTol;
52  double dt0;
54  int maxSteps;
56  double dtMax;
57 
58  public:
59 
61  ~RADAU5Integrator() {}
62 
63  void setAbsoluteTolerance(const fmatvec::Vec &aTol_) {aTol.resize() = aTol_;}
64  void setAbsoluteTolerance(double aTol_) {aTol.resize() = fmatvec::Vec(1,fmatvec::INIT,aTol_);}
65  void setRelativeTolerance(const fmatvec::Vec &rTol_) {rTol.resize() = rTol_;}
66  void setRelativeTolerance(double rTol_) {rTol.resize() = fmatvec::Vec(1,fmatvec::INIT,rTol_);}
67  void setInitialStepSize(double dt0_) {dt0 = dt0_;}
68  void setMaximalStepSize(double dtMax_) {dtMax = dtMax_;}
69  void setMaxStepNumber(int maxSteps_) {maxSteps = maxSteps_;}
70 
71 
72  void integrate(DynamicSystemSolver& system);
73 
74  virtual void initializeUsingXML(TiXmlElement *element);
75  };
76 
77 }
78 
79 #endif