src/Cockpit/radiostack.cxx

   1 // radiostack.cxx -- class to manage an instance of the radio stack
   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 #include <Aircraft/aircraft.hxx>
  25 #include <Navaids/ilslist.hxx>
  26 #include <Navaids/navlist.hxx>
  27
  28 #include "radiostack.hxx"
  29
  30
  31 FGRadioStack *current_radiostack;
  32
  33
  34 // Constructor
  35 FGRadioStack::FGRadioStack() {
  36     nav1_dme_dist = 0.0;
  37     need_update = true;
  38 }
  39
  40
  41 // Destructor
  42 FGRadioStack::~FGRadioStack() {
  43 }
  44
  45
  46 // Search the database for the current frequencies given current location
  47 void FGRadioStack::update( double lon, double lat, double elev ) {
  48     need_update = false;
  49
  50     Point3D aircraft = fgGeodToCart( Point3D( lon, lat, elev ) );
  51     Point3D station;
  52     double az1, az2, s;
  53
  54     if ( nav1_valid ) {
  55         // staightline distance
  56         station = Point3D( nav1_dme_x, nav1_dme_y, nav1_dme_z );
  57         nav1_dme_dist = aircraft.distance3D( station );
  58         if ( nav1_loc ) {
  59             station = Point3D( nav1_gs_x, nav1_gs_y, nav1_gs_z );
  60             nav1_gs_dist = aircraft.distance3D( station );
  61         }
  62
  63         if ( nav1_dme_dist < nav1_effective_range * NM_TO_METER ) {
  64             nav1_inrange = true;
  65
  66             // wgs84 heading
  67             geo_inverse_wgs_84( elev, lat * RAD_TO_DEG, lon * RAD_TO_DEG,
  68                                 nav1_loclat, nav1_loclon,
  69                                 &az1, &az2, &s );
  70             nav1_heading = az1;
  71
  72             // cout << " heading = " << nav1_heading
  73             //      << " dist = " << nav1_dist << endl;
  74         } else {
  75             nav1_inrange = false;
  76         }
  77
  78         if ( nav1_loc ) {
  79         } else {
  80             nav1_radial = nav1_sel_radial;
  81         }
  82     } else {
  83         nav1_inrange = false;
  84         // cout << "not picking up vor. :-(" << endl;
  85     }
  86
  87     if ( nav2_valid ) {
  88         // staightline distance
  89         station = Point3D( nav2_dme_x, nav2_dme_y, nav2_dme_z );
  90         nav2_dme_dist = aircraft.distance3D( station );
  91         if ( nav2_loc ) {
  92             station = Point3D( nav2_gs_x, nav2_gs_y, nav2_gs_z );
  93             nav2_gs_dist = aircraft.distance3D( station );
  94         }
  95
  96         if ( nav2_dme_dist < nav2_effective_range * NM_TO_METER ) {
  97             nav2_inrange = true;
  98
  99             // wgs84 heading
 100             geo_inverse_wgs_84( elev, lat * RAD_TO_DEG, lon * RAD_TO_DEG,
 101                                 nav2_loclat, nav2_loclon,
 102                                 &az1, &az2, &s );
 103             nav2_heading = az1;
 104
 105             // cout << " heading = " << nav2_heading
 106             //      << " dist = " << nav2_dist << endl;
 107         } else {
 108             nav2_inrange = false;
 109         }
 110
 111         if ( !nav2_loc ) {
 112             nav2_radial = nav2_sel_radial;
 113         }
 114     } else {
 115         nav2_inrange = false;
 116         // cout << "not picking up vor. :-(" << endl;
 117     }
 118
 119     // adf
 120     if ( adf_valid ) {
 121         // staightline distance
 122         station = Point3D( adf_x, adf_y, adf_z );
 123         adf_dist = aircraft.distance3D( station );
 124
 125         if ( adf_dist < adf_effective_range * NM_TO_METER ) {
 126             adf_inrange = true;
 127
 128             // wgs84 heading
 129             geo_inverse_wgs_84( elev, lat * RAD_TO_DEG, lon * RAD_TO_DEG,
 130                                 adf_lat, adf_lon,
 131                                 &az1, &az2, &s );
 132             adf_heading = az1;
 133
 134             // cout << " heading = " << nav2_heading
 135             //      << " dist = " << nav2_dist << endl;
 136         } else {
 137             adf_inrange = false;
 138         }
 139     } else {
 140         adf_inrange = false;
 141     }
 142 }
 143
 144
 145 // Update current nav/adf radio stations based on current postition
 146 void FGRadioStack::search( double lon, double lat, double elev ) {
 147     // nav1
 148     FGILS ils;
 149     FGNav nav;
 150
 151     if ( current_ilslist->query( lon, lat, elev, nav1_freq, &ils ) ) {
 152         nav1_valid = true;
 153         nav1_loc = true;
 154         nav1_dme = true;
 155
 156         nav1_loclon = ils.get_loclon();
 157         nav1_loclat = ils.get_loclat();
 158         nav1_gslon = ils.get_gslon();
 159         nav1_gslat = ils.get_gslat();
 160         nav1_dmelon = ils.get_dmelon();
 161         nav1_dmelat = ils.get_dmelat();
 162         nav1_elev = ils.get_gselev();
 163         nav1_effective_range = FG_ILS_DEFAULT_RANGE;
 164         nav1_target_gs = ils.get_gsangle();
 165         nav1_radial = ils.get_locheading();
 166         while ( nav1_radial <   0.0 ) { nav1_radial += 360.0; }
 167         while ( nav1_radial > 360.0 ) { nav1_radial -= 360.0; }
 168         nav1_gs_x = ils.get_gs_x();
 169         nav1_gs_y = ils.get_gs_y();
 170         nav1_gs_z = ils.get_gs_z();
 171         nav1_dme_x = ils.get_dme_x();
 172         nav1_dme_y = ils.get_dme_y();
 173         nav1_dme_z = ils.get_dme_z();
 174         // cout << "Found an ils station in range" << endl;
 175         // cout << " id = " << ils.get_locident() << endl;
 176     } else if ( current_navlist->query( lon, lat, elev, nav1_freq, &nav ) ) {
 177         nav1_valid = true;
 178         nav1_loc = false;
 179         nav1_dme = nav.get_dme();
 180         nav1_loclon = nav.get_lon();
 181         nav1_loclat = nav.get_lat();
 182         nav1_elev = nav.get_elev();
 183         nav1_effective_range = nav.get_range();
 184         nav1_target_gs = 0.0;
 185         nav1_radial = nav1_sel_radial;
 186         nav1_dme_x = nav.get_x();
 187         nav1_dme_y = nav.get_y();
 188         nav1_dme_y = nav.get_z();
 189         // cout << "Found a vor station in range" << endl;
 190         // cout << " id = " << nav.get_ident() << endl;
 191     } else {
 192         nav1_valid = false;
 193         // cout << "not picking up vor1. :-(" << endl;
 194     }
 195
 196     if ( current_ilslist->query( lon, lat, elev, nav2_freq, &ils ) ) {
 197         nav2_valid = true;
 198         nav2_loc = true;
 199         nav2_dme = true;
 200
 201         nav2_loclon = ils.get_loclon();
 202         nav2_loclat = ils.get_loclat();
 203         nav2_elev = ils.get_gselev();
 204         nav2_effective_range = FG_ILS_DEFAULT_RANGE;
 205         nav2_target_gs = ils.get_gsangle();
 206         nav2_radial = ils.get_locheading();
 207         while ( nav2_radial <   0.0 ) { nav2_radial += 360.0; }
 208         while ( nav2_radial > 360.0 ) { nav2_radial -= 360.0; }
 209         nav2_gs_x = ils.get_gs_x();
 210         nav2_gs_y = ils.get_gs_y();
 211         nav2_gs_z = ils.get_gs_z();
 212         nav2_dme_x = ils.get_dme_x();
 213         nav2_dme_y = ils.get_dme_y();
 214         nav2_dme_z = ils.get_dme_z();
 215         // cout << "Found an ils station in range" << endl;
 216         // cout << " id = " << ils.get_locident() << endl;
 217     } else if ( current_navlist->query( lon, lat, elev, nav2_freq, &nav ) ) {
 218         nav2_valid = true;
 219         nav2_loc = false;
 220         nav2_dme = nav.get_dme();
 221
 222         nav2_loclon = nav.get_lon();
 223         nav2_loclat = nav.get_lat();
 224         nav2_elev = nav.get_elev();
 225         nav2_effective_range = nav.get_range();
 226         nav2_target_gs = 0.0;
 227         nav2_radial = nav2_sel_radial;
 228         nav2_dme_x = nav.get_x();
 229         nav2_dme_y = nav.get_y();
 230         nav2_dme_z = nav.get_z();
 231         // cout << "Found a vor station in range" << endl;
 232         // cout << " id = " << nav.get_ident() << endl;
 233     } else {
 234         nav2_valid = false;
 235         // cout << "not picking up vor2. :-(" << endl;
 236     }
 237
 238     // adf
 239     if ( current_navlist->query( lon, lat, elev, adf_freq, &nav ) ) {
 240         adf_valid = true;
 241
 242         adf_lon = nav.get_lon();
 243         adf_lat = nav.get_lat();
 244         adf_elev = nav.get_elev();
 245         adf_effective_range = nav.get_range();
 246         adf_x = nav.get_x();
 247         adf_y = nav.get_y();
 248         adf_z = nav.get_z();
 249         // cout << "Found an adf station in range" << endl;
 250         // cout << " id = " << nav.get_ident() << endl;
 251     } else {
 252         adf_valid = false;
 253         // cout << "not picking up adf. :-(" << endl;
 254     }
 255 }
 256
 257
 258 // periodic radio station search wrapper
 259 void fgRadioSearch( void ) {
 260     current_radiostack->search( cur_fdm_state->get_Longitude(),
 261                                 cur_fdm_state->get_Latitude(),
 262                                 cur_fdm_state->get_Altitude() * FEET_TO_METER );
 263 }