]> git.mxchange.org Git - flightgear.git/blob - src/Cockpit/dme.cxx
cc18217d994c7eee58d660f4872e0277c297b5cd
[flightgear.git] / src / Cockpit / dme.cxx
1 // dme.cxx -- class to manage an instance of the DME
2 //
3 // Written by Curtis Olson, started April 2000.
4 //
5 // Copyright (C) 2000  Curtis L. Olson - curt@flightgear.org
6 //
7 // This program is free software; you can redistribute it and/or
8 // modify it under the terms of the GNU General Public License as
9 // published by the Free Software Foundation; either version 2 of the
10 // License, or (at your option) any later version.
11 //
12 // This program is distributed in the hope that it will be useful, but
13 // WITHOUT ANY WARRANTY; without even the implied warranty of
14 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15 // General Public License for more details.
16 //
17 // You should have received a copy of the GNU General Public License
18 // along with this program; if not, write to the Free Software
19 // Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
20 //
21 // $Id$
22
23
24 #ifdef HAVE_CONFIG_H
25 #  include <config.h>
26 #endif
27
28 #include <stdio.h>      // snprintf
29
30 #include <simgear/compiler.h>
31 #include <simgear/math/sg_random.h>
32
33 #include <Aircraft/aircraft.hxx>
34 #include <Navaids/ilslist.hxx>
35 #include <Navaids/mkrbeacons.hxx>
36 #include <Navaids/navlist.hxx>
37 #include <Time/FGEventMgr.hxx>
38
39 #include "dme.hxx"
40
41 #include <string>
42 SG_USING_STD(string);
43
44
45 /**
46  * Boy, this is ugly!  Make the VOR range vary by altitude difference.
47  */
48 static double kludgeRange ( double stationElev, double aircraftElev,
49                             double nominalRange)
50 {
51                                 // Assume that the nominal range (usually
52                                 // 50nm) applies at a 5,000 ft difference.
53                                 // Just a wild guess!
54   double factor = ((aircraftElev*SG_METER_TO_FEET) - stationElev) / 5000.0;
55   double range = fabs(nominalRange * factor);
56
57                                 // Clamp the range to keep it sane; for
58                                 // now, never less than 25% or more than
59                                 // 500% of nominal range.
60   if (range < nominalRange/4.0) {
61     range = nominalRange/4.0;
62   } else if (range > nominalRange*5.0) {
63     range = nominalRange*5.0;
64   }
65
66   return range;
67 }
68
69
70 // Constructor
71 FGDME::FGDME() :
72     lon_node(fgGetNode("/position/longitude-deg", true)),
73     lat_node(fgGetNode("/position/latitude-deg", true)),
74     alt_node(fgGetNode("/position/altitude-ft", true)),
75     bus_power(fgGetNode("/systems/electrical/outputs/dme", true)),
76     navcom1_bus_power(fgGetNode("/systems/electrical/outputs/navcom[0]", true)),
77     navcom2_bus_power(fgGetNode("/systems/electrical/outputs/navcom[1]", true)),
78     navcom1_power_btn(fgGetNode("/radios/comm[0]/inputs/power-btn", true)),
79     navcom2_power_btn(fgGetNode("/radios/comm[1]/inputs/power-btn", true)),
80     navcom1_freq(fgGetNode("/radios/nav[0]/frequencies/selected-mhz", true)),
81     navcom2_freq(fgGetNode("/radios/nav[1]/frequencies/selected-mhz", true)),
82     need_update(true),
83     freq(0.0),
84     dist(0.0),
85     prev_dist(0.0),
86     spd(0.0),
87     ete(0.0)
88 {
89     last_time.stamp();
90 }
91
92
93 // Destructor
94 FGDME::~FGDME() 
95 {
96 }
97
98
99 void
100 FGDME::init ()
101 {
102 }
103
104 void
105 FGDME::bind ()
106 {
107
108                                 // User inputs
109     fgTie("/radios/dme/frequencies/selected-khz", this,
110           &FGDME::get_freq, &FGDME::set_freq);
111
112                                 // Radio outputs
113     fgTie("/radios/dme/in-range", this, &FGDME::get_inrange);
114
115     fgTie("/radios/dme/distance-nm", this, &FGDME::get_dist);
116
117     fgTie("/radios/dme/speed-kt", this, &FGDME::get_spd);
118
119     fgTie("/radios/dme/ete-min", this, &FGDME::get_ete);
120 }
121
122 void
123 FGDME::unbind ()
124 {
125     fgUntie("/radios/dme/frequencies/selected-khz");
126
127                                 // Radio outputs
128     fgUntie("/radios/dme/in-range");
129     fgUntie("/radios/dme/distance-nm");
130     fgUntie("/radios/dme/speed-kt");
131     fgUntie("/radios/dme/ete-min");
132 }
133
134
135 // Update the various nav values based on position and valid tuned in navs
136 void 
137 FGDME::update(double dt) 
138 {
139     double lon = lon_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS;
140     double lat = lat_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS;
141     double elev = alt_node->getDoubleValue() * SG_FEET_TO_METER;
142
143     need_update = false;
144
145     Point3D aircraft = sgGeodToCart( Point3D( lon, lat, elev ) );
146     Point3D station;
147
148     if ( valid && has_power() ) {
149         station = Point3D( x, y, z );
150         dist = aircraft.distance3D( station ) * SG_METER_TO_NM;
151         effective_range = kludgeRange(elev, elev, range);
152         if (dist < effective_range * SG_NM_TO_METER) {
153             inrange = true;
154         } else if (dist < 2 * effective_range * SG_NM_TO_METER) {
155             inrange = sg_random() <
156                 (2 * effective_range * SG_NM_TO_METER - dist) /
157                 (effective_range * SG_NM_TO_METER);
158         } else {
159             inrange = false;
160         }
161         if ( inrange ) {
162             SGTimeStamp current_time;
163             station = Point3D( x, y, z );
164             dist = aircraft.distance3D( station ) * SG_METER_TO_NM;
165             current_time.stamp();
166             long dMs = (current_time - last_time) / 1000;
167                                 // Update every second
168             if (dMs >= 1000) {
169                 double dDist = dist - prev_dist;
170                 spd = fabs((dDist/dMs) * 3600000);
171                                 // FIXME: the panel should be able to
172                                 // handle this!!!
173                 if (spd > 999.0)
174                     spd = 999.0;
175                 ete = fabs((dist/spd) * 60.0);
176                                 // FIXME: the panel should be able to
177                                 // handle this!!!
178                 if (ete > 99.0)
179                     ete = 99.0;
180                 prev_dist = dist;
181                 last_time.stamp();
182             }
183         }
184     } else {
185         inrange = false;
186         dist = 0.0;
187         prev_dist = 0.0;
188         spd = 0.0;
189         ete = 0.0;
190     }
191 }
192
193
194 // Update current nav/adf radio stations based on current postition
195 void FGDME::search() 
196 {
197     double lon = lon_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS;
198     double lat = lat_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS;
199     double elev = alt_node->getDoubleValue() * SG_FEET_TO_METER;
200
201                                 // FIXME: the panel should handle this
202                                 // don't worry about overhead for now,
203                                 // since this is handled only periodically
204     switch_pos = fgGetInt("/radios/dme/switch-position", 2);
205     if ( switch_pos == 1 && has_power() && navcom1_on() ) {
206         if ( freq != navcom1_freq->getDoubleValue() ) {
207             freq = navcom1_freq->getDoubleValue();
208             need_update = true;
209         }
210     } else if ( switch_pos == 3 && has_power() && navcom2_on() ) {
211         if ( freq != navcom2_freq->getDoubleValue() ) {
212             freq = navcom2_freq->getDoubleValue();
213             need_update = true;
214         }
215     } else {
216         freq = 0;
217         inrange = false;
218     }
219
220     FGILS *ils;
221     FGNav *nav;
222
223     if ( (ils = current_ilslist->findByFreq( freq, lon, lat, elev )) != NULL ) {
224         if ( ils->get_has_dme() ) {
225             valid = true;
226             lon = ils->get_loclon();
227             lat = ils->get_loclat();
228             elev = ils->get_gselev();
229             range = FG_ILS_DEFAULT_RANGE;
230             effective_range = kludgeRange(elev, elev, range);
231             x = ils->get_dme_x();
232             y = ils->get_dme_y();
233             z = ils->get_dme_z();
234         }
235     } else if ( (nav = current_navlist->findByFreq(freq, lon, lat, elev)) != NULL ) {
236         if (nav->get_has_dme()) {
237             valid = true;
238             lon = nav->get_lon();
239             lat = nav->get_lat();
240             elev = nav->get_elev();
241             range = nav->get_range();
242             effective_range = kludgeRange(elev, elev, range);
243             x = nav->get_x();
244             y = nav->get_y();
245             z = nav->get_z();
246         }
247     } else {
248         valid = false;
249         dist = 0;
250     }
251 }