IRI ROS Specific Algorithm Class. More...
#include <force_robot_companion_learning_alg_node.h>
IRI ROS Specific Algorithm Class.
Definition at line 61 of file force_robot_companion_learning_alg_node.h.
enum ForceRobotCompanionLearningAlgNode::learning_mode [private] |
Definition at line 64 of file force_robot_companion_learning_alg_node.h.
enum ForceRobotCompanionLearningAlgNode::sim_state [private] |
Definition at line 63 of file force_robot_companion_learning_alg_node.h.
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.
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.
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.
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.
Definition at line 68 of file force_robot_companion_learning_alg_node.h.
Definition at line 67 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::Marker ForceRobotCompanionLearningAlgNode::dest_marker_ [private] |
Definition at line 88 of file force_robot_companion_learning_alg_node.h.
CMutex ForceRobotCompanionLearningAlgNode::dest_mutex_ [private] |
Definition at line 107 of file force_robot_companion_learning_alg_node.h.
Definition at line 105 of file force_robot_companion_learning_alg_node.h.
string ForceRobotCompanionLearningAlgNode::destination_map_path_ [private] |
Definition at line 144 of file force_robot_companion_learning_alg_node.h.
Definition at line 81 of file force_robot_companion_learning_alg_node.h.
Sforce ForceRobotCompanionLearningAlgNode::f1_ [private] |
Definition at line 135 of file force_robot_companion_learning_alg_node.h.
Sforce ForceRobotCompanionLearningAlgNode::f2_ [private] |
Definition at line 135 of file force_robot_companion_learning_alg_node.h.
Sforce ForceRobotCompanionLearningAlgNode::f3_ [private] |
Definition at line 135 of file force_robot_companion_learning_alg_node.h.
Sforce ForceRobotCompanionLearningAlgNode::f4_ [private] |
Definition at line 135 of file force_robot_companion_learning_alg_node.h.
Sforce ForceRobotCompanionLearningAlgNode::f5_ [private] |
Definition at line 135 of file force_robot_companion_learning_alg_node.h.
Sforce ForceRobotCompanionLearningAlgNode::f_ [private] |
Definition at line 135 of file force_robot_companion_learning_alg_node.h.
FILE* ForceRobotCompanionLearningAlgNode::file_results_out_ [private] |
Definition at line 150 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::Marker ForceRobotCompanionLearningAlgNode::force_goal2_marker_ [private] |
Definition at line 91 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::Marker ForceRobotCompanionLearningAlgNode::force_goal_marker_ [private] |
Definition at line 91 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::Marker ForceRobotCompanionLearningAlgNode::force_int_person_marker_ [private] |
Definition at line 91 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::Marker ForceRobotCompanionLearningAlgNode::force_int_robot_marker_ [private] |
Definition at line 91 of file force_robot_companion_learning_alg_node.h.
string ForceRobotCompanionLearningAlgNode::force_map_path_ [private] |
Definition at line 144 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::Marker ForceRobotCompanionLearningAlgNode::force_marker_ [private] |
Definition at line 91 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::Marker ForceRobotCompanionLearningAlgNode::force_obstacle_laser_marker_ [private] |
Definition at line 91 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::Marker ForceRobotCompanionLearningAlgNode::force_obstacle_map_marker_ [private] |
Definition at line 91 of file force_robot_companion_learning_alg_node.h.
geometry_msgs::PointStamped ForceRobotCompanionLearningAlgNode::force_param_msg_ [private] |
Definition at line 76 of file force_robot_companion_learning_alg_node.h.
Definition at line 75 of file force_robot_companion_learning_alg_node.h.
Definition at line 79 of file force_robot_companion_learning_alg_node.h.
CMutex ForceRobotCompanionLearningAlgNode::laser_mutex_ [private] |
Definition at line 104 of file force_robot_companion_learning_alg_node.h.
double ForceRobotCompanionLearningAlgNode::laser_radi_ [private] |
Definition at line 145 of file force_robot_companion_learning_alg_node.h.
Definition at line 103 of file force_robot_companion_learning_alg_node.h.
Definition at line 156 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::MarkerArray ForceRobotCompanionLearningAlgNode::MarkerArray_destinations_msg_ [private] |
Definition at line 82 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::MarkerArray ForceRobotCompanionLearningAlgNode::MarkerArray_forces_msg_ [private] |
Definition at line 80 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::MarkerArray ForceRobotCompanionLearningAlgNode::MarkerArray_predictions_msg_ [private] |
Definition at line 84 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::MarkerArray ForceRobotCompanionLearningAlgNode::MarkerArray_trajectories_msg_ [private] |
Definition at line 78 of file force_robot_companion_learning_alg_node.h.
int ForceRobotCompanionLearningAlgNode::nearest_target_ [private] |
Definition at line 143 of file force_robot_companion_learning_alg_node.h.
Definition at line 136 of file force_robot_companion_learning_alg_node.h.
int ForceRobotCompanionLearningAlgNode::num_experiment_ [private] |
Definition at line 149 of file force_robot_companion_learning_alg_node.h.
Definition at line 149 of file force_robot_companion_learning_alg_node.h.
double ForceRobotCompanionLearningAlgNode::param_f1_ [private] |
Definition at line 139 of file force_robot_companion_learning_alg_node.h.
double ForceRobotCompanionLearningAlgNode::param_f2_ [private] |
Definition at line 139 of file force_robot_companion_learning_alg_node.h.
double ForceRobotCompanionLearningAlgNode::param_f3_ [private] |
Definition at line 139 of file force_robot_companion_learning_alg_node.h.
Definition at line 70 of file force_robot_companion_learning_alg_node.h.
Definition at line 69 of file force_robot_companion_learning_alg_node.h.
Cforce_reactive_robot_companion_learning ForceRobotCompanionLearningAlgNode::pred_ [private] |
Definition at line 129 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::Marker ForceRobotCompanionLearningAlgNode::pred_marker_ [private] |
Definition at line 89 of file force_robot_companion_learning_alg_node.h.
Definition at line 83 of file force_robot_companion_learning_alg_node.h.
std::vector<int> ForceRobotCompanionLearningAlgNode::prev_buttons_ [private] |
Definition at line 140 of file force_robot_companion_learning_alg_node.h.
Definition at line 116 of file force_robot_companion_learning_alg_node.h.
std_srvs::Empty ForceRobotCompanionLearningAlgNode::reset_srv_ [private] |
Definition at line 117 of file force_robot_companion_learning_alg_node.h.
Definition at line 151 of file force_robot_companion_learning_alg_node.h.
string ForceRobotCompanionLearningAlgNode::results_folder_ [private] |
Definition at line 152 of file force_robot_companion_learning_alg_node.h.
SpointV_cov ForceRobotCompanionLearningAlgNode::robot_desired_position_ [private] |
Definition at line 134 of file force_robot_companion_learning_alg_node.h.
std::string ForceRobotCompanionLearningAlgNode::robot_frame_ [private] |
Definition at line 130 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::Marker ForceRobotCompanionLearningAlgNode::robot_marker_ [private] |
Definition at line 86 of file force_robot_companion_learning_alg_node.h.
geometry_msgs::PoseStamped ForceRobotCompanionLearningAlgNode::robot_position_msg_ [private] |
Definition at line 74 of file force_robot_companion_learning_alg_node.h.
Definition at line 73 of file force_robot_companion_learning_alg_node.h.
double ForceRobotCompanionLearningAlgNode::robot_x_ini_ [private] |
Definition at line 153 of file force_robot_companion_learning_alg_node.h.
double ForceRobotCompanionLearningAlgNode::robot_y_ini_ [private] |
Definition at line 153 of file force_robot_companion_learning_alg_node.h.
Definition at line 148 of file force_robot_companion_learning_alg_node.h.
SpointV_cov ForceRobotCompanionLearningAlgNode::target_followed_pose_ [private] |
Definition at line 134 of file force_robot_companion_learning_alg_node.h.
std::string ForceRobotCompanionLearningAlgNode::target_frame_ [private] |
Definition at line 130 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::Marker ForceRobotCompanionLearningAlgNode::target_marker_ [private] |
Definition at line 87 of file force_robot_companion_learning_alg_node.h.
geometry_msgs::PointStamped ForceRobotCompanionLearningAlgNode::target_person_position_msg_ [private] |
Definition at line 72 of file force_robot_companion_learning_alg_node.h.
Definition at line 71 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::Marker ForceRobotCompanionLearningAlgNode::text_marker_ [private] |
Definition at line 90 of file force_robot_companion_learning_alg_node.h.
Definition at line 131 of file force_robot_companion_learning_alg_node.h.
int ForceRobotCompanionLearningAlgNode::timer_ [private] |
Definition at line 149 of file force_robot_companion_learning_alg_node.h.
CMutex ForceRobotCompanionLearningAlgNode::tracks_mutex_ [private] |
Definition at line 110 of file force_robot_companion_learning_alg_node.h.
Definition at line 108 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::Marker ForceRobotCompanionLearningAlgNode::traj_marker_ [private] |
Definition at line 86 of file force_robot_companion_learning_alg_node.h.
visualization_msgs::Marker ForceRobotCompanionLearningAlgNode::traj_robot_marker_ [private] |
Definition at line 86 of file force_robot_companion_learning_alg_node.h.
Definition at line 77 of file force_robot_companion_learning_alg_node.h.
Definition at line 138 of file force_robot_companion_learning_alg_node.h.