// Acquire state is used to wait for the GPS to achieve lock.
void ent_acquiringS()
{
flags._.GPS_steering = 0 ;
flags._.pitch_feedback = 0 ;
flags._.altitude_hold_throttle = 0 ;
flags._.altitude_hold_pitch = 0 ;
// almost ready to turn the control on, save the trims and sensor offsets
#if (FIXED_TRIMPOINT != 1) // Do not alter trims from preset when they are fixed
#if(USE_NV_MEMORY == 1)
if(udb_skip_flags.skip_radio_trim == 0)
{
udb_servo_record_trims() ;
}
#else
udb_servo_record_trims() ;
#endif
#endif
dcm_calibrate() ;
waggle = WAGGLE_SIZE ;
throttleFiltered._.W1 = 0 ;
stateS = &acquiringS ;
standby_timer = STANDBY_PAUSE ;
#if ( LED_RED_MAG_CHECK == 0 )
LED_RED = LED_OFF ;
#endif
return ;
}
void dcm_run_calib_step(uint16_t count)
{
if (count == DCM_CALIB_COUNT)
{
DPRINT("calib_finished\r\n");
dcm_flags._.calib_finished = 1;
dcm_calibrate(); // Finish calibration
}
}
static boolean dcm_run_calib_step(uint16_t count)
{
if (count == CALIB_COUNT)
{
DPRINT("calib_finished\r\n");
dcm_calibrate(); // Finish calibration
return true; // indicate that we are done
}
return false;
}
// Acquire state is used to wait for the GPS to achieve lock.
void ent_acquiringS()
{
flags._.GPS_steering = 0 ;
flags._.pitch_feedback = 0 ;
flags._.altitude_hold_throttle = 0 ;
flags._.altitude_hold_pitch = 0 ;
// almost ready to turn the control on, save the trims and sensor offsets
udb_servo_record_trims() ;
dcm_calibrate() ;
waggle = WAGGLE_SIZE ;
throttleFiltered._.W1 = 0 ;
stateS = &acquiringS ;
standby_timer = STANDBY_PAUSE ;
#if ( LED_RED_MAG_CHECK == 0 )
LED_RED = LED_OFF ;
#endif
return ;
}