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 );
+
+ if (wp) {
+ add_waypoint( *wp, n );
+ delete wp;
-int FGRouteMgr::new_waypoint( const string& Tgt_Alt, int n ) {
- double alt = 0.0;
- string target = Tgt_Alt;
+ 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;
}
- // check for fix id
- 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" );
- return 3;
- }
-
- // Try finding a nav matching the ID
double lat, lon;
// The base lon/lat are determined by the last WP,
// or the current pos if the WP list is empty.
lon = fgGetNode("/position/longitude-deg")->getDoubleValue();
}
+ // check for fix id
+ FGFix f;
+ double heading;
+ double dist;
+
+ if ( globals->get_fixlist()->query_and_offset( target, lon, lat, 0, &f, &heading, &dist ) ) {
+ SG_LOG( SG_GENERAL, SG_INFO, "Adding waypoint (fix) = " << target );
+ *wp = new SGWayPoint( f.get_lon(), f.get_lat(), alt, SGWayPoint::WGS84, target );
+ return 3;
+ }
+
+ // Try finding a nav matching the ID
lat *= SGD_DEGREES_TO_RADIANS;
lon *= SGD_DEGREES_TO_RADIANS;
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
-// @pop ... remove first entry
-// @delete3 ... delete 4th entry
-// @insert2:ksfo@900 ... insert "ksfo@900" as 3rd entry
-// ksfo@900 ... append "ksfo@900"
+// @CLEAR ... clear route
+// @POP ... remove first entry
+// @DELETE3 ... delete 4th entry
+// @INSERT2:KSFO@900 ... insert "KSFO@900" as 3rd entry
+// KSFO@900 ... append "KSFO@900"
//
void FGRouteMgr::Listener::valueChanged(SGPropertyNode *prop)
{
const char *s = prop->getStringValue();
- if (!strcmp(s, "@clear"))
+ if (!strcmp(s, "@CLEAR"))
mgr->init();
- else if (!strcmp(s, "@pop"))
+ else if (!strcmp(s, "@POP"))
mgr->pop_waypoint(0);
- else if (!strncmp(s, "@delete", 7))
+ else if (!strncmp(s, "@DELETE", 7))
mgr->pop_waypoint(atoi(s + 7));
- else if (!strncmp(s, "@insert", 7)) {
+ else if (!strncmp(s, "@INSERT", 7)) {
char *r;
int pos = strtol(s + 7, &r, 10);
if (*r++ != ':')
projects / flightgear.git / blobdiff