Public Member Functions | |
AmclNode () | |
int | process () |
~AmclNode () | |
Private Member Functions | |
bool | getOdomPose (tf::Stamped< tf::Pose > &pose, double &x, double &y, double &yaw, const ros::Time &t, const std::string &f) |
double | getYaw (tf::Pose &t) |
bool | globalLocalizationCallback (std_srvs::Empty::Request &req, std_srvs::Empty::Response &res) |
void | initialPoseReceived (const geometry_msgs::PoseWithCovarianceStampedConstPtr &msg) |
void | initialPoseReceivedOld (const geometry_msgs::PoseWithCovarianceStampedConstPtr &msg) |
void | laserReceived (const sensor_msgs::LaserScanConstPtr &laser_scan) |
map_t * | requestMap () |
Static Private Member Functions | |
static pf_vector_t | uniformPoseGenerator (void *arg) |
Private Attributes | |
double | a_thresh_ |
std::string | base_frame_id_ |
ros::Duration | cloud_pub_interval |
double | d_thresh_ |
std::map< std::string, int > | frame_to_laser_ |
std::string | global_frame_id_ |
ros::ServiceServer | global_loc_srv_ |
ros::Duration | gui_publish_period |
tf::MessageFilter < geometry_msgs::PoseWithCovarianceStamped > * | initial_pose_filter_ |
message_filters::Subscriber < geometry_msgs::PoseWithCovarianceStamped > * | initial_pose_sub_ |
ros::Subscriber | initial_pose_sub_old_ |
AMCLLaser * | laser_ |
double | laser_max_range_ |
double | laser_min_range_ |
tf::MessageFilter < sensor_msgs::LaserScan > * | laser_scan_filter_ |
message_filters::Subscriber < sensor_msgs::LaserScan > * | laser_scan_sub_ |
std::vector< AMCLLaser * > | lasers_ |
std::vector< bool > | lasers_update_ |
ros::Time | last_cloud_pub_time |
geometry_msgs::PoseWithCovarianceStamped | last_published_pose |
tf::Transform | latest_tf_ |
bool | latest_tf_valid_ |
map_t * | map_ |
char * | mapdata |
ros::NodeHandle | nh_ |
AMCLOdom * | odom_ |
std::string | odom_frame_id_ |
ros::Publisher | particlecloud_pub_ |
pf_t * | pf_ |
double | pf_err_ |
bool | pf_init_ |
boost::mutex | pf_mutex_ |
pf_vector_t | pf_odom_pose_ |
double | pf_z_ |
ros::Publisher | pose_pub_ |
ros::NodeHandle | private_nh_ |
int | resample_count_ |
int | resample_interval_ |
double | resolution |
ros::Time | save_pose_last_time |
ros::Duration | save_pose_period |
bool | sent_first_transform_ |
int | sx |
int | sy |
tf::TransformListener * | tf_ |
tf::TransformBroadcaster * | tfb_ |
ros::Duration | transform_tolerance_ |
Static Private Attributes | |
static std::vector< std::pair < int, int > > | free_space_indices |
Definition at line 93 of file amcl_node.cpp.
AmclNode::AmclNode | ( | ) |
Definition at line 205 of file amcl_node.cpp.
AmclNode::~AmclNode | ( | ) |
Definition at line 416 of file amcl_node.cpp.
bool AmclNode::getOdomPose | ( | tf::Stamped< tf::Pose > & | pose, | |
double & | x, | |||
double & | y, | |||
double & | yaw, | |||
const ros::Time & | t, | |||
const std::string & | f | |||
) | [private] |
Definition at line 432 of file amcl_node.cpp.
double AmclNode::getYaw | ( | tf::Pose & | t | ) | [private] |
Definition at line 894 of file amcl_node.cpp.
bool AmclNode::globalLocalizationCallback | ( | std_srvs::Empty::Request & | req, | |
std_srvs::Empty::Response & | res | |||
) | [private] |
Definition at line 496 of file amcl_node.cpp.
void AmclNode::initialPoseReceived | ( | const geometry_msgs::PoseWithCovarianceStampedConstPtr & | msg | ) | [private] |
Definition at line 914 of file amcl_node.cpp.
void AmclNode::initialPoseReceivedOld | ( | const geometry_msgs::PoseWithCovarianceStampedConstPtr & | msg | ) | [private] |
Definition at line 903 of file amcl_node.cpp.
void AmclNode::laserReceived | ( | const sensor_msgs::LaserScanConstPtr & | laser_scan | ) | [private] |
Definition at line 510 of file amcl_node.cpp.
int AmclNode::process | ( | ) |
map_t * AmclNode::requestMap | ( | ) | [private] |
Definition at line 375 of file amcl_node.cpp.
pf_vector_t AmclNode::uniformPoseGenerator | ( | void * | arg | ) | [static, private] |
Definition at line 458 of file amcl_node.cpp.
double AmclNode::a_thresh_ [private] |
Definition at line 156 of file amcl_node.cpp.
std::string AmclNode::base_frame_id_ [private] |
Definition at line 128 of file amcl_node.cpp.
ros::Duration AmclNode::cloud_pub_interval [private] |
Definition at line 165 of file amcl_node.cpp.
double AmclNode::d_thresh_ [private] |
Definition at line 156 of file amcl_node.cpp.
std::map< std::string, int > AmclNode::frame_to_laser_ [private] |
Definition at line 148 of file amcl_node.cpp.
std::vector< std::pair< int, int > > AmclNode::free_space_indices [static, private] |
Definition at line 114 of file amcl_node.cpp.
std::string AmclNode::global_frame_id_ [private] |
Definition at line 129 of file amcl_node.cpp.
ros::ServiceServer AmclNode::global_loc_srv_ [private] |
Definition at line 183 of file amcl_node.cpp.
ros::Duration AmclNode::gui_publish_period [private] |
Definition at line 131 of file amcl_node.cpp.
tf::MessageFilter<geometry_msgs::PoseWithCovarianceStamped>* AmclNode::initial_pose_filter_ [private] |
Definition at line 145 of file amcl_node.cpp.
message_filters::Subscriber<geometry_msgs::PoseWithCovarianceStamped>* AmclNode::initial_pose_sub_ [private] |
Definition at line 144 of file amcl_node.cpp.
ros::Subscriber AmclNode::initial_pose_sub_old_ [private] |
Definition at line 184 of file amcl_node.cpp.
AMCLLaser* AmclNode::laser_ [private] |
Definition at line 163 of file amcl_node.cpp.
double AmclNode::laser_max_range_ [private] |
Definition at line 160 of file amcl_node.cpp.
double AmclNode::laser_min_range_ [private] |
Definition at line 159 of file amcl_node.cpp.
tf::MessageFilter<sensor_msgs::LaserScan>* AmclNode::laser_scan_filter_ [private] |
Definition at line 143 of file amcl_node.cpp.
message_filters::Subscriber<sensor_msgs::LaserScan>* AmclNode::laser_scan_sub_ [private] |
Definition at line 142 of file amcl_node.cpp.
std::vector< AMCLLaser* > AmclNode::lasers_ [private] |
Definition at line 146 of file amcl_node.cpp.
std::vector< bool > AmclNode::lasers_update_ [private] |
Definition at line 147 of file amcl_node.cpp.
ros::Time AmclNode::last_cloud_pub_time [private] |
Definition at line 166 of file amcl_node.cpp.
geometry_msgs::PoseWithCovarianceStamped AmclNode::last_published_pose [private] |
Definition at line 135 of file amcl_node.cpp.
tf::Transform AmclNode::latest_tf_ [private] |
Definition at line 107 of file amcl_node.cpp.
bool AmclNode::latest_tf_valid_ [private] |
Definition at line 108 of file amcl_node.cpp.
map_t* AmclNode::map_ [private] |
Definition at line 137 of file amcl_node.cpp.
char* AmclNode::mapdata [private] |
Definition at line 138 of file amcl_node.cpp.
ros::NodeHandle AmclNode::nh_ [private] |
Definition at line 179 of file amcl_node.cpp.
AMCLOdom* AmclNode::odom_ [private] |
Definition at line 162 of file amcl_node.cpp.
std::string AmclNode::odom_frame_id_ [private] |
Definition at line 126 of file amcl_node.cpp.
ros::Publisher AmclNode::particlecloud_pub_ [private] |
Definition at line 182 of file amcl_node.cpp.
pf_t* AmclNode::pf_ [private] |
Definition at line 151 of file amcl_node.cpp.
double AmclNode::pf_err_ [private] |
Definition at line 153 of file amcl_node.cpp.
bool AmclNode::pf_init_ [private] |
Definition at line 154 of file amcl_node.cpp.
boost::mutex AmclNode::pf_mutex_ [private] |
Definition at line 152 of file amcl_node.cpp.
pf_vector_t AmclNode::pf_odom_pose_ [private] |
Definition at line 155 of file amcl_node.cpp.
double AmclNode::pf_z_ [private] |
Definition at line 153 of file amcl_node.cpp.
ros::Publisher AmclNode::pose_pub_ [private] |
Definition at line 181 of file amcl_node.cpp.
ros::NodeHandle AmclNode::private_nh_ [private] |
Definition at line 180 of file amcl_node.cpp.
int AmclNode::resample_count_ [private] |
Definition at line 158 of file amcl_node.cpp.
int AmclNode::resample_interval_ [private] |
Definition at line 157 of file amcl_node.cpp.
double AmclNode::resolution [private] |
Definition at line 140 of file amcl_node.cpp.
ros::Time AmclNode::save_pose_last_time [private] |
Definition at line 132 of file amcl_node.cpp.
ros::Duration AmclNode::save_pose_period [private] |
Definition at line 133 of file amcl_node.cpp.
bool AmclNode::sent_first_transform_ [private] |
Definition at line 105 of file amcl_node.cpp.
int AmclNode::sx [private] |
Definition at line 139 of file amcl_node.cpp.
int AmclNode::sy [private] |
Definition at line 139 of file amcl_node.cpp.
tf::TransformListener* AmclNode::tf_ [private] |
Definition at line 103 of file amcl_node.cpp.
tf::TransformBroadcaster* AmclNode::tfb_ [private] |
Definition at line 102 of file amcl_node.cpp.
ros::Duration AmclNode::transform_tolerance_ [private] |
Definition at line 177 of file amcl_node.cpp.