mtecs: disable underspeed mode in takeoff mode (as the comment says)

This commit is contained in:
Thomas Gubler 2014-06-02 18:28:18 +02:00
parent fecbebc5a6
commit eb02c6ce49

View File

@ -185,8 +185,8 @@ int mTecs::updateFlightPathAngleAcceleration(float flightPathAngle, float flight
(double)energyDistributionRateSp, (double)energyDistributionRate, (double)energyDistributionRateError, (double)energyDistributionRateError2);
}
/* Check airspeed: if below safe value switch to underspeed mode (if not in takeoff mode) */
if (mode != TECS_MODE_LAND && airspeed < _airspeedMin.get()) {
/* Check airspeed: if below safe value switch to underspeed mode (if not in land or takeoff mode) */
if (mode != TECS_MODE_LAND && mode != TECS_MODE_TAKEOFF && airspeed < _airspeedMin.get()) {
mode = TECS_MODE_UNDERSPEED;
}