MBSim

Project Page
auxiliary_functions.h
00001 /* Copyright (C) 2004-2009 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: martin.o.foerg@googlemail.com
00018  */
00019 
00020 #ifndef AUXILIARY_FUNCTIONS_H_
00021 #define AUXILIARY_FUNCTIONS_H_
00022 
00023 #include "mbsim/functions/function.h"
00024 
00025 namespace MBSim {
00026 
00027   template <class Ret>
00028     class StateDependentFunction : public Function<Ret(fmatvec::VecV,double)> {
00029       private:
00030         Function<Ret(fmatvec::VecV)> *f;
00031         int n;
00032       public:
00033         StateDependentFunction(Function<Ret(fmatvec::VecV)> *f_=NULL) : f(f_), n(0) { 
00034           if(f) {
00035             n = (*f)(fmatvec::VecV(getArg1Size())).rows();
00036             f->setParent(this);
00037           }
00038         }
00039         ~StateDependentFunction() { delete f; }
00040         typename fmatvec::Size<fmatvec::VecV>::type getArg1Size() const { return f->getArgSize();}
00041         typename fmatvec::Size<double>::type getArg2Size() const { return 0; }
00042         Ret operator()(const fmatvec::VecV &arg1, const double &arg2) {return (*f)(arg1); }
00043         typename fmatvec::Der<Ret, fmatvec::VecV>::type parDer1(const fmatvec::VecV &arg1, const double &arg2) { return f->parDer(arg1); }
00044         typename fmatvec::Der<Ret, double>::type parDer2(const fmatvec::VecV &arg1, const double &arg2) {return typename fmatvec::Der<Ret, double>::type(n); }
00045         typename fmatvec::Der<typename fmatvec::Der<Ret, double>::type, double>::type parDer2ParDer2(const fmatvec::VecV &arg1, const double &arg2) { return typename fmatvec::Der<typename fmatvec::Der<Ret, double>::type, double>::type(n); }
00046         typename fmatvec::Der<Ret, double>::type parDer2DirDer1(const fmatvec::VecV &arg1Dir, const fmatvec::VecV &arg1, const double &arg2) { return typename fmatvec::Der<Ret, double>::type(n); }
00047         typename fmatvec::Der<typename fmatvec::Der<Ret, fmatvec::VecV>::type, double>::type parDer1ParDer2(const fmatvec::VecV &arg1, const double &arg2) { return typename fmatvec::Der<typename fmatvec::Der<Ret, fmatvec::VecV>::type, double>::type(n,getArg1Size()); }
00048         typename fmatvec::Der<Ret, fmatvec::VecV>::type parDer1DirDer1(const fmatvec::VecV &arg1Dir, const fmatvec::VecV &arg1, const double &arg2) { return f->parDerDirDer(arg1Dir,arg1); }
00049         bool constParDer1() const { return f->constParDer(); }
00050         bool constParDer2() const { return true; }
00051         Function<Ret(fmatvec::VecV)>* getFunction() const { return f; }
00052         void init(Element::InitStage stage) {
00053           Function<Ret(fmatvec::VecV,double)>::init(stage);
00054           if(f)
00055             f->init(stage);
00056         }
00057     };
00058 
00059    template <class Ret>
00060     class TimeDependentFunction : public Function<Ret(fmatvec::VecV,double)> {
00061       private:
00062         Function<Ret(double)> *f;
00063         int n;
00064       public:
00065         TimeDependentFunction(Function<Ret(double)> *f_=NULL) : f(f_), n(0) { 
00066           if(f) {
00067             n = (*f)(0).rows();
00068             f->setParent(this);
00069           }
00070         }
00071         ~TimeDependentFunction() { delete f; }
00072         typename fmatvec::Size<fmatvec::VecV>::type getArg1Size() const { return 0;}
00073         typename fmatvec::Size<double>::type getArg2Size() const { return 1; }
00074         Ret operator()(const fmatvec::VecV &arg1, const double &arg2) {return (*f)(arg2); }
00075         typename fmatvec::Der<Ret, fmatvec::VecV>::type parDer1(const fmatvec::VecV &arg1, const double &arg2) { return typename fmatvec::Der<Ret, fmatvec::VecV>::type(n,getArg1Size()); }
00076         typename fmatvec::Der<Ret, double>::type parDer2(const fmatvec::VecV &arg1, const double &arg2) {return f->parDer(arg2); }
00077         typename fmatvec::Der<typename fmatvec::Der<Ret, double>::type, double>::type parDer2ParDer2(const fmatvec::VecV &arg1, const double &arg2) { return f->parDerParDer(arg2); }
00078         typename fmatvec::Der<Ret, double>::type parDer2DirDer1(const fmatvec::VecV &arg1Dir, const fmatvec::VecV &arg1, const double &arg2) { return typename fmatvec::Der<Ret, double>::type(n); }
00079         typename fmatvec::Der<typename fmatvec::Der<Ret, fmatvec::VecV>::type, double>::type parDer1ParDer2(const fmatvec::VecV &arg1, const double &arg2) { return typename fmatvec::Der<typename fmatvec::Der<Ret, fmatvec::VecV>::type, double>::type(n,getArg1Size()); }
00080         typename fmatvec::Der<Ret, fmatvec::VecV>::type parDer1DirDer1(const fmatvec::VecV &arg1Dir, const fmatvec::VecV &arg1, const double &arg2) { return typename fmatvec::Der<Ret, fmatvec::VecV>::type(n,getArg1Size()); }
00081         bool constParDer1() const { return true; }
00082         bool constParDer2() const { return f->constParDer(); }
00083         void init(Element::InitStage stage) {
00084           Function<Ret(fmatvec::VecV,double)>::init(stage);
00085           if(f)
00086             f->init(stage);
00087         }
00088     };
00089 
00090 }
00091 
00092 #endif
00093