gps_util.h

#pragma once
 
#include "../navtypes.h"

class GPSDatum {
public:
    static const GPSDatum WGS84;

    GPSDatum(double a, double b);

    double getA() const;

    double getB() const;

    double getFlattening() const;

    double getSquareEccentricity() const;
 
private:
    const double a;
    const double b;
};

class GPSToMetersConverter {
public:
    GPSToMetersConverter(const GPSDatum& datum, const navtypes::gpscoords_t& origin);

    navtypes::point_t gpsToMeters(const navtypes::gpscoords_t& coords) const;

    navtypes::gpscoords_t metersToGPS(const navtypes::point_t& pos) const;

    double getMetersPerDegLat() const;

    double getMetersPerDegLon() const;
 
private:
    const GPSDatum datum;
    const navtypes::gpscoords_t origin;
    double metersPerDegLat;
    double metersPerDegLon;
};