|
|
|
@ -401,6 +401,13 @@ void Standard::update_mc_state()
@@ -401,6 +401,13 @@ void Standard::update_mc_state()
|
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// Do not engage pusher assist during a failsafe event
|
|
|
|
|
// There could be a problem with the fixed wing drive
|
|
|
|
|
if (_attc->get_vtol_vehicle_status()->vtol_transition_failsafe) { |
|
|
|
|
_pusher_throttle = 0.0f; |
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
matrix::Dcmf R(matrix::Quatf(_v_att->q)); |
|
|
|
|
matrix::Dcmf R_sp(matrix::Quatf(_v_att_sp->q_d)); |
|
|
|
|
matrix::Eulerf euler(R); |
|
|
|
|