src/Instrumentation/gps.hxx

   1 // gps.hxx - distance-measuring equipment.
   2 // Written by David Megginson, started 2003.
   3 //
   4 // This file is in the Public Domain and comes with no warranty.
   5
   6
   7 #ifndef __INSTRUMENTS_GPS_HXX
   8 #define __INSTRUMENTS_GPS_HXX 1
   9
  10 #ifndef __cplusplus
  11 # error This library requires C++
  12 #endif
  13
  14 #include <simgear/props/props.hxx>
  15 #include <simgear/structure/subsystem_mgr.hxx>
  16
  17
  18 /**
  19  * Model a GPS radio.
  20  *
  21  * Input properties:
  22  *
  23  * /position/longitude-deg
  24  * /position/latitude-deg
  25  * /position/altitude-ft
  26  * /environment/magnetic-variation-deg
  27  * /systems/electrical/outputs/gps
  28  * /instrumentation/gps/serviceable
  29  *
  30  * /instrumentation/gps/wp-longitude-deg
  31  * /instrumentation/gps/wp-latitude-deg
  32  * /instrumentation/gps/wp-altitude-ft
  33  * /instrumentation/gps/wp-ID
  34  * /instrumentation/gps/wp-name
  35  * /instrumentation/gps/desired-course-deg
  36  * /instrumentation/gps/get-nearest-airport
  37  * /instrumentation/gps/waypoint-type
  38  * /instrumentation/gps/tracking-bug
  39  *
  40  * Output properties:
  41  *
  42  * /instrumentation/gps/indicated-longitude-deg
  43  * /instrumentation/gps/indicated-latitude-deg
  44  * /instrumentation/gps/indicated-altitude-ft
  45  * /instrumentation/gps/indicated-vertical-speed-fpm
  46  * /instrumentation/gps/indicated-track-true-deg
  47  * /instrumentation/gps/indicated-track-magnetic-deg
  48  * /instrumentation/gps/indicated-ground-speed-kt
  49  *
  50  * /instrumentation/gps/wp-distance-nm
  51  * /instrumentation/gps/wp-bearing-deg
  52  * /instrumentation/gps/wp-bearing-mag-deg
  53  * /instrumentation/gps/TTW
  54  * /instrumentation/gps/course-deviation-deg
  55  * /instrumentation/gps/course-error-nm
  56  * /instrumentation/gps/to-flag
  57  * /instrumentation/gps/odometer
  58  * /instrumentation/gps/trip-odometer
  59  * /instrumentation/gps/true-bug-error-deg
  60  * /instrumentation/gps/magnetic-bug-error-deg
  61  * /instrumentation/gps/true-bearing-error-deg
  62  * /instrumentation/gps/magnetic-bearing-error-deg
  63  */
  64 class GPS : public SGSubsystem
  65 {
  66
  67 public:
  68
  69     GPS ();
  70     virtual ~GPS ();
  71
  72     virtual void init ();
  73     virtual void update (double delta_time_sec);
  74
  75 private:
  76
  77     void search (double frequency, double longitude_rad,
  78                  double latitude_rad, double altitude_m);
  79
  80     double degrange360 (double deg);
  81     double degrange180 (double deg);
  82     double degrange (double deg, double min, double max);
  83
  84     SGPropertyNode_ptr _longitude_node;
  85     SGPropertyNode_ptr _latitude_node;
  86     SGPropertyNode_ptr _altitude_node;
  87     SGPropertyNode_ptr _magvar_node;
  88     SGPropertyNode_ptr _serviceable_node;
  89     SGPropertyNode_ptr _electrical_node;
  90     SGPropertyNode_ptr _wp0_longitude_node;
  91     SGPropertyNode_ptr _wp0_latitude_node;
  92     SGPropertyNode_ptr _wp0_altitude_node;
  93     SGPropertyNode_ptr _wp0_ID_node;
  94     SGPropertyNode_ptr _wp0_name_node;
  95     SGPropertyNode_ptr _wp0_course_node;
  96     SGPropertyNode_ptr _get_nearest_airport_node;
  97     SGPropertyNode_ptr _wp0_waypoint_type_node;
  98     SGPropertyNode_ptr _wp1_longitude_node;
  99     SGPropertyNode_ptr _wp1_latitude_node;
 100     SGPropertyNode_ptr _wp1_altitude_node;
 101     SGPropertyNode_ptr _wp1_ID_node;
 102     SGPropertyNode_ptr _wp1_name_node;
 103     SGPropertyNode_ptr _wp1_course_node;
 104     SGPropertyNode_ptr _wp1_waypoint_type_node;
 105     SGPropertyNode_ptr _tracking_bug_node;
 106
 107     SGPropertyNode_ptr _raim_node;
 108     SGPropertyNode_ptr _indicated_longitude_node;
 109     SGPropertyNode_ptr _indicated_latitude_node;
 110     SGPropertyNode_ptr _indicated_altitude_node;
 111     SGPropertyNode_ptr _indicated_vertical_speed_node;
 112     SGPropertyNode_ptr _true_track_node;
 113     SGPropertyNode_ptr _magnetic_track_node;
 114     SGPropertyNode_ptr _speed_node;
 115     SGPropertyNode_ptr _wp0_distance_node;
 116     SGPropertyNode_ptr _wp0_ttw_node;
 117     SGPropertyNode_ptr _wp0_bearing_node;
 118     SGPropertyNode_ptr _wp0_mag_bearing_node;
 119     SGPropertyNode_ptr _wp0_course_deviation_node;
 120     SGPropertyNode_ptr _wp0_course_error_nm_node;
 121     SGPropertyNode_ptr _wp0_to_flag_node;
 122     SGPropertyNode_ptr _wp1_distance_node;
 123     SGPropertyNode_ptr _wp1_ttw_node;
 124     SGPropertyNode_ptr _wp1_bearing_node;
 125     SGPropertyNode_ptr _wp1_mag_bearing_node;
 126     SGPropertyNode_ptr _wp1_course_deviation_node;
 127     SGPropertyNode_ptr _wp1_course_error_nm_node;
 128     SGPropertyNode_ptr _wp1_to_flag_node;
 129     SGPropertyNode_ptr _odometer_node;
 130     SGPropertyNode_ptr _trip_odometer_node;
 131     SGPropertyNode_ptr _true_bug_error_node;
 132     SGPropertyNode_ptr _magnetic_bug_error_node;
 133     SGPropertyNode_ptr _true_wp0_bearing_error_node;
 134     SGPropertyNode_ptr _magnetic_wp0_bearing_error_node;
 135     SGPropertyNode_ptr _true_wp1_bearing_error_node;
 136     SGPropertyNode_ptr _magnetic_wp1_bearing_error_node;
 137     SGPropertyNode_ptr _leg_distance_node;
 138     SGPropertyNode_ptr _leg_course_node;
 139     SGPropertyNode_ptr _leg_magnetic_course_node;
 140     SGPropertyNode_ptr _alt_dist_ratio_node;
 141     SGPropertyNode_ptr _leg_course_deviation_node;
 142     SGPropertyNode_ptr _leg_course_error_nm_node;
 143     SGPropertyNode_ptr _leg_to_flag_node;
 144     SGPropertyNode_ptr _alt_deviation_node;
 145
 146     bool _last_valid;
 147     double _last_longitude_deg;
 148     double _last_latitude_deg;
 149     double _last_altitude_m;
 150     double _last_speed_kts;
 151
 152     double _wp0_latitude_deg;
 153     double _wp0_longitude_deg;
 154     double _wp0_altitude_m;
 155     double _wp1_latitude_deg;
 156     double _wp1_longitude_deg;
 157     double _wp1_altitude_m;
 158     string _last_wp0_ID;
 159     string _last_wp1_ID;
 160
 161     double _alt_dist_ratio;
 162     double _distance_m;
 163     double _course_deg;
 164
 165     double bias_length;
 166     double bias_angle;
 167     double azimuth_error;
 168     double range_error;
 169     double elapsed_time;
 170
 171 };
 172
 173
 174 #endif // __INSTRUMENTS_GPS_HXX