// 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 ; }