Make hardcoded error values configurable.

[flightgear.git] / src / Instrumentation / gps.hxx

diff --git a/src/Instrumentation/gps.hxx b/src/Instrumentation/gps.hxx
index cb3df424e7d37921dc862f453fd365429b06d857..24c98239cf79c499ab3f423c88867943c53e8f56 100644 (file)
--- a/src/Instrumentation/gps.hxx
+++ b/src/Instrumentation/gps.hxx
@@ -7,13 +7,28 @@
 #ifndef __INSTRUMENTS_GPS_HXX
 #define __INSTRUMENTS_GPS_HXX 1
 
-#ifndef __cplusplus
-# error This library requires C++
-#endif
-
 #include <simgear/props/props.hxx>
 #include <simgear/structure/subsystem_mgr.hxx>
+#include <simgear/math/SGMath.hxx>
+
+// forward decls
+class SGRoute;
 
+class SGGeodProperty
+{
+public:
+    SGGeodProperty()
+    {
+    }
+        
+    void init(SGPropertyNode* base, const char* lonStr, const char* latStr, const char* altStr = NULL);    
+    void init(const char* lonStr, const char* latStr, const char* altStr = NULL);    
+    void clear();    
+    void operator=(const SGGeod& geod);    
+    SGGeod get() const;
+private:
+    SGPropertyNode_ptr _lon, _lat, _alt;
+};
 
 /**
  * Model a GPS radio.
@@ -66,6 +81,7 @@ class GPS : public SGSubsystem
 
 public:
 
+    GPS (SGPropertyNode *node);
     GPS ();
     virtual ~GPS ();
 
@@ -73,41 +89,58 @@ public:
     virtual void update (double delta_time_sec);
 
 private:
-
-    void search (double frequency, double longitude_rad,
-                 double latitude_rad, double altitude_m);
-
-    double degrange360 (double deg);
-    double degrange180 (double deg);
-    double degrange (double deg, double min, double max);
-
-    SGPropertyNode_ptr _longitude_node;
-    SGPropertyNode_ptr _latitude_node;
-    SGPropertyNode_ptr _altitude_node;
+    typedef struct {
+        double dt;
+        SGGeod pos;
+        SGGeod wp0_pos;
+        SGGeod wp1_pos;
+        bool waypoint_changed;
+        double speed_kt;
+        double track1_deg;
+        double track2_deg;
+        double magvar_deg;
+        double wp0_distance;
+        double wp0_course_deg;
+        double wp0_bearing_deg;
+        double wp1_distance;
+        double wp1_course_deg;
+        double wp1_bearing_deg;
+    } UpdateContext;
+    
+    void search (double frequency, const SGGeod& pos);
+
+    /**
+     * reset all output properties to default / non-service values
+     */
+    void clearOutput();
+
+    void updateWithValid(UpdateContext& ctx);
+    
+    void updateNearestAirport(UpdateContext& ctx);
+    void updateWaypoint0(UpdateContext& ctx);
+    void updateWaypoint1(UpdateContext& ctx);
+
+    void updateLegCourse(UpdateContext& ctx);
+    void updateWaypoint0Course(UpdateContext& ctx);
+    void updateWaypoint1Course(UpdateContext& ctx);
+
+    void waypointChanged(UpdateContext& ctx);
+    void updateTTWNode(UpdateContext& ctx, double distance_m, SGPropertyNode_ptr node);
+    void updateTrackingBug(UpdateContext& ctx);
+    
     SGPropertyNode_ptr _magvar_node;
     SGPropertyNode_ptr _serviceable_node;
     SGPropertyNode_ptr _electrical_node;
-    SGPropertyNode_ptr _wp0_longitude_node;
-    SGPropertyNode_ptr _wp0_latitude_node;
-    SGPropertyNode_ptr _wp0_altitude_node;
     SGPropertyNode_ptr _wp0_ID_node;
     SGPropertyNode_ptr _wp0_name_node;
     SGPropertyNode_ptr _wp0_course_node;
     SGPropertyNode_ptr _get_nearest_airport_node;
-    SGPropertyNode_ptr _wp0_waypoint_type_node;
-    SGPropertyNode_ptr _wp1_longitude_node;
-    SGPropertyNode_ptr _wp1_latitude_node;
-    SGPropertyNode_ptr _wp1_altitude_node;
     SGPropertyNode_ptr _wp1_ID_node;
     SGPropertyNode_ptr _wp1_name_node;
     SGPropertyNode_ptr _wp1_course_node;
-    SGPropertyNode_ptr _wp1_waypoint_type_node;
     SGPropertyNode_ptr _tracking_bug_node;
 
     SGPropertyNode_ptr _raim_node;
-    SGPropertyNode_ptr _indicated_longitude_node;
-    SGPropertyNode_ptr _indicated_latitude_node;
-    SGPropertyNode_ptr _indicated_altitude_node;
     SGPropertyNode_ptr _indicated_vertical_speed_node;
     SGPropertyNode_ptr _true_track_node;
     SGPropertyNode_ptr _magnetic_track_node;
@@ -144,30 +177,29 @@ private:
     SGPropertyNode_ptr _alt_deviation_node;
 
     bool _last_valid;
-    double _last_longitude_deg;
-    double _last_latitude_deg;
-    double _last_altitude_m;
+    SGGeod _last_pos;
     double _last_speed_kts;
 
-    double _wp0_latitude_deg;
-    double _wp0_longitude_deg;
-    double _wp0_altitude_m;
-    double _wp1_latitude_deg;
-    double _wp1_longitude_deg;
-    double _wp1_altitude_m;
-    string _last_wp0_ID;
-    string _last_wp1_ID;
+    std::string _last_wp0_ID;
+    std::string _last_wp1_ID;
 
     double _alt_dist_ratio;
     double _distance_m;
     double _course_deg;
 
-    double bias_length;
-    double bias_angle;
-    double azimuth_error;
-    double range_error;
-    double elapsed_time;
+    double _bias_length;
+    double _bias_angle;
+    double _azimuth_error;
+    double _range_error;
+    double _elapsed_time;
+
+    std::string _name;
+    int _num;
 
+    SGGeodProperty _position;
+    SGGeodProperty _wp0_position;
+    SGGeodProperty _wp1_position;
+    SGGeodProperty _indicated_pos;
 };