31 #include <tf/transform_broadcaster.h>
32 #include <tf/transform_listener.h>
34 #include <ar_pose/ARMarkers.h>
35 #include <ar_pose/ARMarker.h>
38 #include "std_msgs/String.h"
44 #include "leader_follower/TrajectoryObservation.h"
65 double dist2 = ((x1-x2)*(x1-x2))+((y1-y2)*(y1-y2));
114 #endif // HUMAN_PROC_H
tf::TransformListener listener
void ar_pose_callback(const ar_pose::ARMarkers::ConstPtr &)
ros::Duration duration_since_detection
ar_pose::ARMarkers ar_pose_msg
ros::NodeHandle * local_n
std::vector< ar_pose_reader * > readers
std::vector< double > vec_theta
ros::Publisher trajectory_pub
double euclidean_dist(double x1, double y1, double x2, double y2)
std::vector< double > vec_y
std::vector< double > vec_x
ros::Subscriber ar_pose_sub
social_filter::humanPose getPose()
geometry_msgs::PoseStamped target_pose
geometry_msgs::PoseStamped source_pose
trajectory_simulator::TrajectoryObservation ghmm_wrapper
void manage_list(int marker_id)
ar_management markers_list[10]
ar_pose_reader(std_msgs::String topic_name, ros::NodeHandle *n)