lat( NULL ),
alt( NULL ),
true_hdg_deg( NULL ),
+ target_altitude_ft( NULL ),
+ altitude_lock( NULL ),
wp0_id( NULL ),
wp0_dist( NULL ),
wp0_eta( NULL ),
wpn_eta( NULL ),
input(fgGetNode( RM "input", true )),
listener(new Listener(this)),
- mirror(fgGetNode( RM "route", true ))
+ mirror(fgGetNode( RM "route", true )),
+ altitude_set( false )
{
input->setStringValue("");
input->addChangeListener(listener);
FGRouteMgr::~FGRouteMgr() {
- delete route;
input->removeChangeListener(listener);
+ delete route;
}
alt = fgGetNode( "/position/altitude-ft", true );
true_hdg_deg = fgGetNode( "/autopilot/settings/true-heading-deg", true );
+ target_altitude_ft = fgGetNode( "/autopilot/settings/target-altitude-ft", true );
+ altitude_lock = fgGetNode( "/autopilot/locks/altitude", true );
wp0_id = fgGetNode( RM "wp[0]/id", true );
wp0_dist = fgGetNode( RM "wp[0]/dist", true );
alt->getDoubleValue(), &wp_course, &wp_distance );
true_hdg_deg->setDoubleValue( wp_course );
+ double target_alt = wp.get_target_alt();
+
+ if ( !altitude_set && target_alt > -9990 ) {
+ target_altitude_ft->setDoubleValue( target_alt * SG_METER_TO_FEET );
+ altitude_set = true;
+
+ if ( !near_ground() )
+ altitude_lock->setStringValue( "altitude-hold" );
+ }
if ( wp_distance < 200.0 ) {
pop_waypoint();
+ altitude_set = false;
}
}
void FGRouteMgr::add_waypoint( const SGWayPoint& wp, int n ) {
+ if ( n == 0 || !route->size() )
+ altitude_set = false;
+
route->add_waypoint( wp, n );
update_mirror();
}
wp0_eta->setStringValue( "" );
}
+ if ( n == 0 && route->size() )
+ altitude_set = false;
+
update_mirror();
return wp;
}
}
+int FGRouteMgr::new_waypoint( const string& target, int n ) {
+ SGWayPoint *wp = 0;
+ int type = make_waypoint( &wp, target );
-int FGRouteMgr::new_waypoint( const string& Tgt_Alt, int n ) {
- double alt = 0.0;
- string target = Tgt_Alt;
+ if (wp) {
+ add_waypoint( *wp, n );
+ delete wp;
+
+ if ( !near_ground() )
+ fgSetString( "/autopilot/locks/heading", "true-heading-hold" );
+ }
+ return type;
+}
+
+
+int FGRouteMgr::make_waypoint( SGWayPoint **wp, const string& tgt ) {
+ string target = tgt;
// make upper case
for (unsigned int i = 0; i < target.size(); i++)
target[i] -= 'a' - 'A';
// extract altitude
- unsigned int pos = target.find( '@' );
+ double alt = -9999.0;
+ size_t pos = target.find( '@' );
if ( pos != string::npos ) {
alt = atof( target.c_str() + pos + 1 );
target = target.substr( 0, pos );
}
// check for lon,lat
- pos = target.find(',');
+ pos = target.find( ',' );
if ( pos != string::npos ) {
double lon = atof( target.substr(0, pos).c_str());
double lat = atof( target.c_str() + pos + 1);
SG_LOG( SG_GENERAL, SG_INFO, "Adding waypoint lon = " << lon << ", lat = " << lat );
- SGWayPoint wp( lon, lat, alt, SGWayPoint::WGS84, target );
- add_waypoint( wp, n );
- fgSetString( "/autopilot/locks/heading", "true-heading-hold" );
+ *wp = new SGWayPoint( lon, lat, alt, SGWayPoint::WGS84, target );
return 1;
}
const FGAirport *apt = fgFindAirportID( target );
if (apt) {
SG_LOG( SG_GENERAL, SG_INFO, "Adding waypoint (airport) = " << target );
- SGWayPoint wp( apt->getLongitude(), apt->getLatitude(), alt, SGWayPoint::WGS84, target );
- add_waypoint( wp, n );
- fgSetString( "/autopilot/locks/heading", "true-heading-hold" );
+ *wp = new SGWayPoint( apt->getLongitude(), apt->getLatitude(), alt, SGWayPoint::WGS84, target );
return 2;
}
FGFix f;
if ( globals->get_fixlist()->query( target, &f ) ) {
SG_LOG( SG_GENERAL, SG_INFO, "Adding waypoint (fix) = " << target );
- SGWayPoint wp( f.get_lon(), f.get_lat(), alt, SGWayPoint::WGS84, target );
- add_waypoint( wp, n );
- fgSetString( "/autopilot/locks/heading", "true-heading-hold" );
+ *wp = new SGWayPoint( f.get_lon(), f.get_lat(), alt, SGWayPoint::WGS84, target );
return 3;
}
if (FGNavRecord* nav = globals->get_navlist()->findByIdent(target.c_str(), lon, lat)) {
SG_LOG( SG_GENERAL, SG_INFO, "Adding waypoint (nav) = " << target );
- SGWayPoint wp( nav->get_lon(), nav->get_lat(), alt, SGWayPoint::WGS84, target );
- add_waypoint( wp, n );
- fgSetString( "/autopilot/locks/heading", "true-heading-hold" );
+ *wp = new SGWayPoint( nav->get_lon(), nav->get_lat(), alt, SGWayPoint::WGS84, target );
return 4;
}
- // target not identified
+ // unknown target
return 0;
}
}
+bool FGRouteMgr::near_ground() {
+ SGPropertyNode *gear = fgGetNode( "/gear/gear/wow", false );
+ if ( !gear || gear->getType() == SGPropertyNode::NONE )
+ return fgGetBool( "/sim/presets/onground", true );
+
+ if ( fgGetDouble("/position/altitude-agl-ft", 300.0)
+ < fgGetDouble("/autopilot/route-manager/min-lock-altitude-agl-ft") )
+ return true;
+
+ return gear->getBoolValue();
+}
+
+
// command interface /autopilot/route-manager/input:
//
// @clear ... clear route