00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
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