Skip to content

Commit 4f6c1d9

Browse files
RomanBapstJaeyoung-Lim
authored andcommitted
FixedWingPositionControl: use target climb/sink rate parameters as maximum
rates in manual altitude controlled modes Signed-off-by: RomanBapst <[email protected]>
1 parent ba13bb7 commit 4f6c1d9

File tree

1 file changed

+2
-2
lines changed

1 file changed

+2
-2
lines changed

src/modules/fw_pos_control_l1/FixedwingPositionControl.cpp

Lines changed: 2 additions & 2 deletions
Original file line numberDiff line numberDiff line change
@@ -641,13 +641,13 @@ FixedwingPositionControl::update_desired_altitude(float dt)
641641
if (_manual_control_setpoint_altitude > deadBand) {
642642
/* pitching down */
643643
float pitch = -(_manual_control_setpoint_altitude - deadBand) / factor;
644-
_hold_alt += (_param_fw_t_sink_max.get() * dt) * pitch;
644+
_hold_alt += (_param_sinkrate_target.get() * dt) * pitch;
645645
_was_in_deadband = false;
646646

647647
} else if (_manual_control_setpoint_altitude < - deadBand) {
648648
/* pitching up */
649649
float pitch = -(_manual_control_setpoint_altitude + deadBand) / factor;
650-
_hold_alt += (_param_fw_t_clmb_max.get() * dt) * pitch;
650+
_hold_alt += (_param_climbrate_target.get() * dt) * pitch;
651651
_was_in_deadband = false;
652652

653653
} else if (!_was_in_deadband) {

0 commit comments

Comments
 (0)