use thrust scale parameter for vtol pusher support (#5207)

This commit is contained in:
Andreas Daniel Antener
2016-08-03 23:41:01 +02:00
committed by Lorenz Meier
parent feccb9bfc1
commit f3c5c2c5a9
+2 -1
View File
@@ -361,7 +361,8 @@ void Standard::update_mc_state()
// desired roll angle in heading frame stays the same
float roll_new = -atan2f(body_z_sp(1), body_z_sp(2));
_pusher_throttle = (sinf(-pitch_forward) - sinf(_params_standard.down_pitch_max)) * _v_att_sp->thrust;
_pusher_throttle = (sinf(-pitch_forward) - sinf(_params_standard.down_pitch_max))
* _v_att_sp->thrust * _params_standard.forward_thrust_scale;
// limit desired pitch
float pitch_new = -_params_standard.down_pitch_max;