}
+// get airport elevation
+static double fgGetAirportElev( const string& id ) {
+ FGAirport a;
+ // double lon, lat;
+
+ SG_LOG( SG_GENERAL, SG_INFO,
+ "Finding elevation for airport: " << id );
+
+ if ( fgFindAirportID( id, &a ) ) {
+ return a.elevation;
+ } else {
+ return -9999.0;
+ }
+}
+
+
// Preset lon/lat given an airport id
static bool fgSetPosFromAirportID( const string& id ) {
FGAirport a;
} else {
return false;
}
-
}
-
// Set current tower position lon/lat given an airport id
static bool fgSetTowerPosFromAirportID( const string& id, double hdg ) {
FGAirport a;
"Attempting to set starting position from runway code "
<< id << " heading " << tgt_hdg );
- // SGPath inpath( globals->get_fg_root() );
- // inpath.append( "Airports" );
- // inpath.append( "apt_simple" );
- // airports.load( inpath.c_str() );
-
- // SGPath outpath( globals->get_fg_root() );
- // outpath.append( "Airports" );
- // outpath.append( "simple.gdbm" );
- // airports.dump_gdbm( outpath.c_str() );
-
if ( ! runways.search( id, &r ) ) {
SG_LOG( SG_GENERAL, SG_ALERT,
"Failed to find " << id << " in database." );
}
+// Set current_options lon/lat given an airport id and heading (degrees)
+static bool fgSetPosFromAirportIDandRwy( const string& id, const string& rwy ) {
+ FGRunway r;
+ FGRunway found_r;
+ double heading = 0.0;
+ string runway;
+ bool match = false;
+
+ // standardize input number
+ string tmp = rwy.substr(1, 1);
+ if ( tmp == "L" || tmp == "R" || tmp == "C" ) {
+ runway = "0";
+ runway += rwy;
+ } else {
+ runway = rwy;
+ }
+
+ if ( id.length() ) {
+ // set initial position from runway and heading
+
+ SGPath path( globals->get_fg_root() );
+ path.append( "Airports" );
+ path.append( "runways.mk4" );
+ FGRunways runways( path.c_str() );
+
+ SG_LOG( SG_GENERAL, SG_INFO,
+ "Attempting to set starting position for "
+ << id << ":" << runway );
+
+ if ( ! runways.search( id, &r ) ) {
+ SG_LOG( SG_GENERAL, SG_ALERT,
+ "Failed to find " << id << " in database." );
+ return false;
+ }
+
+ while ( r.id == id ) {
+ // forward direction
+ if ( r.rwy_no == runway ) {
+ found_r = r;
+ heading = r.heading;
+ match = true;
+ SG_LOG( SG_GENERAL, SG_INFO,
+ "Runway " << r.rwy_no << " heading = " << heading );
+ }
+
+ // calculate reciprocal runway number
+ string snum = r.rwy_no;
+ int len = snum.length();
+ string letter = "";
+ string rev_letter = "";
+ int i;
+ for ( i = 0; i < len; ++i ) {
+ string tmp = snum.substr(i, 1);
+ if ( tmp == "L" ) {
+ letter = "L";
+ rev_letter = "R";
+ } else if ( tmp == "R" ) {
+ letter = "R";
+ rev_letter = "L";
+ } else if ( tmp == "C" ) {
+ letter == "C";
+ rev_letter = "C";
+ }
+ }
+ for ( i = 0; i < len; ++i ) {
+ string tmp = snum.substr(i, 1);
+ if ( tmp == "L" || tmp == "R" || tmp == "C" || tmp == " " ) {
+ snum = snum.substr(0, i);
+ }
+ }
+ SG_LOG(SG_GENERAL, SG_DEBUG, "Runway num = '" << snum << "'");
+ int num = atoi( snum.c_str() ) + 18;
+ while ( num > 36 ) { num -= 36; }
+ while ( num <= 0 ) { num += 36; }
+
+ char recip_no[10];
+ snprintf( recip_no, 10, "%02d%s", num, rev_letter.c_str() );
+
+ // reverse direction
+ if ( (string)recip_no == runway ) {
+ found_r = r;
+ heading = r.heading + 180;
+ while ( heading > 360.0 ) { heading -= 360; }
+ match = true;
+ SG_LOG( SG_GENERAL, SG_INFO,
+ "Runway " << r.rwy_no << " heading = " << heading );
+ }
+
+ runways.next( &r );
+ }
+ } else {
+ return false;
+ }
+
+ if ( match ) {
+ double lat2, lon2, az2;
+ double azimuth = heading + 180.0;
+ while ( azimuth >= 360.0 ) { azimuth -= 360.0; }
+
+ SG_LOG( SG_GENERAL, SG_INFO,
+ "runway = " << found_r.lon << ", " << found_r.lat
+ << " length = " << found_r.length * SG_FEET_TO_METER * 0.5
+ << " heading = " << azimuth );
+
+ geo_direct_wgs_84 ( 0, found_r.lat, found_r.lon,
+ azimuth,
+ found_r.length * SG_FEET_TO_METER * 0.5 - 5.0,
+ &lat2, &lon2, &az2 );
+
+ if ( fabs( fgGetDouble("/sim/presets/offset-distance") ) > SG_EPSILON )
+ {
+ double olat, olon;
+ double odist = fgGetDouble("/sim/presets/offset-distance");
+ odist *= SG_NM_TO_METER;
+ double oaz = azimuth;
+ if ( fabs(fgGetDouble("/sim/presets/offset-azimuth")) > SG_EPSILON )
+ {
+ oaz = fgGetDouble("/sim/presets/offset-azimuth") + 180;
+ }
+ while ( oaz >= 360.0 ) { oaz -= 360.0; }
+ geo_direct_wgs_84 ( 0, lat2, lon2, oaz, odist, &olat, &olon, &az2 );
+ lat2=olat;
+ lon2=olon;
+ }
+
+ // presets
+ fgSetDouble("/sim/presets/longitude-deg", lon2 );
+ fgSetDouble("/sim/presets/latitude-deg", lat2 );
+ fgSetDouble("/sim/presets/heading-deg", heading );
+
+ // other code depends on the actual values being set ...
+ fgSetDouble("/position/longitude-deg", lon2 );
+ fgSetDouble("/position/latitude-deg", lat2 );
+ fgSetDouble("/orientation/heading-deg", heading );
+
+ SG_LOG( SG_GENERAL, SG_INFO,
+ "Position for " << id << " is ("
+ << lon2 << ", "
+ << lat2 << ") new heading is "
+ << heading );
+
+ return true;
+ } else {
+ return false;
+ }
+}
+
+
static void fgSetDistOrAltFromGlideSlope() {
- double gs = fgGetDouble("/sim/presets/glideslope");
+ string apt_id = fgGetString("/sim/presets/airport-id");
+ double gs = fgGetDouble("/sim/presets/glideslope-deg")
+ * SG_DEGREES_TO_RADIANS ;
double od = fgGetDouble("/sim/presets/offset-distance");
double alt = fgGetDouble("/sim/presets/altitude-ft");
-
+
+ double apt_elev = 0.0;
+ if ( ! apt_id.empty() ) {
+ apt_elev = fgGetAirportElev( apt_id );
+ if ( apt_elev < -9990.0 ) {
+ apt_elev = 0.0;
+ }
+ } else {
+ apt_elev = 0.0;
+ }
+
if( fabs(gs) > 0.01 && fabs(od) > 0.1 && alt < -9990 ) {
// set altitude from glideslope and offset-distance
od *= SG_NM_TO_METER * SG_METER_TO_FEET;
- alt = fabs(od*tan(gs));
+ alt = fabs(od*tan(gs)) + apt_elev;
fgSetDouble("/sim/presets/altitude-ft", alt);
fgSetBool("/sim/presets/onground", false);
SG_LOG(SG_GENERAL,SG_INFO, "Calculated altitude as: " << alt << " ft");
} else if( fabs(gs) > 0.01 && alt > 0 && fabs(od) < 0.1) {
// set offset-distance from glideslope and altitude
- od = alt/tan(gs);
+ od = (alt - apt_elev) / tan(gs);
od *= -1*SG_FEET_TO_METER * SG_METER_TO_NM;
fgSetDouble("/sim/presets/offset-distance", od);
SG_LOG(SG_GENERAL, SG_INFO, "Calculated offset distance as: "
SG_LOG( SG_GENERAL, SG_ALERT,
"Glideslope given but not altitude or offset-distance." );
SG_LOG( SG_GENERAL, SG_ALERT, "Resetting glideslope to zero" );
- fgSetDouble("/sim/presets/glideslope", 0);
+ fgSetDouble("/sim/presets/glideslope-deg", 0);
+ fgSetBool("/sim/presets/onground", true);
}
}
// Set the initial position based on presets (or defaults)
bool fgInitPosition() {
- // Calculate offset-distance or altitude relative to glide slope
- // if either was not specified.
+ bool set_pos = false;
+
+ // If glideslope is specified, then calculate offset-distance or
+ // altitude relative to glide slope if either of those was not
+ // specified.
fgSetDistOrAltFromGlideSlope();
// If we have an explicit, in-range lon/lat, don't change it, just use it.
if ( lon_deg >= -180.0 && lon_deg <= 180.0
&& lat_deg >= -90.0 && lat_deg <= 90.0 )
{
- // valid lon/lat specified, use it.
- } else {
- string apt = fgGetString("/sim/presets/airport-id");
- double hdg = fgGetDouble("/sim/presets/heading-deg");
- if ( !apt.empty() ) {
- // An airport id is requested, set position from that.
- fgSetPosFromAirportIDandHdg( apt, hdg );
+ set_pos = true;
+ }
+ string apt = fgGetString("/sim/presets/airport-id");
+ string rwy_no = fgGetString("/sim/presets/runway");
+ double hdg = fgGetDouble("/sim/presets/heading-deg");
+ if ( !set_pos && !apt.empty() && !rwy_no.empty() ) {
+ // An airport + runway is requested
+ if ( fgSetPosFromAirportIDandRwy( apt, rwy_no ) ) {
// set tower position (a little off the heading for single
// runway airports)
fgSetTowerPosFromAirportID( apt, hdg );
- } else {
- // No lon/lat specified, no airport specified, default to
- // middle of KSFO field.
- fgSetDouble("/sim/presets/longitude-deg", -122.374843);
- fgSetDouble("/sim/presets/latitude-deg", 37.619002);
+
+ set_pos = true;
+ }
+ }
+
+ if ( !set_pos && !apt.empty() ) {
+ if ( fgSetPosFromAirportIDandHdg( apt, hdg ) ) {
+ // set tower position (a little off the heading for single
+ // runway airports)
+ fgSetTowerPosFromAirportID( apt, hdg );
+
+ set_pos = true;
}
}
+ if ( !set_pos ) {
+ // No lon/lat specified, no airport specified, default to
+ // middle of KSFO field.
+ fgSetDouble("/sim/presets/longitude-deg", -122.374843);
+ fgSetDouble("/sim/presets/latitude-deg", 37.619002);
+ }
+
fgSetDouble( "/position/longitude-deg",
fgGetDouble("/sim/presets/longitude-deg") );
fgSetDouble( "/position/latitude-deg",
// initialization routines. If you are adding a subsystem to flight
// gear, its initialization call should located in this routine.
// Returns non-zero if a problem encountered.
-bool fgInitSubsystems( void ) {
+bool fgInitSubsystems() {
static const SGPropertyNode *longitude
= fgGetNode("/sim/presets/longitude-deg");
static const SGPropertyNode *latitude
// Load the local scenery data
double visibility_meters = fgGetDouble("/environment/visibility-m");
- global_tile_mgr.update( longitude->getDoubleValue(),
- latitude->getDoubleValue(),
- visibility_meters );
+ global_tile_mgr.update( visibility_meters );
} else {
SG_LOG( SG_GENERAL, SG_ALERT, "Error in Tile Manager initialization!" );
exit(-1);
}
-void fgReInitSubsystems( void )
+void fgReInitSubsystems()
{
static const SGPropertyNode *longitude
= fgGetNode("/sim/presets/longitude-deg");
if ( !freeze ) {
fgSetBool("/sim/freeze/master", true);
}
-
- // Initialize the Scenery Management subsystem
- // FIXME, what really needs to get initialized here, at the time
- // this was commented out, scenery.init() was a noop
- // scenery.init();
+ // Initialize the FDM
fgInitFDM();
// allocates structures so must happen before any of the flight
projects / flightgear.git / blobdiff