mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-24 04:03:35 +08:00
mtecs: disable underspeed mode in takeoff mode (as the comment says)
This commit is contained in:
@@ -185,8 +185,8 @@ int mTecs::updateFlightPathAngleAcceleration(float flightPathAngle, float flight
|
|||||||
(double)energyDistributionRateSp, (double)energyDistributionRate, (double)energyDistributionRateError, (double)energyDistributionRateError2);
|
(double)energyDistributionRateSp, (double)energyDistributionRate, (double)energyDistributionRateError, (double)energyDistributionRateError2);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Check airspeed: if below safe value switch to underspeed mode (if not in takeoff mode) */
|
/* Check airspeed: if below safe value switch to underspeed mode (if not in land or takeoff mode) */
|
||||||
if (mode != TECS_MODE_LAND && airspeed < _airspeedMin.get()) {
|
if (mode != TECS_MODE_LAND && mode != TECS_MODE_TAKEOFF && airspeed < _airspeedMin.get()) {
|
||||||
mode = TECS_MODE_UNDERSPEED;
|
mode = TECS_MODE_UNDERSPEED;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user