X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FAutopilot%2Froute_mgr.cxx;h=e8c5674c3213605a19f57ed730878c63812b16c4;hb=11d15b451347674fba77648700d23c5aaec3c6c2;hp=b52fa4fe88ce694650779d8b2a9113d5046e35fe;hpb=f3b110e5656b077edb7adb63d3854c5ce235c656;p=flightgear.git diff --git a/src/Autopilot/route_mgr.cxx b/src/Autopilot/route_mgr.cxx index b52fa4fe8..e8c5674c3 100644 --- a/src/Autopilot/route_mgr.cxx +++ b/src/Autopilot/route_mgr.cxx @@ -29,12 +29,9 @@ #include -#include #include #include
-#include -#include -#include +#include #include "route_mgr.hxx" @@ -70,6 +67,7 @@ FGRouteMgr::FGRouteMgr() : FGRouteMgr::~FGRouteMgr() { input->removeChangeListener(listener); + delete listener; delete route; } @@ -126,80 +124,66 @@ static double get_ground_speed() { return kts; } +void FGRouteMgr::updateTargetAltitude() { + if (route->size() == 0) { + altitude_set = false; + return; + } + + SGWayPoint wp = route->get_waypoint( 0 ); + if (wp.get_target_alt() < -9990.0) { + altitude_set = false; + return; + } + + altitude_set = true; + target_altitude_ft->setDoubleValue( wp.get_target_alt() * SG_METER_TO_FEET ); + + if ( !near_ground() ) { + // James Turner [zakalawe]: there's no explanation for this logic, + // it feels like the autopilot should pull the target altitude out of + // wp0 instead of us pushing it through here. Hmmm. + altitude_lock->setStringValue( "altitude-hold" ); + } +} void FGRouteMgr::update( double dt ) { - double accum = 0.0; + if (route->size() == 0) { + return; // no route set, early return + } + double wp_course, wp_distance; - char eta_str[128]; // first way point - if ( route->size() > 0 ) { - SGWayPoint wp = route->get_waypoint( 0 ); - wp.CourseAndDistance( lon->getDoubleValue(), lat->getDoubleValue(), - 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; + SGWayPoint wp = route->get_waypoint( 0 ); + wp.CourseAndDistance( lon->getDoubleValue(), lat->getDoubleValue(), + alt->getDoubleValue(), &wp_course, &wp_distance ); + true_hdg_deg->setDoubleValue( wp_course ); + + if ( wp_distance < 200.0 ) { + pop_waypoint(); + if (route->size() == 0) { + return; // end of route, we're done for the time being } + + wp = route->get_waypoint( 0 ); } - // next way point - if ( route->size() > 0 ) { - SGWayPoint wp = route->get_waypoint( 0 ); - // update the property tree info - - wp0_id->setStringValue( wp.get_id().c_str() ); - - accum += wp_distance; - wp0_dist->setDoubleValue( accum * SG_METER_TO_NM ); - - double eta = accum * SG_METER_TO_NM / get_ground_speed(); - if ( eta >= 100.0 ) { eta = 99.999; } - int major, minor; - if ( eta < (1.0/6.0) ) { - // within 10 minutes, bump up to min/secs - eta *= 60.0; - } - major = (int)eta; - minor = (int)((eta - (int)eta) * 60.0); - snprintf( eta_str, 128, "%d:%02d", major, minor ); - wp0_eta->setStringValue( eta_str ); - } + // update the property tree info for WP0 + wp0_id->setStringValue( wp.get_id().c_str() ); + double accum = wp_distance; + wp0_dist->setDoubleValue( accum * SG_METER_TO_NM ); + setETAPropertyFromDistance(wp0_eta, accum); // next way point if ( route->size() > 1 ) { SGWayPoint wp = route->get_waypoint( 1 ); // update the property tree info - wp1_id->setStringValue( wp.get_id().c_str() ); - accum += wp.get_distance(); wp1_dist->setDoubleValue( accum * SG_METER_TO_NM ); - - double eta = accum * SG_METER_TO_NM / get_ground_speed(); - if ( eta >= 100.0 ) { eta = 99.999; } - int major, minor; - if ( eta < (1.0/6.0) ) { - // within 10 minutes, bump up to min/secs - eta *= 60.0; - } - major = (int)eta; - minor = (int)((eta - (int)eta) * 60.0); - snprintf( eta_str, 128, "%d:%02d", major, minor ); - wp1_eta->setStringValue( eta_str ); + setETAPropertyFromDistance(wp1_eta, accum); } // summarize remaining way points @@ -211,32 +195,36 @@ void FGRouteMgr::update( double dt ) { } // update the property tree info - wpn_id->setStringValue( wp.get_id().c_str() ); - wpn_dist->setDoubleValue( accum * SG_METER_TO_NM ); - - double eta = accum * SG_METER_TO_NM / get_ground_speed(); - if ( eta >= 100.0 ) { eta = 99.999; } - int major, minor; - if ( eta < (1.0/6.0) ) { - // within 10 minutes, bump up to min/secs - eta *= 60.0; - } - major = (int)eta; - minor = (int)((eta - (int)eta) * 60.0); - snprintf( eta_str, 128, "%d:%02d", major, minor ); - wpn_eta->setStringValue( eta_str ); + setETAPropertyFromDistance(wpn_eta, accum); } } +void FGRouteMgr::setETAPropertyFromDistance(SGPropertyNode_ptr aProp, double aDistance) { + char eta_str[64]; + double eta = aDistance * SG_METER_TO_NM / get_ground_speed(); + if ( eta >= 100.0 ) { + eta = 99.999; // clamp + } + + if ( eta < (1.0/6.0) ) { + // within 10 minutes, bump up to min/secs + eta *= 60.0; + } + + int major = (int)eta, + minor = (int)((eta - (int)eta) * 60.0); + snprintf( eta_str, 64, "%d:%02d", major, minor ); + aProp->setStringValue( eta_str ); +} void FGRouteMgr::add_waypoint( const SGWayPoint& wp, int n ) { - if ( n == 0 || !route->size() ) - altitude_set = false; - route->add_waypoint( wp, n ); update_mirror(); + if ((n==0) || (route->size() == 1)) { + updateTargetAltitude(); + } } @@ -268,9 +256,7 @@ SGWayPoint FGRouteMgr::pop_waypoint( int n ) { wp0_eta->setStringValue( "" ); } - if ( n == 0 && route->size() ) - altitude_set = false; - + updateTargetAltitude(); update_mirror(); return wp; } @@ -342,7 +328,7 @@ SGWayPoint* FGRouteMgr::make_waypoint(const string& tgt ) { return NULL; } - return new SGWayPoint(p->longitude(), p->latitude(), p->elevation(), SGWayPoint::WGS84, target); + return new SGWayPoint(p->longitude(), p->latitude(), alt, SGWayPoint::WGS84, target); } @@ -367,7 +353,7 @@ void FGRouteMgr::update_mirror() { bool FGRouteMgr::near_ground() { SGPropertyNode *gear = fgGetNode( "/gear/gear/wow", false ); - if ( !gear || gear->getType() == SGPropertyNode::NONE ) + if ( !gear || gear->getType() == simgear::props::NONE ) return fgGetBool( "/sim/presets/onground", true ); if ( fgGetDouble("/position/altitude-agl-ft", 300.0)