コード例 #1
0
ファイル: states.c プロジェクト: cglusky/MatrixPilot-VTOL
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 ;
}
コード例 #2
0
ファイル: states.c プロジェクト: trigrass2/lino-udb4
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 ;
}
コード例 #3
0
ファイル: states.c プロジェクト: cglusky/MatrixPilot-VTOL
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 ;
}
コード例 #4
0
ファイル: states.c プロジェクト: cglusky/MatrixPilot-VTOL
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 ;
}
コード例 #5
0
ファイル: states.c プロジェクト: trigrass2/lino-udb4
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 ;
}
コード例 #6
0
ファイル: states.c プロジェクト: trigrass2/lino-udb4
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 ;
}