00001 /* **-*-c++-*-************************************************************** 00002 Copyright (C)2002 David Jung <opensim@pobox.com> 00003 00004 This program/file is free software; you can redistribute it and/or modify 00005 it under the terms of the GNU General Public License as published by 00006 the Free Software Foundation; either version 2 of the License, or 00007 (at your option) any later version. 00008 00009 This program is distributed in the hope that it will be useful, 00010 but WITHOUT ANY WARRANTY; without even the implied warranty of 00011 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 00012 GNU General Public License for more details. (http://www.gnu.org) 00013 00014 You should have received a copy of the GNU General Public License 00015 along with this program; if not, write to the Free Software 00016 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 00017 00018 $Id: ParametricTrajectoryRep 1029 2004-02-11 20:45:54Z jungd $ 00019 $Revision: 1.1 $ 00020 $Date: 2004-02-11 15:45:54 -0500 (Wed, 11 Feb 2004) $ 00021 $Author: jungd $ 00022 00023 ****************************************************************************/ 00024 00025 #ifndef _BASE_PARAMETRICTRAJECTORYREP_ 00026 #define _BASE_PARAMETRICTRAJECTORYREP_ 00027 00028 #include <base/TrajectoryTimeRep> 00029 #include <base/ParametricPathRep> 00030 #include <base/Math> 00031 00032 00033 namespace base { 00034 00035 00036 /// Concrete trajectory representation as a set symbolic parametric equations for positions/orientation and time in terms of s in [0..1] 00037 class ParametricTrajectoryRep : public ParametricPathRep, public TrajectoryTimeRep 00038 { 00039 public: 00040 ParametricTrajectoryRep(const ExpressionVector& p); 00041 00042 virtual Object& clone() const 00043 { return *NewObj ParametricTrajectoryRep(v,times,flags); } 00044 00045 virtual String className() const { return String("ParametricTrajectoryRep"); } 00046 00047 /// get time at s:[0..1] 00048 virtual Time time(Real s) const; 00049 00050 /// shift time by dt 00051 virtual void shiftTime(const Time& dt); 00052 00053 /// scale time by s 00054 virtual void scaleTime(Real s); 00055 00056 /// get parameter s value at time t 00057 virtual Real gets(const Time& t) const; 00058 00059 virtual void serialize(Serializer& s); 00060 00061 protected: 00062 ParametricTrajectoryRep() {} 00063 ParametricTrajectoryRep(const ExpressionVector& v, const Expression& times, Int flags) 00064 : times(times) { this->v = v; this->flags = flags; } 00065 00066 Expression times; 00067 inline Real eval(Real s) const { Vector param(1); param[0]=s; return times.evaluate(param); } 00068 00069 void linearFit(Real& a, Real &b) const; ///< fits the line t = a*s + b to the expression in times 00070 00071 friend class Trajectory; 00072 friend class Serializable::SerializableDerivedInstantiator<ParametricTrajectoryRep>; 00073 }; 00074 00075 00076 } // base 00077 00078 #endif