dopri5_integrator.h

/* Copyright (C) 2004-2006  Martin Förg
 
 * This library is free software; you can redistribute it and/or 
 * modify it under the terms of the GNU Lesser General Public 
 * License as published by the Free Software Foundation; either 
 * version 2.1 of the License, or (at your option) any later version. 
 *  
 * This library is distributed in the hope that it will be useful, 
 * but WITHOUT ANY WARRANTY; without even the implied warranty of 
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU 
 * Lesser General Public License for more details. 
 *  
 * You should have received a copy of the GNU Lesser General Public 
 * License along with this library; if not, write to the Free Software 
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301 USA
 
 *
 * Contact:
 *   martin.o.foerg@googlemail.com
 *
 */
 
#ifndef _DOPRI5_INTEGRATOR_H_
#define _DOPRI5_INTEGRATOR_H_
 
#include "root_finding_integrator.h"
 
namespace MBSim {
 
  class DOPRI5Integrator : public RootFindingIntegrator {
 
    private:
 
      static void fzdot(int* n, double* t, double* z, double* zd, double* rpar, int* ipar);
      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);
 
      double tPlot{0};
      double dtOut{0};
      double s0; 
      double time{0};
 
      fmatvec::Vec aTol;
      fmatvec::Vec rTol;
      double dt0{0};
      int maxSteps{std::numeric_limits<int>::max()};
      double dtMax{0};
 
      bool drift { false };
 
      std::exception_ptr exception;
 
    public:
 
      ~DOPRI5Integrator() override = default;
 
      const fmatvec::Vec& getAbsoluteTolerance() const { return aTol; }
      const fmatvec::Vec& getRelativeTolerance() const { return rTol; }
      double getInitialStepSize() const { return dt0; }
      int getStepLimit() const { return maxSteps; }
      double getMaximumStepSize() const { return dtMax; }
 
      void setAbsoluteTolerance(const fmatvec::Vec &aTol_) { aTol <<= aTol_; }
      void setAbsoluteTolerance(double aTol_) { aTol.resize(1,fmatvec::INIT,aTol_); }
      void setRelativeTolerance(const fmatvec::Vec &rTol_) { rTol <<= rTol_; }
      void setRelativeTolerance(double rTol_) { rTol.resize(1,fmatvec::INIT,rTol_); }
      void setInitialStepSize(double dt0_) { dt0 = dt0_; }
      void setStepLimit(int maxSteps_) { maxSteps = maxSteps_; }
      void setMaximumStepSize(double dtMax_) { dtMax = dtMax_; }
 
      using Integrator::integrate;
      void integrate() override;
 
      void initializeUsingXML(xercesc::DOMElement *element) override;
  };
 
}
 
#endif