Classes | |
| struct | BoxInfo |
| struct | CollisionPoint |
| struct | CollisionPointOrder |
| struct | StampedCMap |
Public Member Functions | |
| CollisionMapperOcc (void) | |
| void | run (void) |
| ~CollisionMapperOcc (void) | |
Private Types | |
| typedef std::set < CollisionPoint, CollisionPointOrder > | CMap |
Private Member Functions | |
| void | cloudCallback (const sensor_msgs::PointCloudConstPtr &cloud, const std::string topic_name) |
| void | cloudIncrementalCallback (const sensor_msgs::PointCloudConstPtr &cloud) |
| void | composeMapUnion (std::map< std::string, std::list< StampedCMap * > > &maps, CMap &uni) |
| void | constructCollisionMap (const sensor_msgs::PointCloud &cloud, CMap &map) |
| bool | getCloudSettings (collision_environment_msgs::GetCloudSettings::Request &req, collision_environment_msgs::GetCloudSettings::Response &res) |
| void | makeStaticCollisionMap (const collision_environment_msgs::MakeStaticCollisionMapGoalConstPtr &goal) |
| void | publishCollisionMap (const CMap &map, const std::string &frame_id, const ros::Time &stamp, ros::Publisher &pub) const |
| bool | reset (std_srvs::Empty::Request &req, std_srvs::Empty::Response &res) |
| bool | setCloudSettings (collision_environment_msgs::SetCloudSettings::Request &req, collision_environment_msgs::SetCloudSettings::Response &res) |
| void | subsampleCloudPoints (const sensor_msgs::PointCloud &msg, sensor_msgs::PointCloud &myMsg, int subsampleNum) |
| bool | transformMap (CMap &map, const std::string &from_frame_id, const ros::Time &from_stamp, const std::string &to_frame_id, const ros::Time &to_stamp) |
| void | updateBuffer (std::list< StampedCMap * > &buffer, const unsigned int buffer_size, const ros::Duration buffer_duration, const std::string sensor_frame) |
| void | updateMap (CMap *currentMap, CMap &obstacles, std::string &frame_id, ros::Time &stamp, std::string to_frame_id, std::string cloud_name) |
Private Attributes | |
| boost::shared_ptr < actionlib::SimpleActionServer < collision_environment_msgs::MakeStaticCollisionMapAction > > | action_server_ |
| BoxInfo | bi_ |
| int | cloud_count_ |
| std::map< std::string, CloudInfo > | cloud_source_map_ |
| ros::Publisher | cmapPublisher_ |
| ros::Publisher | cmapUpdPublisher_ |
| std::map< std::string, std::list< StampedCMap * > > | currentMaps_ |
| bool | disregard_first_message_ |
| std::string | fixedFrame_ |
| ros::ServiceServer | get_settings_server_ |
| bool | making_static_collision_map_ |
| boost::recursive_mutex | mapProcessing_ |
| std::vector< tf::MessageFilter < sensor_msgs::PointCloud > * > | mn_cloud_tf_fil_vector_ |
| std::vector < message_filters::Subscriber < sensor_msgs::PointCloud > * > | mn_cloud_tf_sub_vector_ |
| std::map< std::string, ros::Publisher > | occPublisherMap_ |
| bool | publish_over_dynamic_map_ |
| bool | publishOcclusion_ |
| ros::ServiceServer | resetService_ |
| std::string | robotFrame_ |
| ros::NodeHandle | root_handle_ |
| ros::ServiceServer | set_settings_server_ |
| collision_environment_msgs::MakeStaticCollisionMapGoal * | static_map_goal_ |
| std::map< std::string, bool > | static_map_published_ |
| ros::Publisher | static_map_publisher_ |
| std::map< std::string, StampedCMap * > | tempMaps_ |
| tf::TransformListener | tf_ |
Definition at line 87 of file collision_map_self_occ.cpp.
typedef std::set<CollisionPoint, CollisionPointOrder> CollisionMapperOcc::CMap [private] |
Definition at line 307 of file collision_map_self_occ.cpp.
| CollisionMapperOcc::CollisionMapperOcc | ( | void | ) | [inline] |
Definition at line 91 of file collision_map_self_occ.cpp.
| CollisionMapperOcc::~CollisionMapperOcc | ( | void | ) | [inline] |
Definition at line 244 of file collision_map_self_occ.cpp.
| void CollisionMapperOcc::cloudCallback | ( | const sensor_msgs::PointCloudConstPtr & | cloud, | |
| const std::string | topic_name | |||
| ) | [inline, private] |
Definition at line 542 of file collision_map_self_occ.cpp.
| void CollisionMapperOcc::cloudIncrementalCallback | ( | const sensor_msgs::PointCloudConstPtr & | cloud | ) | [inline, private] |
Definition at line 439 of file collision_map_self_occ.cpp.
| void CollisionMapperOcc::composeMapUnion | ( | std::map< std::string, std::list< StampedCMap * > > & | maps, | |
| CMap & | uni | |||
| ) | [inline, private] |
Definition at line 525 of file collision_map_self_occ.cpp.
| void CollisionMapperOcc::constructCollisionMap | ( | const sensor_msgs::PointCloud & | cloud, | |
| CMap & | map | |||
| ) | [inline, private] |
Construct an axis-aligned collision map from a point cloud assumed to be in the robot frame
Definition at line 853 of file collision_map_self_occ.cpp.
| bool CollisionMapperOcc::getCloudSettings | ( | collision_environment_msgs::GetCloudSettings::Request & | req, | |
| collision_environment_msgs::GetCloudSettings::Response & | res | |||
| ) | [inline, private] |
Definition at line 329 of file collision_map_self_occ.cpp.
| void CollisionMapperOcc::makeStaticCollisionMap | ( | const collision_environment_msgs::MakeStaticCollisionMapGoalConstPtr & | goal | ) | [inline, private] |
Definition at line 898 of file collision_map_self_occ.cpp.
| void CollisionMapperOcc::publishCollisionMap | ( | const CMap & | map, | |
| const std::string & | frame_id, | |||
| const ros::Time & | stamp, | |||
| ros::Publisher & | pub | |||
| ) | const [inline, private] |
Definition at line 871 of file collision_map_self_occ.cpp.
| bool CollisionMapperOcc::reset | ( | std_srvs::Empty::Request & | req, | |
| std_srvs::Empty::Response & | res | |||
| ) | [inline, private] |
Definition at line 750 of file collision_map_self_occ.cpp.
| void CollisionMapperOcc::run | ( | void | ) | [inline] |
Definition at line 272 of file collision_map_self_occ.cpp.
| bool CollisionMapperOcc::setCloudSettings | ( | collision_environment_msgs::SetCloudSettings::Request & | req, | |
| collision_environment_msgs::SetCloudSettings::Response & | res | |||
| ) | [inline, private] |
Definition at line 352 of file collision_map_self_occ.cpp.
| void CollisionMapperOcc::subsampleCloudPoints | ( | const sensor_msgs::PointCloud & | msg, | |
| sensor_msgs::PointCloud & | myMsg, | |||
| int | subsampleNum | |||
| ) | [inline, private] |
Definition at line 475 of file collision_map_self_occ.cpp.
| bool CollisionMapperOcc::transformMap | ( | CMap & | map, | |
| const std::string & | from_frame_id, | |||
| const ros::Time & | from_stamp, | |||
| const std::string & | to_frame_id, | |||
| const ros::Time & | to_stamp | |||
| ) | [inline, private] |
Definition at line 779 of file collision_map_self_occ.cpp.
| void CollisionMapperOcc::updateBuffer | ( | std::list< StampedCMap * > & | buffer, | |
| const unsigned int | buffer_size, | |||
| const ros::Duration | buffer_duration, | |||
| const std::string | sensor_frame | |||
| ) | [inline, private] |
Definition at line 488 of file collision_map_self_occ.cpp.
| void CollisionMapperOcc::updateMap | ( | CMap * | currentMap, | |
| CMap & | obstacles, | |||
| std::string & | frame_id, | |||
| ros::Time & | stamp, | |||
| std::string | to_frame_id, | |||
| std::string | cloud_name | |||
| ) | [inline, private] |
Definition at line 672 of file collision_map_self_occ.cpp.
boost::shared_ptr<actionlib::SimpleActionServer<collision_environment_msgs::MakeStaticCollisionMapAction> > CollisionMapperOcc::action_server_ [private] |
Definition at line 988 of file collision_map_self_occ.cpp.
BoxInfo CollisionMapperOcc::bi_ [private] |
Definition at line 982 of file collision_map_self_occ.cpp.
int CollisionMapperOcc::cloud_count_ [private] |
Definition at line 976 of file collision_map_self_occ.cpp.
std::map<std::string,CloudInfo> CollisionMapperOcc::cloud_source_map_ [private] |
Definition at line 986 of file collision_map_self_occ.cpp.
ros::Publisher CollisionMapperOcc::cmapPublisher_ [private] |
Definition at line 965 of file collision_map_self_occ.cpp.
ros::Publisher CollisionMapperOcc::cmapUpdPublisher_ [private] |
Definition at line 966 of file collision_map_self_occ.cpp.
std::map<std::string, std::list<StampedCMap*> > CollisionMapperOcc::currentMaps_ [private] |
Definition at line 979 of file collision_map_self_occ.cpp.
bool CollisionMapperOcc::disregard_first_message_ [private] |
Definition at line 975 of file collision_map_self_occ.cpp.
std::string CollisionMapperOcc::fixedFrame_ [private] |
Definition at line 983 of file collision_map_self_occ.cpp.
ros::ServiceServer CollisionMapperOcc::get_settings_server_ [private] |
Definition at line 990 of file collision_map_self_occ.cpp.
bool CollisionMapperOcc::making_static_collision_map_ [private] |
Definition at line 973 of file collision_map_self_occ.cpp.
boost::recursive_mutex CollisionMapperOcc::mapProcessing_ [private] |
Definition at line 956 of file collision_map_self_occ.cpp.
std::vector<tf::MessageFilter<sensor_msgs::PointCloud>* > CollisionMapperOcc::mn_cloud_tf_fil_vector_ [private] |
Definition at line 962 of file collision_map_self_occ.cpp.
std::vector<message_filters::Subscriber<sensor_msgs::PointCloud>* > CollisionMapperOcc::mn_cloud_tf_sub_vector_ [private] |
Definition at line 961 of file collision_map_self_occ.cpp.
std::map<std::string, ros::Publisher> CollisionMapperOcc::occPublisherMap_ [private] |
Definition at line 968 of file collision_map_self_occ.cpp.
bool CollisionMapperOcc::publish_over_dynamic_map_ [private] |
Definition at line 974 of file collision_map_self_occ.cpp.
bool CollisionMapperOcc::publishOcclusion_ [private] |
Definition at line 970 of file collision_map_self_occ.cpp.
ros::ServiceServer CollisionMapperOcc::resetService_ [private] |
Definition at line 969 of file collision_map_self_occ.cpp.
std::string CollisionMapperOcc::robotFrame_ [private] |
Definition at line 984 of file collision_map_self_occ.cpp.
ros::NodeHandle CollisionMapperOcc::root_handle_ [private] |
Definition at line 964 of file collision_map_self_occ.cpp.
ros::ServiceServer CollisionMapperOcc::set_settings_server_ [private] |
Definition at line 991 of file collision_map_self_occ.cpp.
collision_environment_msgs::MakeStaticCollisionMapGoal* CollisionMapperOcc::static_map_goal_ [private] |
Definition at line 972 of file collision_map_self_occ.cpp.
std::map<std::string,bool> CollisionMapperOcc::static_map_published_ [private] |
Definition at line 987 of file collision_map_self_occ.cpp.
ros::Publisher CollisionMapperOcc::static_map_publisher_ [private] |
Definition at line 967 of file collision_map_self_occ.cpp.
std::map<std::string, StampedCMap*> CollisionMapperOcc::tempMaps_ [private] |
Definition at line 980 of file collision_map_self_occ.cpp.
tf::TransformListener CollisionMapperOcc::tf_ [private] |
Definition at line 958 of file collision_map_self_occ.cpp.