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();
}