From: daveluff Date: Wed, 4 Dec 2002 19:47:16 +0000 (+0000) Subject: Add ground control frequency data handling along the same lines as navlist etc... X-Git-Url: https://git.mxchange.org/?a=commitdiff_plain;h=1db3b01e047c9d70896e8db764b985403926412b;p=flightgear.git Add ground control frequency data handling along the same lines as navlist etc... --- diff --git a/src/ATC/groundlist.cxx b/src/ATC/groundlist.cxx new file mode 100644 index 000000000..c8dfbe1be --- /dev/null +++ b/src/ATC/groundlist.cxx @@ -0,0 +1,134 @@ +// groundlist.cxx -- ATC Ground data management class +// +// Written by David Luff, started November 2002. +// Based on navlist.cxx by Curtis Olson, started April 2000. +// +// Copyright (C) 2000 Curtis L. Olson - curt@flightgear.org +// +// This program is free software; you can redistribute it and/or +// modify it under the terms of the GNU General Public License as +// published by the Free Software Foundation; either version 2 of the +// License, or (at your option) any later version. +// +// This program is distributed in the hope that it will be useful, but +// WITHOUT ANY WARRANTY; without even the implied warranty of +// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +// General Public License for more details. +// +// You should have received a copy of the GNU General Public License +// along with this program; if not, write to the Free Software +// Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. + + +#ifdef HAVE_CONFIG_H +# include +#endif + +#include +#include +#include +#include + +#include "groundlist.hxx" + +FGGroundList *current_groundlist; + +// Constructor +FGGroundList::FGGroundList( void ) { +} + + +// Destructor +FGGroundList::~FGGroundList( void ) { +} + + +// load the navaids and build the map +bool FGGroundList::init( SGPath path ) { + + groundlist.erase( groundlist.begin(), groundlist.end() ); + + sg_gzifstream in( path.str() ); + if ( !in.is_open() ) { + SG_LOG( SG_GENERAL, SG_ALERT, "Cannot open file: " << path.str() ); + exit(-1); + } + + // read in each line of the file + + in >> skipcomment; + + #ifdef __MWERKS__ + char c = 0; + while ( in.get(c) && c != '\0' ) { + in.putback(c); + #else + while ( !in.eof() ) { + #endif + + FGGround g; + in >> g; + if ( g.get_type() == '[' ) { + break; + } + + //cout << "id = " << t.GetIdent() << endl; + //cout << " type = " << t.get_type() << endl; + //cout << " lon = " << t.get_lon() << endl; + //cout << " lat = " << t.get_lat() << endl; + //cout << " elev = " << t.get_elev() << endl; + //cout << " freq = " << t.get_freq() << endl; + //cout << " range = " << t.get_range() << endl; + + groundlist[g.get_freq()].push_back(g); + in >> skipcomment; + } + + return true; + } + + + // query the database for the specified frequency, lon and lat are in + // degrees, elev is in meters + bool FGGroundList::query( double lon, double lat, double elev, double freq, + FGGround *g ) + { + lon *= SGD_DEGREES_TO_RADIANS; + lat *= SGD_DEGREES_TO_RADIANS; + //cout << "lon = " << lon << '\n'; + //cout << "lat = " << lat << '\n'; + //cout << "elev = " << elev << '\n'; + //cout << "freq = " << freq << '\n'; + + ground_list_type stations = groundlist[(int)(freq*100.0 + 0.5)]; + + ground_list_iterator current = stations.begin(); + ground_list_iterator last = stations.end(); + + // double az1, az2, s; + Point3D aircraft = sgGeodToCart( Point3D(lon, lat, elev) ); + Point3D station; + double d; + for ( ; current != last ; ++current ) { + //cout << "testing " << current->GetIdent() << endl; + station = Point3D(current->get_x(), current->get_y(), current->get_z()); + //cout << "aircraft = " << aircraft << endl; + //cout << "station = " << station << endl; + + d = aircraft.distance3Dsquared( station ); + + //cout << " dist = " << sqrt(d) + // << " range = " << current->get_range() * SG_NM_TO_METER << endl; + + // match up to twice the published range so we can model + // reduced signal strength + if ( d < (2 * current->get_range() * SG_NM_TO_METER + * 2 * current->get_range() * SG_NM_TO_METER ) ) { + //cout << "matched = " << current->GetIdent() << endl; + *g = *current; + return true; + } + } + + return false; + } diff --git a/src/ATC/groundlist.hxx b/src/ATC/groundlist.hxx new file mode 100644 index 000000000..7b5603945 --- /dev/null +++ b/src/ATC/groundlist.hxx @@ -0,0 +1,74 @@ +// groundlist.hxx -- ATC Ground data management class +// +// Written by David Luff, started November 2002. +// Based on navlist.hxx by Curtis Olson, started April 2000. +// +// Copyright (C) 2000 Curtis L. Olson - curt@flightgear.org +// +// This program is free software; you can redistribute it and/or +// modify it under the terms of the GNU General Public License as +// published by the Free Software Foundation; either version 2 of the +// License, or (at your option) any later version. +// +// This program is distributed in the hope that it will be useful, but +// WITHOUT ANY WARRANTY; without even the implied warranty of +// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU +// General Public License for more details. +// +// You should have received a copy of the GNU General Public License +// along with this program; if not, write to the Free Software +// Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. + + +#ifndef _FG_GROUNDLIST_HXX +#define _FG_GROUNDLIST_HXX + + +#include +#include + +#include +#include +#include + +#include "ground.hxx" + +SG_USING_STD(map); +SG_USING_STD(vector); +SG_USING_STD(string); + + +class FGGroundList { + + // convenience types + typedef vector < FGGround > ground_list_type; + typedef ground_list_type::iterator ground_list_iterator; + typedef ground_list_type::const_iterator ground_list_const_iterator; + + // Map containing FGGround keyed by frequency. + // A vector of FGGround is kept at each node since some may share frequency + typedef map < int, ground_list_type > ground_map_type; + typedef ground_map_type::iterator ground_map_iterator; + typedef ground_map_type::const_iterator ground_map_const_iterator; + + ground_map_type groundlist; + +public: + + FGGroundList(); + ~FGGroundList(); + + // load all atis and build the map + bool init( SGPath path ); + + // query the database for the specified frequency, lon and lat are + // in degrees, elev is in meters + bool query( double lon, double lat, double elev, double freq, FGGround *g ); + +}; + + +extern FGGroundList *current_groundlist; + + +#endif // _FG_GROUNDLIST_HXX