#include <ControlNode.h>

Public Member Functions
void	comCb (const std_msgs::StringConstPtr str)
	ControlNode ()
void	droneposeCb (const tum_ardrone::filter_stateConstPtr statePtr)
void	dynConfCb (tum_ardrone::AutopilotParamsConfig &config, uint32_t level)
void	Loop ()
void	publishCommand (std::string c)
void	sendControlToDrone (ControlCommand cmd)
void	sendLand ()
void	sendTakeoff ()
void	sendToggleState ()
void	toogleLogging ()
	~ControlNode ()
Public Attributes
DroneController	controller
ControlCommand	hoverCommand
bool	isControlling
long	lastControlSentMS
std::ofstream *	logfileControl
Static Public Attributes
static pthread_mutex_t	logControl_CS = PTHREAD_MUTEX_INITIALIZER
Private Member Functions
bool	clear (std_srvs::Empty::Request &, std_srvs::Empty::Response &)
void	clearCommands ()
bool	hover (std_srvs::Empty::Request &, std_srvs::Empty::Response &)
bool	lockScaleFP (std_srvs::Empty::Request &, std_srvs::Empty::Response &)
void	popNextCommand (const tum_ardrone::filter_stateConstPtr statePtr)
void	reSendInfo ()
bool	setInitialReachDistance (tum_ardrone::SetInitialReachDistance::Request &, tum_ardrone::SetInitialReachDistance::Response &)
bool	setMaxControl (tum_ardrone::SetMaxControl::Request &, tum_ardrone::SetMaxControl::Response &)
bool	setReference (tum_ardrone::SetReference::Request &, tum_ardrone::SetReference::Response &)
bool	setStayTime (tum_ardrone::SetStayTime::Request &, tum_ardrone::SetStayTime::Response &)
bool	setStayWithinDistance (tum_ardrone::SetStayWithinDistance::Request &, tum_ardrone::SetStayWithinDistance::Response &)
bool	start (std_srvs::Empty::Request &, std_srvs::Empty::Response &)
void	startControl ()
bool	stop (std_srvs::Empty::Request &, std_srvs::Empty::Response &)
void	stopControl ()
void	updateControl (const tum_ardrone::filter_stateConstPtr statePtr)
Private Attributes
char	buf [500]
ros::ServiceServer	clearCommands_
std::string	command_channel
std::deque< std::string >	commandQueue
std::string	control_channel
KIProcedure *	currentKI
std::string	dronepose_channel
ros::Subscriber	dronepose_sub
ros::ServiceServer	hover_
std::string	land_channel
ros::Publisher	land_pub
ControlCommand	lastSentControl
ros::ServiceServer	lockScaleFP_
int	minPublishFreq
ros::NodeHandle	nh_
std::string	packagePath
double	parameter_InitialReachDist
double	parameter_MaxControl
DronePosition	parameter_referenceZero
double	parameter_StayTime
double	parameter_StayWithinDist
ros::ServiceServer	setInitialReachDistance_
ros::ServiceServer	setMaxControl_
ros::ServiceServer	setReference_
ros::ServiceServer	setStayTime_
ros::ServiceServer	setStayWithinDistance_
ros::ServiceServer	startControl_
ros::ServiceServer	stopControl_
std::string	takeoff_channel
ros::Publisher	takeoff_pub
std::string	toggleState_channel
ros::Publisher	toggleState_pub
ros::Publisher	tum_ardrone_pub
ros::Subscriber	tum_ardrone_sub
ros::Publisher	vel_pub
Static Private Attributes
static pthread_mutex_t	commandQueue_CS = PTHREAD_MUTEX_INITIALIZER
static pthread_mutex_t	tum_ardrone_CS = PTHREAD_MUTEX_INITIALIZER

Detailed Description

Definition at line 47 of file ControlNode.h.

Constructor & Destructor Documentation

ControlNode::ControlNode ( )

Definition at line 47 of file ControlNode.cpp.

ControlNode::~ControlNode ( )

Definition at line 111 of file ControlNode.cpp.

Member Function Documentation

bool ControlNode::clear	(	std_srvs::Empty::Request &	,
		std_srvs::Empty::Response &
	)		`[private]`

Definition at line 553 of file ControlNode.cpp.

void ControlNode::clearCommands ( ) [private]

Definition at line 492 of file ControlNode.cpp.

void ControlNode::comCb ( const std_msgs::StringConstPtr str )

Definition at line 312 of file ControlNode.cpp.

void ControlNode::droneposeCb ( const tum_ardrone::filter_stateConstPtr statePtr )

Definition at line 117 of file ControlNode.cpp.

void ControlNode::dynConfCb	(	tum_ardrone::AutopilotParamsConfig &	config,
		uint32_t	level
	)

Definition at line 375 of file ControlNode.cpp.

bool ControlNode::hover	(	std_srvs::Empty::Request &	,
		std_srvs::Empty::Response &
	)		`[private]`

Definition at line 559 of file ControlNode.cpp.

bool ControlNode::lockScaleFP	(	std_srvs::Empty::Request &	,
		std_srvs::Empty::Response &
	)		`[private]`

Definition at line 565 of file ControlNode.cpp.

void ControlNode::Loop ( )

Definition at line 346 of file ControlNode.cpp.

void ControlNode::popNextCommand ( const tum_ardrone::filter_stateConstPtr statePtr ) [private]

Definition at line 145 of file ControlNode.cpp.

void ControlNode::publishCommand ( std::string c )

Definition at line 398 of file ControlNode.cpp.

void ControlNode::reSendInfo ( ) [private]

Definition at line 448 of file ControlNode.cpp.

void ControlNode::sendControlToDrone ( ControlCommand cmd )

Definition at line 413 of file ControlNode.cpp.

void ControlNode::sendLand ( )

Definition at line 433 of file ControlNode.cpp.

void ControlNode::sendTakeoff ( )

Definition at line 438 of file ControlNode.cpp.

void ControlNode::sendToggleState ( )

Definition at line 443 of file ControlNode.cpp.

bool ControlNode::setInitialReachDistance	(	tum_ardrone::SetInitialReachDistance::Request &	,
		tum_ardrone::SetInitialReachDistance::Response &
	)		`[private]`