Interpolator3D.h

Go to the documentation of this file.

/*
 * Interpolator3D.h
 *
 *  Created on: Apr 17, 2015
 *      Author: leven
 */

#ifndef INTERPOLATOR3D_H_
#define INTERPOLATOR3D_H_


#include "Macros_Convenience.h"
#include "Math/Interpolator.h"
#include "utl/UTMPoint.h"
#include "utl/Vector.h"
#include "utl/CoordinateSystemPtr.h"
#include "utl/TimeStamp.h"

#include "Math/Interpolator.h"

#include <vector>
#include <string>

namespace RdAirplane {

class Flight;

class Interpolator3D {
  public:
    Interpolator3D(
      const std::vector<const utl::TimeStamp*>& pTimes,
      const std::vector<const utl::UTMPoint*>& pCoordinates,
      Flight* pFlight);


    utl::Point getCoordinates(const utl::TimeStamp& pTime) const;

    utl::Vector getDerivative(const utl::TimeStamp& pTime) const;

    bool isTimeInInterpolatedRange(const utl::TimeStamp& pTime) const;

    std::string getInformation() const;

    virtual ~Interpolator3D();

  private:
    DISALLOW_COPY_AND_ASSIGN(Interpolator3D);
    static double _timeFromTimeStamp(const utl::TimeStamp& pTime);
    static std::vector<double> _timesFromTimeStamps(const std::vector<const utl::TimeStamp*>& pTimes);
    static boost::tuple<double,double> _verySimpleLinearFit(const std::vector<double>& pX, const std::vector<double>& pY);
    static utl::CoordinateSystemPtr _coordinateSystem();
    static void _getCoordinates(
        const std::vector<const utl::UTMPoint*>& pCoordinates,
        std::vector<double>* p_OUT_xs,
        std::vector<double>* p_OUT_ys,
        std::vector<double>* p_OUT_zs);
    static void _getGeodeticCoordinates(
        const std::vector<const utl::UTMPoint*>& pCoordinates,
        std::vector<double>* p_OUT_latitudes,
        std::vector<double>* p_OUT_longitudes,
        std::vector<double>* p_OUT_altitudes);
    Flight* _flight_;
    utl::TimeStamp _earliestTime_;
    utl::TimeStamp _latesTime_;
    ROOT::Math::Interpolator* _interpolatorX_;
    ROOT::Math::Interpolator* _interpolatorY_;
    ROOT::Math::Interpolator* _interpolatorZ_;
};

} /* namespace RdAirplane */
#endif /* INTERPOLATOR3D_H_ */