mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-01 02:55:07 +08:00
use thrust scale parameter for vtol pusher support (#5207)
This commit is contained in:
committed by
Lorenz Meier
parent
feccb9bfc1
commit
f3c5c2c5a9
@@ -361,7 +361,8 @@ void Standard::update_mc_state()
|
|||||||
// desired roll angle in heading frame stays the same
|
// desired roll angle in heading frame stays the same
|
||||||
float roll_new = -atan2f(body_z_sp(1), body_z_sp(2));
|
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
|
// limit desired pitch
|
||||||
float pitch_new = -_params_standard.down_pitch_max;
|
float pitch_new = -_params_standard.down_pitch_max;
|
||||||
|
|||||||
Reference in New Issue
Block a user