Planar scan generator. More...
#include <stdio.h>
#include <ros/ros.h>
#include <laser_geometry/laser_geometry.h>
#include <sensor_msgs/LaserScan.h>
#include <sensor_msgs/PointCloud2.h>
#include <tf/transform_listener.h>
#include <pcl_ros/transforms.h>
#include <pcl/ros/conversions.h>
#include <pcl/point_cloud.h>
#include <pcl/point_types.h>
#include <pcl/segmentation/extract_polygonal_prism_data.h>
#include <pcl/filters/extract_indices.h>
#include <pcl/filters/project_inliers.h>
#include <visualization_msgs/Marker.h>
#include <visualization_msgs/MarkerArray.h>
#include <mtt/TargetListPC.h>
#include <atlascar_base/AtlascarCommand.h>
#include <sound_play/sound_play.h>
#include <ros/package.h>
Go to the source code of this file.
Planar scan generator.
Definition in file follow_pedestrian.h.
#define _SAFE_ZONE_X_MAX_ 4 |
Definition at line 74 of file follow_pedestrian.h.
#define _SAFE_ZONE_X_MIN_ 3.5 |
Definition at line 75 of file follow_pedestrian.h.
#define _SAFE_ZONE_Y_MAX_ 0.5 |
Definition at line 76 of file follow_pedestrian.h.
#define _SAFE_ZONE_Y_MIN_ -0.5 |
Definition at line 77 of file follow_pedestrian.h.
#define _SEARCH_RADIUS_ 0.3 |
Definition at line 80 of file follow_pedestrian.h.
#define _SEARCH_X_ 6 |
Definition at line 78 of file follow_pedestrian.h.
#define _SEARCH_Y_ 0 |
Definition at line 79 of file follow_pedestrian.h.
#define _USE_DEBUG_ 1 |
Definition at line 65 of file follow_pedestrian.h.
#define DIRECTION_IN_FRONT 0 |
Definition at line 70 of file follow_pedestrian.h.
#define LIGHT_OFF 0 |
Definition at line 66 of file follow_pedestrian.h.
#define LIGHT_ON 1 |
Definition at line 67 of file follow_pedestrian.h.
#define PFLN printf("file %s line %d\n",__FILE__,__LINE__); |
Definition at line 63 of file follow_pedestrian.h.
#define SPEED_MOVE_SLOW 0.1 |
Definition at line 69 of file follow_pedestrian.h.
#define SPEED_STOP 0 |
Definition at line 68 of file follow_pedestrian.h.
enum enum_state |
Definition at line 112 of file follow_pedestrian.h.
enum t_transitions |
SEARCHING_2_TRACKING | |
SEARCHING_2_TRACKING_NOT_SAFE | |
TRACKING_2_TARGET_LOST | |
TRACKING_2_TRACKING_NOT_SAFE | |
TRACKING_NOT_SAFE_2_TRACKING | |
TRACKING_NOT_SAFE_2_TARGET_LOST | |
NONE |
Definition at line 114 of file follow_pedestrian.h.
void add_to_viz_markers_vec | ( | std::vector< visualization_msgs::Marker > * | marker_vec | ) |
bool check_safety_zone | ( | t_targets * | targets, | |
t_safety_zone * | safety_zone | |||
) |
Definition at line 156 of file follow_pedestrian.cpp.
void foveationcontrol | ( | t_status * | status | ) |
Definition at line 270 of file follow_pedestrian.cpp.
void foveationcontrol_home | ( | void | ) |
Definition at line 283 of file follow_pedestrian.cpp.
void foveationcontrol_sweeping | ( | void | ) |
Definition at line 41 of file follow_pedestrian.cpp.
Definition at line 242 of file follow_pedestrian.cpp.
void init_search_area | ( | t_search_area * | area | ) |
Definition at line 262 of file follow_pedestrian.cpp.
bool is_safe_using_lasers | ( | void | ) |
Definition at line 72 of file follow_pedestrian.cpp.
void mtt_targets_cb | ( | const mtt::TargetListPC & | targetlist | ) |
Definition at line 172 of file follow_pedestrian.cpp.
void play_sound | ( | int | sit, | |
int | mandatory, | |||
double | num_h = 5 | |||
) |
Definition at line 95 of file follow_pedestrian.cpp.
void print_status | ( | t_status * | status | ) |
Definition at line 129 of file follow_pedestrian.cpp.
bool search_for_new_target | ( | t_targets * | targets, | |
t_status * | status, | |||
t_search_area * | area | |||
) |
If the object meets all requeriments we put his information on the current target
Definition at line 216 of file follow_pedestrian.cpp.
void set_high_command_msg_direction_speed | ( | atlascar_base::AtlascarCommand & | msg, | |
double | dir, | |||
double | speed | |||
) |
Definition at line 297 of file follow_pedestrian.cpp.
void set_high_command_msg_lights | ( | atlascar_base::AtlascarCommand & | msg, | |
bool | high, | |||
bool | medium, | |||
bool | left, | |||
bool | right, | |||
bool | warning | |||
) |
Definition at line 303 of file follow_pedestrian.cpp.
void sleepok | ( | int | t, | |
ros::NodeHandle & | nh | |||
) |
Definition at line 90 of file follow_pedestrian.cpp.
void state_machine | ( | void | ) |
Draw the
some local variables
Tracking state machine
--------------------------------------------------------------------------- STATE MACHINE ---------------------------------------------------------------------------
---------------------------------------------------------------------------
STATE INITIALIZE
---------------------------------------------------------------------------
--- TIMER UPDATES --- //
--- STATE ACTIONS ---//
--- TRANSITIONS ---//
--- TRANSITION ACTIONS ---//
---------------------------------------------------------------------------
STATE SEARCHING
---------------------------------------------------------------------------
--- TIMER UPDATES --- //
--- STATE ACTIONS ---//
--- TRANSITIONS ---//
--- TRANSITION ACTIONS ---//
--- TRANSITION ACTIONS ---//
---------------------------------------------------------------------------
STATE TRACKING
--------------------------------------------------------------------------- --- TIMER UPDATES --- //
--- STATE ACTIONS ---//
--- TRANSITIONS ---//
--- TRANSITION ACTIONS ---//
--- TRANSITION ACTIONS ---//
--- TRANSITION ACTIONS ---//
---------------------------------------------------------------------------
TRACKING_NOT_SAFE
--------------------------------------------------------------------------- --- TIMER UPDATES --- //
--- STATE ACTIONS ---//
--- TRANSITIONS ---//
--- TRANSITION ACTIONS ---//
--- TRANSITION ACTIONS ---//
--- TRANSITION ACTIONS ---//
---------------------------------------------------------------------------
TARGET_LOST
--------------------------------------------------------------------------- --- TIMER UPDATES --- //
--- STATE ACTIONS ---//
--- TRANSITIONS ---//
---------------------------------------------------------------------------
UNKNOWN STATE
---------------------------------------------------------------------------
Definition at line 40 of file state_machine.cpp.
double a_h |
atlascar_base::AtlascarCommand command_msg |
ros::Publisher command_pub |
tf::TransformListener* p_listener |
ros::NodeHandle* p_n |
ros::Publisher* p_pub_fctlr |
sound_play::SoundClient* p_sc |