void stabilization_attitude_enter(void) { stab_att_sp_euler.psi = stateGetNedToBodyEulers_i()->psi; reset_psi_ref_from_body(); INT_EULERS_ZERO( stabilization_att_sum_err ); }
void stabilization_attitude_ref_enter(void) { reset_psi_ref_from_body(); update_ref_quat_from_eulers(); }
void stabilization_attitude_ref_enter() { reset_psi_ref_from_body(); }