Exemplo n.º 1
0
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 ;
}
Exemplo n.º 2
0
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 ;
}
Exemplo n.º 3
0
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 ;
}
Exemplo n.º 4
0
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 ;
}