void manualS(void) { if ( udb_flags._.radio_on ) { if ( flags._.home_req & dcm_flags._.nav_capable ) ent_waypointS() ; else if ( flags._.auto_req ) ent_stabilizedS() ; } else { if ( dcm_flags._.nav_capable ) ent_returnS() ; else ent_stabilizedS() ; } return ; }
void manualS(void) { if ( udb_flags._.radio_on ) { if ( flight_mode_switch_home() & dcm_flags._.nav_capable ) ent_waypointS() ; else if ( flight_mode_switch_auto() ) ent_stabilizedS() ; } else { if ( dcm_flags._.nav_capable ) ent_returnS() ; else ent_stabilizedS() ; } return ; }
void returnS(void) { if ( udb_flags._.radio_on ) { if ( flags._.man_req ) ent_manualS() ; else if ( flags._.auto_req ) ent_stabilizedS() ; else if ( flags._.home_req & dcm_flags._.nav_capable ) ent_waypointS() ; } else { #if (FAILSAFE_HOLD == 1) flags._.rtl_hold = 1 ; #endif } return ; }
void waypointS(void) { #if ( LED_RED_MAG_CHECK == 0 ) udb_led_toggle(LED_RED) ; #endif if ( udb_flags._.radio_on ) { if ( flags._.man_req ) ent_manualS() ; else if ( flags._.auto_req ) ent_stabilizedS() ; } else { ent_returnS() ; } return ; }
void returnS(void) { if ( udb_flags._.radio_on ) { if ( flight_mode_switch_manual() ) ent_manualS() ; else if ( flight_mode_switch_auto() ) ent_stabilizedS() ; else if ( flight_mode_switch_home() & dcm_flags._.nav_capable ) ent_waypointS() ; } else { #if (FAILSAFE_HOLD == 1) flags._.rtl_hold = 1 ; #endif } return ; }
void waypointS(void) { #if ( LED_RED_MAG_CHECK == 0 ) udb_led_toggle(LED_RED) ; #endif if ( udb_flags._.radio_on ) { if ( flight_mode_switch_manual() ) ent_manualS() ; else if ( flight_mode_switch_auto() ) ent_stabilizedS() ; } else { ent_returnS() ; } return ; }