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.