void udb_callback_radio_did_turn_off( void )
{
// Only enter RTL mode if we are calibrated and acquired
if (calib_timer <= 0 && standby_timer <= 0)
{
ent_returnS() ;
}
return ;
}
void stabilizedS(void)
{
if ( udb_flags._.radio_on )
{
if ( flags._.home_req & dcm_flags._.nav_capable )
ent_waypointS() ;
else if ( flags._.man_req )
ent_manualS() ;
}
else
{
if ( dcm_flags._.nav_capable )
ent_returnS() ;
}
return ;
}
void stabilizedS(void)
{
if ( udb_flags._.radio_on )
{
if ( flight_mode_switch_home() & dcm_flags._.nav_capable )
ent_waypointS() ;
else if ( flight_mode_switch_manual() )
ent_manualS() ;
}
else
{
if ( dcm_flags._.nav_capable )
ent_returnS() ;
}
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 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 ;
}