Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-25 08:36:08 +08:00
Code Issues Actions 8 Packages Projects Releases Wiki Activity

Takeoff: remove updateRamp() early return

Browse Source
This commit is contained in:
Matthias Grob
2021-03-04 11:15:33 +01:00
parent b7600f4e4d
commit 8ca76feaba
1 changed files with 5 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/mc_pos_control/Takeoff/Takeoff.cpp
+5 -3
View File
@@ -111,8 +111,10 @@ void Takeoff::updateTakeoffState(const bool armed, const bool landed, const bool
float Takeoff::updateRamp(const float dt, const float takeoff_desired_vz)
{
float upwards_velocity_limit = takeoff_desired_vz;
if (_takeoff_state < TakeoffState::rampup) {
return _takeoff_ramp_vz_init;
upwards_velocity_limit = _takeoff_ramp_vz_init;
}
if (_takeoff_state == TakeoffState::rampup) {
@@ -124,9 +126,9 @@ float Takeoff::updateRamp(const float dt, const float takeoff_desired_vz)
}
if (_takeoff_ramp_vz < takeoff_desired_vz) {
return _takeoff_ramp_vz;
upwards_velocity_limit = _takeoff_ramp_vz;
}
}
return takeoff_desired_vz;
return upwards_velocity_limit;
}