OsgAnimatSim/OsgLinearPath.h

#pragma once

#include <osg/Referenced>

namespace OsgAnimatSim
{
        namespace Visualization
        {

                class OsgLinearPath;
                class OsgScriptedSimulationWindow;

class ANIMAT_OSG_PORT ControlPoint : public osg::Referenced, public AnimatSim::AnimatBase
{
public:
    // constructor
    ControlPoint(const double t, const osg::Vec3d pos, const osg::Vec3d v) 
    :   AnimatBase(), 
                m_Pos(pos),
        m_vDist(0, 0, 0),
        m_dblDist(0),
        m_V(v),
        m_T(t),
        m_Uv(osg::Vec3d(0.0, 0.0, 0.0)),
        m_IsDirty(true), 
                m_lpParentSpline(NULL),
                m_Tnext(0)
    {}

        ControlPoint()
    :   AnimatBase(), 
                m_Pos(0, 0, 0),
        m_vDist(0, 0, 0),
        m_dblDist(0),
        m_V(0, 0, 0),
        m_T(0),
        m_Uv(osg::Vec3d(0.0, 0.0, 0.0)),
        m_IsDirty(true), 
                m_lpParentSpline(NULL),
                m_Tnext(0)
        {}

protected:
    // destructor
    ~ControlPoint()
    {}

public:
    // position of the point
    osg::Vec3d m_Pos;
        //report position
    osg::Vec3d m_ReportPos;
        // Distance vector for this section of the path
        osg::Vec3d m_vDist;
        //Linear distance for this section of the path
        double m_dblDist;
        // Velocity for this section of the path
    osg::Vec3d m_V;
    // unit vector from this waypoint to next.
    osg::Vec3d m_Uv;
    // time at the position
    double m_T;
        // time at next waypoint.
        double m_Tnext;
    // flag if the transformed position is dirty
    bool m_IsDirty;

        OsgLinearPath *m_lpParentSpline;

        virtual osg::Vec3d Position();
        virtual void Position(CStdFPoint &oPoint, bool bUseScaling = true);
        virtual void Position(float fltX, float fltY, float fltZ, bool bUseScaling = true);
        virtual void Position(std::string strXml, bool bUseScaling = true);

        virtual double Time();
        virtual void Time(double dblVal);

        virtual OsgLinearPath *ParentSpline() {return m_lpParentSpline;}; 
        virtual void ParentSpline(OsgLinearPath *lpParentSpline) {m_lpParentSpline = lpParentSpline;};

        virtual bool SetData(const std::string &strDataType, const std::string &strValue, bool bThrowError = true);
        virtual void QueryProperties(CStdPtrArray<TypeProperty> &aryProperties);
        virtual void Load(StdUtils::CStdXml &oXml);
};


class ANIMAT_OSG_PORT OsgLinearPath : public osg::Referenced, public AnimatSim::AnimatBase
{

public:

    class ANIMAT_OSG_PORT ControlPointTransformFunctor
    {
    public:

        // destructor
        ControlPointTransformFunctor() {}
        // constructor
        ~ControlPointTransformFunctor() {}

    public:

        // transform a control point position to user frame position
        virtual osg::Vec3d Transform(const osg::Vec3d p) { return p; }
    };


public:

    // list of control points
    typedef std::vector<osg::ref_ptr<ControlPoint> > PointListType;

public:
    // constructor
    OsgLinearPath();
    // destructor
    ~OsgLinearPath();

public:

    // Control Point methods

    // add a control point
    bool AddControlPoint(const osg::Vec3d point, const double time);
    
    // add a control point
    bool AddControlPoint(ControlPoint *p);
    
    // clear all control points 
    void ClearAllControlPoints();
    
    // return the number of control points in the curve
    unsigned int GetNumberOfControlPoints() { return m_ControlPoints.size(); }

    // return control point by index
    ControlPoint* GetControlPoint(const unsigned int i) { return m_ControlPoints[i].get(); }

    // Method to create and retrieve output curve

    virtual osg::Node *CreateTestGeom(const bool showControlPoints = false,
        const unsigned int numSamples = 3, 
        ControlPointTransformFunctor* xform = NULL);

    virtual bool Interpolate(const double t);

    // return last interpolated position (dbu)
    osg::Vec3d &GetInterpPosition() { return m_Interpolated; }

        osg::Vec3d GetPositionAtTime(const double t);

        virtual CStdColor *LineColor();
        virtual void LineColor(CStdColor &aryColor);
        virtual void LineColor(float *aryColor);
        virtual void LineColor(std::string strXml);
        
        virtual std::string PartID();
        virtual void PartID(std::string strID);

        virtual double StartTime();
        virtual void StartTime(double dblTime, bool bSortPaths = true);

        virtual double EndTime();
        virtual void EndTime(double dblTime, bool bSortPaths = true);

        virtual bool Visible();
        virtual void Visible(bool bVal);

        virtual bool VisibleInSim();
        virtual void VisibleInSim(bool bVal);

        virtual bool ShowWaypoints();
        virtual void ShowWaypoints(bool bVal);

        virtual BodyPart *TrackBody() {return m_lpTrackBody;};

        virtual void SimStarting();
        virtual void ResetSimulation();

        virtual bool SetData(const std::string &strDataType, const std::string &strValue, bool bThrowError = true);
        virtual void QueryProperties(CStdPtrArray<TypeProperty> &aryProperties);
        virtual bool AddItem(const std::string &strItemType, const std::string &strXml, bool bThrowError = true, bool bDoNotInit = false);
        virtual bool RemoveItem(const std::string &strItemType, const std::string &strID, bool bThrowError = true);
        virtual void Initialize();
        virtual void Load(StdUtils::CStdXml &oXml);

        virtual void RedrawCurve();

        virtual bool BeforePathTime(double dblTime);
        virtual bool WithinPathTime(double dblTime);
        virtual bool AfterPathTime(double dblTime);

        virtual OsgScriptedSimulationWindow *ParentWindow() {return m_lpParentWindow;};
        virtual void ParentWindow(OsgScriptedSimulationWindow *lpWnd) {m_lpParentWindow = lpWnd;};

protected:

    void InvalidateCurve();
    bool BuildCurve();

        void RemoveCurve();

        void FindCurrentWaypoint(const double t);

        osg::ref_ptr<ControlPoint> LoadWaypoint(CStdXml &oXml);

        virtual void AddWaypoint(std::string strXml);
        virtual void RemoveWaypoint(std::string strID, bool bThrowError = true);
        virtual int FindWaypointPos(std::string strID, bool bThrowError = true);
        virtual void MakeVisible(bool bVal);

protected:

    // if true, curve holds valid points
    bool m_CurveIsValid;

    // list of 3D control points sorted by time
    PointListType m_ControlPoints;
    
    // last interpolated position (dbu)
    osg::Vec3d m_Interpolated;

        //ID of the part to look at while this path is playing out.
        std::string m_strPartID;

        //Part to look at during camera path playback
        BodyPart *m_lpTrackBody;

        //Start time for this path.
        double m_dblStartTime;

        //End time for this path
        double m_dblEndTime;

        //Line color to use
        CStdColor m_vLineColor;

        //Turns visibility of line on/off while not running.
        bool m_bVisible;

        //Turns visibility of line on/off while running simulation
        bool m_bVisibleInSim;

        //Tells if we should show the waypoints or not.
        bool m_bShowWaypoints;

        //The osg spline node
        osg::ref_ptr<osg::Node> m_osgSpline;

        OsgScriptedSimulationWindow *m_lpParentWindow;

        //the current waypoint being evaluated
        ControlPoint *m_lpCurrentWaypoint;

        //index of the current waypoint being evaluated.
        int m_iCurrentWaypointIdx;
};


        }                       // Visualization
//}                             //OsgAnimatSim

}