Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-28 10:46:33 +08:00
Code Issues Actions 27 Packages Projects Releases Wiki Activity

MulticopterPositionControl: improve tilt limit readability and scope

Browse Source 
according to @bresch's review comment.
This commit is contained in:
Matthias Grob
2021-03-30 19:48:12 +02:00
parent 94469d84ae
commit c06b5a1de9
1 changed files with 3 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/mc_pos_control/MulticopterPositionControl.cpp
+3 -7
View File
@@ -375,13 +375,9 @@ void MulticopterPositionControl::Run()
} }
// limit tilt during takeoff ramupup // limit tilt during takeoff ramupup
float tilt_limit = math::radians(_param_mpc_tiltmax_air.get()); const float tilt_limit_deg = (_takeoff.getTakeoffState() < TakeoffState::flight)
? _param_mpc_tiltmax_lnd.get() : _param_mpc_tiltmax_air.get();
if (_takeoff.getTakeoffState() < TakeoffState::flight) { _control.setTiltLimit(_tilt_limit_slew_rate.update(math::radians(tilt_limit_deg), dt));
tilt_limit = math::radians(_param_mpc_tiltmax_lnd.get());
}
_control.setTiltLimit(_tilt_limit_slew_rate.update(tilt_limit, dt));
const float speed_up = _takeoff.updateRamp(dt, const float speed_up = _takeoff.updateRamp(dt,
PX4_ISFINITE(_vehicle_constraints.speed_up) ? _vehicle_constraints.speed_up : _param_mpc_z_vel_max_up.get()); PX4_ISFINITE(_vehicle_constraints.speed_up) ? _vehicle_constraints.speed_up : _param_mpc_z_vel_max_up.get());