first commit

2022-10-20 20:29:11 +08:00
commit 4d531f8044
3238 changed files with 1387862 additions and 0 deletions
@@ -0,0 +1,102 @@
+#pragma once
+
+#include <simgear/compiler.h>
+
+#include <iostream>
+#include <string>
+#include <vector>
+
+
+// encapsulate a gps integer time (fixme, assumes all times in a track
+// are from the same day, so we don't handle midnight roll over)
+class GPSTime {
+
+public:
+
+    double seconds;
+
+    inline GPSTime( const int hh, const int mm, const double ss ) {
+        seconds = hh*3600 + mm*60 + ss;
+    }
+    inline GPSTime( const double gpstime ) {
+        double tmp = gpstime;
+        int hh = (int)(tmp / 10000);
+        tmp -= hh * 10000;
+        int mm = (int)(tmp / 100);
+        tmp -= mm * 100;
+        double ss = tmp;
+        seconds = hh*3600 + mm*60 + ss;
+        // std::cout << gpstime << " = " << seconds << std::endl;
+    }
+    inline ~GPSTime() {}
+
+    inline double get_time() const { return seconds; }
+    inline double diff_sec( const GPSTime t ) const {
+        return seconds - t.seconds;        
+    }
+};
+
+
+
+// encapsulate the interesting gps data for a moment in time
+class GPSPoint {
+
+public:
+
+    GPSTime gps_time;
+    double lat_deg;
+    double lon_deg;
+    int fix_quality;
+    int num_satellites;
+    double hdop;
+    double altitude_msl;
+    double speed_kts;
+    double course_true;
+
+    GPSPoint() :
+        gps_time(GPSTime(0,0,0)),
+        lat_deg(0.0),
+        lon_deg(0.0),
+        fix_quality(0),
+        num_satellites(0),
+        hdop(0.0),
+        altitude_msl(0.0),
+        speed_kts(0.0),
+        course_true(0.0)
+    { }
+
+    inline double get_time() const { return gps_time.get_time(); }
+};
+
+
+// Manage a saved gps log (track file)
+class GPSTrack {
+
+private:
+
+    std::vector <GPSPoint> data;
+
+public:
+
+    GPSTrack();
+    ~GPSTrack();
+
+    int load( const std::string &file );
+
+    inline int size() const { return data.size(); }
+
+    inline GPSPoint get_point( const unsigned int i )
+    {
+        if ( i < data.size() ) {
+            return data[i];
+        } else {
+            return GPSPoint();
+        }
+    }
+        
+
+};
+
+
+GPSPoint GPSInterpolate( const GPSPoint A, const GPSPoint B,
+                         const double percent );