IRI ROS Specific Algorithm Class. More...

#include <force_robot_companion_learning_alg_node.h>

Inheritance diagram for ForceRobotCompanionLearningAlgNode:

Public Member Functions
	ForceRobotCompanionLearningAlgNode (void)
	Constructor.
	~ForceRobotCompanionLearningAlgNode (void)
	Destructor.
Protected Member Functions
void	addNodeDiagnostics (void)
	node add diagnostics
void	mainNodeThread (void)
	main node thread
void	node_config_update (Config &config, uint32_t level)
	dynamic reconfigure server callback
Private Types
enum	learning_mode { Density = 0, Initial_paramters }
enum	sim_state { Init_Sim = 0, Find_Nearest, Test_Sim, End_Sim }
Private Member Functions
void	clear_force_markers ()
void	dest_callback (const geometry_msgs::PoseStamped::ConstPtr &msg)
void	growing_density_test ()
void	init_node ()
void	initial_params_learning ()
void	tracks_callback (const iri_perception_msgs::peopleTrackingArray::ConstPtr &msg)
void	vis_destinations ()
void	vis_intentionality_prediction ()
void	vis_predictions ()
void	vis_trajectories ()
Private Attributes
std_msgs::Float64	angle_robot_person_msg_
ros::Publisher	angle_robot_person_publisher_
visualization_msgs::Marker	dest_marker_
CMutex	dest_mutex_
ros::Subscriber	dest_subscriber_
string	destination_map_path_
ros::Publisher	destinations_publisher_
Sforce	f1_
Sforce	f2_
Sforce	f3_
Sforce	f4_
Sforce	f5_
Sforce	f_
FILE *	file_results_out_
visualization_msgs::Marker	force_goal2_marker_
visualization_msgs::Marker	force_goal_marker_
visualization_msgs::Marker	force_int_person_marker_
visualization_msgs::Marker	force_int_robot_marker_
string	force_map_path_
visualization_msgs::Marker	force_marker_
visualization_msgs::Marker	force_obstacle_laser_marker_
visualization_msgs::Marker	force_obstacle_map_marker_
geometry_msgs::PointStamped	force_param_msg_
ros::Publisher	force_param_publisher_
ros::Publisher	forces_publisher_
CMutex	laser_mutex_
double	laser_radi_
ros::Subscriber	laser_subscriber_
learning_mode	learning_mode_
visualization_msgs::MarkerArray	MarkerArray_destinations_msg_
visualization_msgs::MarkerArray	MarkerArray_forces_msg_
visualization_msgs::MarkerArray	MarkerArray_predictions_msg_
visualization_msgs::MarkerArray	MarkerArray_trajectories_msg_
int	nearest_target_
ros::Time	now_
int	num_experiment_
int	number_of_virtual_people_
double	param_f1_
double	param_f2_
double	param_f3_
std_msgs::Float64	person_robot_dist_msg_
ros::Publisher	person_robot_dist_publisher_
Cforce_reactive_robot_companion_learning	pred_
visualization_msgs::Marker	pred_marker_
ros::Publisher	predictions_publisher_
std::vector< int >	prev_buttons_
ros::ServiceClient	reset_client_
std_srvs::Empty	reset_srv_
bool	results_file_is_open_
string	results_folder_
SpointV_cov	robot_desired_position_
std::string	robot_frame_
visualization_msgs::Marker	robot_marker_
geometry_msgs::PoseStamped	robot_position_msg_
ros::Publisher	robot_position_publisher_
double	robot_x_ini_
double	robot_y_ini_
sim_state	simulation_state_
SpointV_cov	target_followed_pose_
std::string	target_frame_
visualization_msgs::Marker	target_marker_
geometry_msgs::PointStamped	target_person_position_msg_
ros::Publisher	target_person_position_publisher_
visualization_msgs::Marker	text_marker_
tf::TransformListener	tf_listener_
int	timer_
CMutex	tracks_mutex_
ros::Subscriber	tracks_subscriber_
visualization_msgs::Marker	traj_marker_
visualization_msgs::Marker	traj_robot_marker_
ros::Publisher	trajectories_publisher_
bool	using_prediction_

Detailed Description

IRI ROS Specific Algorithm Class.

Definition at line 61 of file force_robot_companion_learning_alg_node.h.

Member Enumeration Documentation

enum ForceRobotCompanionLearningAlgNode::learning_mode [private]

Enumerator:

Density
Initial_paramters

Definition at line 64 of file force_robot_companion_learning_alg_node.h.

enum ForceRobotCompanionLearningAlgNode::sim_state [private]

Enumerator:

Init_Sim
Find_Nearest
Test_Sim
End_Sim

Definition at line 63 of file force_robot_companion_learning_alg_node.h.

Constructor & Destructor Documentation

ForceRobotCompanionLearningAlgNode::ForceRobotCompanionLearningAlgNode ( void )

Constructor.

This constructor initializes specific class attributes and all ROS communications variables to enable message exchange.

Definition at line 6 of file force_robot_companion_learning_alg_node.cpp.

ForceRobotCompanionLearningAlgNode::~ForceRobotCompanionLearningAlgNode ( void )

Destructor.

This destructor frees all necessary dynamic memory allocated within this this class.

Definition at line 49 of file force_robot_companion_learning_alg_node.cpp.

Member Function Documentation

void ForceRobotCompanionLearningAlgNode::addNodeDiagnostics ( void ) [protected, virtual]

node add diagnostics

In this abstract function additional ROS diagnostics applied to the specific algorithms may be added.

Implements algorithm_base::IriBaseAlgorithm< ForceRobotCompanionLearningAlgorithm >.

Definition at line 1009 of file force_robot_companion_learning_alg_node.cpp.

void ForceRobotCompanionLearningAlgNode::clear_force_markers ( ) [private]

Definition at line 712 of file force_robot_companion_learning_alg_node.cpp.

void ForceRobotCompanionLearningAlgNode::dest_callback ( const geometry_msgs::PoseStamped::ConstPtr & msg ) [private]

Definition at line 865 of file force_robot_companion_learning_alg_node.cpp.

void ForceRobotCompanionLearningAlgNode::growing_density_test ( ) [private]

Definition at line 301 of file force_robot_companion_learning_alg_node.cpp.

void ForceRobotCompanionLearningAlgNode::init_node ( ) [private]

Definition at line 128 of file force_robot_companion_learning_alg_node.cpp.

void ForceRobotCompanionLearningAlgNode::initial_params_learning ( ) [private]

Definition at line 387 of file force_robot_companion_learning_alg_node.cpp.

void ForceRobotCompanionLearningAlgNode::mainNodeThread ( void ) [protected, virtual]

main node thread

This is the main thread node function. Code written here will be executed in every node loop while the algorithm is on running state. Loop frequency can be tuned by modifying loop_rate attribute.

Here data related to the process loop or to ROS topics (mainly data structs related to the MSG and SRV files) must be updated. ROS publisher objects must publish their data in this process. ROS client servers may also request data to the corresponding server topics.

Implements algorithm_base::IriBaseAlgorithm< ForceRobotCompanionLearningAlgorithm >.

Definition at line 56 of file force_robot_companion_learning_alg_node.cpp.

void ForceRobotCompanionLearningAlgNode::node_config_update	(	Config &	config,
		uint32_t	level
	)		`[protected, virtual]`

dynamic reconfigure server callback

This method is called whenever a new configuration is received through the dynamic reconfigure. The derivated generic algorithm class must implement it.

Parameters:

config	an object with new configuration from all algorithm parameters defined in the config file.
level	integer referring the level in which the configuration has been changed.

Implements algorithm_base::IriBaseAlgorithm< ForceRobotCompanionLearningAlgorithm >.

Definition at line 951 of file force_robot_companion_learning_alg_node.cpp.

void ForceRobotCompanionLearningAlgNode::tracks_callback ( const iri_perception_msgs::peopleTrackingArray::ConstPtr & msg ) [private]

Definition at line 879 of file force_robot_companion_learning_alg_node.cpp.

void ForceRobotCompanionLearningAlgNode::vis_destinations ( ) [private]

Definition at line 752 of file force_robot_companion_learning_alg_node.cpp.

void ForceRobotCompanionLearningAlgNode::vis_intentionality_prediction ( ) [private]

Definition at line 723 of file force_robot_companion_learning_alg_node.cpp.

void ForceRobotCompanionLearningAlgNode::vis_predictions ( ) [private]

Definition at line 830 of file force_robot_companion_learning_alg_node.cpp.

void ForceRobotCompanionLearningAlgNode::vis_trajectories ( ) [private]

Definition at line 498 of file force_robot_companion_learning_alg_node.cpp.