robLSPB.h

Go to the documentation of this file.

/* -*- Mode: C++; tab-width: 4; indent-tabs-mode: nil; c-basic-offset: 4 -*-    */
/* ex: set filetype=cpp softtabstop=4 shiftwidth=4 tabstop=4 cindent expandtab: */
 
/*
  Author(s):  Anton Deguet
  Created on: 2014-10-27
 
  (C) Copyright 2014 Johns Hopkins University (JHU), All Rights Reserved.
 
--- begin cisst license - do not edit ---
 
This software is provided "as is" under an open source license, with
no warranty.  The complete license can be found in license.txt and
http://www.cisst.org/cisst/license.txt.
 
--- end cisst license ---
*/
 
#ifndef _robLSPB_h
#define _robLSPB_h
 
#include <cisstVector/vctDynamicVectorTypes.h>
 
 
// Always include last
#include <cisstRobot/robExport.h>

class CISST_EXPORT robLSPB {
 
 public:
    typedef enum {LSPB_NONE, LSPB_DURATION} CoordinationType;
 
 protected:
    bool mIsSet;        
    size_t mDimension;  
    double mStartTime;  
    double mDuration;   
 
    CoordinationType mCoordination;
 
    vctDoubleVec
        mStart,
        mFinish,
        mVelocity,
        mAcceleration,
        mAccelerationTime,
        mFinishTime,
        mTimeScale,
        mTemp;
 
 public:
    robLSPB(void);
    robLSPB(const vctDoubleVec & start,
            const vctDoubleVec & finish,
            const vctDoubleVec & velocity,
            const vctDoubleVec & acceleration,
            const double startTime = 0.0,
            const CoordinationType coordination = LSPB_NONE);
 
    ~robLSPB() {};

    void Set(const vctDoubleVec & start,
             const vctDoubleVec & finish,
             const vctDoubleVec & velocity,
             const vctDoubleVec & acceleration,
             const double startTime = 0.0,
             const CoordinationType coordination = LSPB_NONE);
 
    void Evaluate(const double time,
                  vctDoubleVec & position,
                  vctDoubleVec & velocity,
                  vctDoubleVec & acceleration);
 
    void Evaluate(const double time,
                  vctDoubleVec & position);

    double & StartTime(void);

    double Duration(void) const;
};
 
#endif // _robLSPB_h