// Written by David Luff and Alexander Kappes, started Jan 2003.
// Based on navlist.cxx by Curtis Olson, started April 2000.
//
-// Copyright (C) 2000 Curtis L. Olson - curt@flightgear.org
+// Copyright (C) 2000 Curtis L. Olson - http://www.flightgear.org/~curt
//
// This program is free software; you can redistribute it and/or
// modify it under the terms of the GNU General Public License as
#include <simgear/math/sg_geodesy.hxx>
#include <simgear/math/sg_random.h>
#include <simgear/bucket/newbucket.hxx>
+#include <Airports/simple.hxx>
#include "commlist.hxx"
//#include "atislist.hxx"
+#include "ATCutils.hxx"
FGCommList *current_commlist;
// load the navaids and build the map
-bool FGCommList::init( SGPath path ) {
+bool FGCommList::init( const SGPath& path ) {
SGPath temp = path;
commlist_freq.erase(commlist_freq.begin(), commlist_freq.end());
temp.append( "ATC/default.tower" );
LoadComms(temp);
temp = path;
+ temp.append( "ATC/default.ground" );
+ LoadComms(temp);
+ temp = path;
temp.append( "ATC/default.approach" );
LoadComms(temp);
return true;
}
-bool FGCommList::LoadComms(SGPath path) {
+bool FGCommList::LoadComms(const SGPath& path) {
sg_gzifstream fin( path.str() );
if ( !fin.is_open() ) {
ATCData a;
fin >> a;
if(a.type == INVALID) {
- cout << "WARNING - INVALID type found in " << path.str() << '\n';
+ SG_LOG(SG_GENERAL, SG_DEBUG, "WARNING - INVALID type found in " << path.str() << '\n');
} else {
// Push all stations onto frequency map
commlist_freq[a.freq].push_back(a);
- // Push approach stations onto bucket map as well
- if(a.type == APPROACH) {
+ // Push non-atis stations onto bucket map as well
+ // In fact, push all stations onto bucket map for now so FGATCMgr::GetFrequency() works.
+ //if(a.type != ATIS) {
// get bucket number
SGBucket bucket(a.lon, a.lat);
int bucknum = bucket.gen_index();
commlist_bck[bucknum].push_back(a);
- }
+ //}
}
fin >> skipcomment;
lon *= SGD_DEGREES_TO_RADIANS;
lat *= SGD_DEGREES_TO_RADIANS;
- comm_list_type stations = commlist_freq[(int)(freq*100.0 + 0.5)];
+ // HACK - if freq > 1000 assume it's in KHz, otherwise assume MHz.
+ // A bit ugly but it works for now!!!!
+ comm_list_type stations;
+ if(freq > 1000.0) {
+ stations = commlist_freq[(int)freq];
+ } else {
+ stations = commlist_freq[(int)(freq*100.0 + 0.5)];
+ }
comm_list_iterator current = stations.begin();
comm_list_iterator last = stations.end();
// double az1, az2, s;
Point3D aircraft = sgGeodToCart( Point3D(lon, lat, elev) );
Point3D station;
+ const double orig_max_d = 1e100;
+ double max_d = orig_max_d;
double d;
// TODO - at the moment this loop returns the first match found in range
// We want to return the closest match in the event of a frequency conflict
d = aircraft.distance3Dsquared( station );
//cout << " dist = " << sqrt(d)
- // << " range = " << current->get_range() * SG_NM_TO_METER << endl;
+ // << " range = " << current->range * SG_NM_TO_METER << endl;
- // match up to twice the published range so we can model
+ // TODO - match up to twice the published range so we can model
// reduced signal strength
- if ( d < (2 * current->range * SG_NM_TO_METER
- * 2 * current->range * SG_NM_TO_METER ) ) {
- //cout << "matched = " << current->get_ident() << endl;
+ // NOTE The below is squared since we match to distance3Dsquared (above) to avoid a sqrt.
+ if ( d < (current->range * SG_NM_TO_METER
+ * current->range * SG_NM_TO_METER ) ) {
+ //cout << "matched = " << current->ident << endl;
if((tp == INVALID) || (tp == (*current).type)) {
- *ad = *current;
- return true;
+ if(d < max_d) {
+ max_d = d;
+ *ad = *current;
+ }
}
}
}
- return false;
+ if(max_d < orig_max_d) {
+ return true;
+ } else {
+ return false;
+ }
}
-
-int FGCommList::FindByPos(double lon, double lat, double elev, comm_list_type* stations, atc_type tp)
+int FGCommList::FindByPos(double lon, double lat, double elev, double range, comm_list_type* stations, atc_type tp)
{
// number of relevant stations found within range
int found = 0;
SGBucket buck(lon, lat);
// get neigboring buckets
- int max_range = 100;
- int bx = (int)( max_range*SG_NM_TO_METER / buck.get_width_m() / 2);
- int by = (int)( max_range*SG_NM_TO_METER / buck.get_height_m() / 2 );
+ int bx = (int)( range*SG_NM_TO_METER / buck.get_width_m() / 2);
+ int by = (int)( range*SG_NM_TO_METER / buck.get_height_m() / 2 );
// loop over bucket range
- for ( int i=-bx; i<bx; i++) {
- for ( int j=-by; j<by; j++) {
+ for ( int i=-bx; i<=bx; i++) {
+ for ( int j=-by; j<=by; j++) {
buck = sgBucketOffset(lon, lat, i, j);
long int bucket = buck.gen_index();
comm_list_type Fstations = commlist_bck[bucket];
if((current->type == tp) || (tp == INVALID)) {
station = Point3D(current->x, current->y, current->z);
d = aircraft.distance3Dsquared( station );
- if ( d < (current->range * SG_NM_TO_METER
- * current->range * SG_NM_TO_METER ) ) {
+ // NOTE The below is squared since we match to distance3Dsquared (above) to avoid a sqrt.
+ if ( d < (current->range * SG_NM_TO_METER
+ * current->range * SG_NM_TO_METER ) ) {
stations->push_back(*current);
++found;
}
}
+// Returns the distance in meters to the closest station of a given type,
+// with the details written into ATCData& ad. If no type is specifed simply
+// returns the distance to the closest station of any type.
+// Returns -9999 if no stations found within max_range in nautical miles (default 100 miles).
+// Note that the search algorithm starts at 10 miles and multiplies by 10 thereafter, so if
+// say 300 miles is specifed 10, then 100, then 1000 will be searched, breaking at first result
+// and giving up after 1000.
+double FGCommList::FindClosest( double lon, double lat, double elev, ATCData& ad, atc_type tp, double max_range) {
+ int num_stations = 0;
+ int range = 10;
+ comm_list_type stations;
+ comm_list_iterator itr;
+ double distance = -9999.0;
+
+ while(num_stations == 0) {
+ num_stations = FindByPos(lon, lat, elev, range, &stations, tp);
+ if(num_stations) {
+ double closest = max_range * SG_NM_TO_METER;
+ double tmp;
+ for(itr = stations.begin(); itr != stations.end(); ++itr) {
+ ATCData ad2 = *itr;
+ //Point3D p1(*itr.lon, *itr.lat, *itr.elev);
+ Point3D p1(ad2.lon, ad2.lat, ad2.elev);
+ FGAirport a;
+ if(dclFindAirportID(ad2.ident, &a)) {
+ Point3D p2(lon, lat, elev);
+ tmp = dclGetHorizontalSeparation(p1, p2);
+ if(tmp <= closest) {
+ closest = tmp;
+ distance = tmp;
+ ad = *itr;
+ }
+ }
+ }
+ //cout << "Closest station is " << ad.ident << " at a range of " << distance << " meters\n";
+ return(distance);
+ }
+ if(range > max_range) {
+ break;
+ }
+ range *= 10;
+ }
+ return(-9999.0);
+}
+
+
+// Find by Airport code.
+// This is basically a wrapper for a call to the airport database to get the airport
+// position followed by a call to FindByPos(...)
+bool FGCommList::FindByCode( const string& ICAO, ATCData& ad, atc_type tp ) {
+ FGAirport a;
+ if ( dclFindAirportID( ICAO, &a ) ) {
+ comm_list_type stations;
+ int found = FindByPos(a.getLongitude(), a.getLatitude(), a.getElevation(), 10.0, &stations, tp);
+ if(found) {
+ comm_list_iterator itr = stations.begin();
+ while(itr != stations.end()) {
+ if(((*itr).ident == ICAO) && ((*itr).type == tp)) {
+ ad = *itr;
+ return true;
+ }
+ ++itr;
+ }
+ }
+ } else {
+ return false;
+ }
+ return false;
+}
+
+
// TODO - this function should move somewhere else eventually!
// Return an appropriate call-sign for an ATIS transmission.
-int FGCommList::GetCallSign( string apt_id, int hours, int mins )
+int FGCommList::GetCallSign( const string& apt_id, int hours, int mins )
{
atis_transmission_type tran;
projects / flightgear.git / blobdiff