Definition at line 48 of file ndt_fuser_node.cpp.
NDTFuserNode::NDTFuserNode | ( | ros::NodeHandle | param_nh | ) | [inline] |
if we want to build map reading scans directly from bagfile
topic to wait for point clouds, if available
topic to wait for laser scan messages, if available
if using the HMT fuser, NDT maps are saved in this directory. a word of warning: if you run multiple times with the same directory, the old maps are loaded automatically
initial pose of the vehicle with respect to the map
pose of the sensor with respect to the vehicle odometry frame
size of the map in x/y/z. if using HMT, this is the size of the central tile
range to cutoff sensor measurements
range to cutoff sensor measurements
visualize in a local window
only mathc with 3dof
use HMT grid or simple grid.
use standard odometry messages for initial guess
topic to wait for laser scan messages, if available
if we want to compare to a ground truth topic
if we want to get the initial pose of the vehicle relative to a different frame
enable for LaserScan message input
Definition at line 93 of file ndt_fuser_node.cpp.
NDTFuserNode::~NDTFuserNode | ( | ) | [inline] |
Definition at line 220 of file ndt_fuser_node.cpp.
void NDTFuserNode::gt_callback | ( | const nav_msgs::Odometry::ConstPtr & | msg_in | ) | [inline] |
Definition at line 421 of file ndt_fuser_node.cpp.
void NDTFuserNode::laserCallback | ( | const sensor_msgs::LaserScan::ConstPtr & | msg_in | ) | [inline] |
Definition at line 340 of file ndt_fuser_node.cpp.
void NDTFuserNode::laserOdomCallback | ( | const sensor_msgs::LaserScan::ConstPtr & | msg_in, |
const nav_msgs::Odometry::ConstPtr & | odo_in | ||
) | [inline] |
Definition at line 367 of file ndt_fuser_node.cpp.
void NDTFuserNode::points2Callback | ( | const sensor_msgs::PointCloud2::ConstPtr & | msg_in | ) | [inline] |
Definition at line 290 of file ndt_fuser_node.cpp.
void NDTFuserNode::points2OdomCallback | ( | const sensor_msgs::PointCloud2::ConstPtr & | msg_in, |
const nav_msgs::Odometry::ConstPtr & | odo_in | ||
) | [inline] |
Definition at line 303 of file ndt_fuser_node.cpp.
void NDTFuserNode::processFrame | ( | pcl::PointCloud< pcl::PointXYZ > & | cloud, |
Eigen::Affine3d | Tmotion | ||
) | [inline] |
Definition at line 225 of file ndt_fuser_node.cpp.
bool NDTFuserNode::publish_map | ( | ) | [inline] |
Definition at line 453 of file ndt_fuser_node.cpp.
bool NDTFuserNode::save_map_callback | ( | std_srvs::Empty::Request & | req, |
std_srvs::Empty::Response & | res | ||
) | [inline] |
Definition at line 277 of file ndt_fuser_node.cpp.
std::string NDTFuserNode::bag_name [protected] |
Definition at line 69 of file ndt_fuser_node.cpp.
bool NDTFuserNode::beHMT [protected] |
Definition at line 72 of file ndt_fuser_node.cpp.
lslgeneric::NDTFuserHMT* NDTFuserNode::fuser [protected] |
Definition at line 68 of file ndt_fuser_node.cpp.
std::string NDTFuserNode::fuser_frame [protected] |
Definition at line 69 of file ndt_fuser_node.cpp.
ros::Subscriber NDTFuserNode::gt_sub [protected] |
Definition at line 57 of file ndt_fuser_node.cpp.
std::string NDTFuserNode::gt_topic [protected] |
Definition at line 69 of file ndt_fuser_node.cpp.
std::string NDTFuserNode::init_pose_frame [protected] |
Definition at line 69 of file ndt_fuser_node.cpp.
bool NDTFuserNode::initPoseFromGT [protected] |
Definition at line 72 of file ndt_fuser_node.cpp.
bool NDTFuserNode::initPoseFromTF [protected] |
Definition at line 72 of file ndt_fuser_node.cpp.
bool NDTFuserNode::initPoseSet [protected] |
Definition at line 72 of file ndt_fuser_node.cpp.
message_filters::Subscriber<sensor_msgs::LaserScan>* NDTFuserNode::laser_sub_ [protected] |
Definition at line 55 of file ndt_fuser_node.cpp.
std::string NDTFuserNode::laser_topic [protected] |
Definition at line 69 of file ndt_fuser_node.cpp.
Eigen::Affine3d NDTFuserNode::last_odom [protected] |
Definition at line 90 of file ndt_fuser_node.cpp.
boost::mutex NDTFuserNode::m [protected] |
Definition at line 67 of file ndt_fuser_node.cpp.
std::string NDTFuserNode::map_dir [protected] |
Definition at line 69 of file ndt_fuser_node.cpp.
std::string NDTFuserNode::map_name [protected] |
Definition at line 69 of file ndt_fuser_node.cpp.
ros::Publisher NDTFuserNode::map_publisher_ [protected] |
Definition at line 88 of file ndt_fuser_node.cpp.
bool NDTFuserNode::match2D [protected] |
Definition at line 72 of file ndt_fuser_node.cpp.
bool NDTFuserNode::matchLaser [protected] |
Definition at line 72 of file ndt_fuser_node.cpp.
boost::mutex NDTFuserNode::message_m [protected] |
Definition at line 67 of file ndt_fuser_node.cpp.
double NDTFuserNode::min_laser_range_ [protected] |
Definition at line 71 of file ndt_fuser_node.cpp.
unsigned int NDTFuserNode::nb_added_clouds_ [protected] |
Definition at line 64 of file ndt_fuser_node.cpp.
ros::NodeHandle NDTFuserNode::nh_ [protected] |
Definition at line 52 of file ndt_fuser_node.cpp.
message_filters::Subscriber<nav_msgs::Odometry>* NDTFuserNode::odom_sub_ [protected] |
Definition at line 56 of file ndt_fuser_node.cpp.
std::string NDTFuserNode::odometry_topic [protected] |
Definition at line 69 of file ndt_fuser_node.cpp.
ros::Publisher NDTFuserNode::output_pub_ [protected] |
Definition at line 61 of file ndt_fuser_node.cpp.
bool NDTFuserNode::plotGTTrack [protected] |
Definition at line 72 of file ndt_fuser_node.cpp.
message_filters::Subscriber<sensor_msgs::PointCloud2>* NDTFuserNode::points2_sub_ [protected] |
Definition at line 54 of file ndt_fuser_node.cpp.
std::string NDTFuserNode::points_topic [protected] |
Definition at line 69 of file ndt_fuser_node.cpp.
Eigen::Affine3d NDTFuserNode::pose_ [protected] |
Definition at line 62 of file ndt_fuser_node.cpp.
double NDTFuserNode::pose_init_p [protected] |
Definition at line 75 of file ndt_fuser_node.cpp.
double NDTFuserNode::pose_init_r [protected] |
Definition at line 75 of file ndt_fuser_node.cpp.
double NDTFuserNode::pose_init_t [protected] |
Definition at line 75 of file ndt_fuser_node.cpp.
double NDTFuserNode::pose_init_x [protected] |
Definition at line 75 of file ndt_fuser_node.cpp.
double NDTFuserNode::pose_init_y [protected] |
Definition at line 75 of file ndt_fuser_node.cpp.
double NDTFuserNode::pose_init_z [protected] |
Definition at line 75 of file ndt_fuser_node.cpp.
Definition at line 79 of file ndt_fuser_node.cpp.
bool NDTFuserNode::renderGTmap [protected] |
Definition at line 72 of file ndt_fuser_node.cpp.
double NDTFuserNode::resolution [protected] |
Definition at line 71 of file ndt_fuser_node.cpp.
ros::ServiceServer NDTFuserNode::save_map_ [protected] |
Definition at line 86 of file ndt_fuser_node.cpp.
Eigen::Affine3d NDTFuserNode::sensor_pose_ [protected] |
Definition at line 62 of file ndt_fuser_node.cpp.
double NDTFuserNode::sensor_pose_p [protected] |
Definition at line 77 of file ndt_fuser_node.cpp.
double NDTFuserNode::sensor_pose_r [protected] |
Definition at line 77 of file ndt_fuser_node.cpp.
double NDTFuserNode::sensor_pose_t [protected] |
Definition at line 77 of file ndt_fuser_node.cpp.
double NDTFuserNode::sensor_pose_x [protected] |
Definition at line 77 of file ndt_fuser_node.cpp.
double NDTFuserNode::sensor_pose_y [protected] |
Definition at line 77 of file ndt_fuser_node.cpp.
double NDTFuserNode::sensor_pose_z [protected] |
Definition at line 77 of file ndt_fuser_node.cpp.
double NDTFuserNode::sensor_range [protected] |
Definition at line 71 of file ndt_fuser_node.cpp.
double NDTFuserNode::size_x [protected] |
Definition at line 71 of file ndt_fuser_node.cpp.
double NDTFuserNode::size_y [protected] |
Definition at line 71 of file ndt_fuser_node.cpp.
double NDTFuserNode::size_z [protected] |
Definition at line 71 of file ndt_fuser_node.cpp.
message_filters::Synchronizer< LaserOdomSync >* NDTFuserNode::sync_lo_ [protected] |
Definition at line 81 of file ndt_fuser_node.cpp.
message_filters::Synchronizer< LaserPoseSync >* NDTFuserNode::sync_lp_ [protected] |
Definition at line 82 of file ndt_fuser_node.cpp.
message_filters::Synchronizer< PointsOdomSync >* NDTFuserNode::sync_po_ [protected] |
Definition at line 84 of file ndt_fuser_node.cpp.
message_filters::Synchronizer< PointsPoseSync >* NDTFuserNode::sync_pp_ [protected] |
Definition at line 85 of file ndt_fuser_node.cpp.
Eigen::Affine3d NDTFuserNode::T [protected] |
Definition at line 62 of file ndt_fuser_node.cpp.
tf::TransformBroadcaster NDTFuserNode::tf_ [protected] |
Definition at line 60 of file ndt_fuser_node.cpp.
Eigen::Affine3d NDTFuserNode::this_odom [protected] |
Definition at line 90 of file ndt_fuser_node.cpp.
bool NDTFuserNode::useOdometry [protected] |
Definition at line 72 of file ndt_fuser_node.cpp.
double NDTFuserNode::varz [protected] |
Definition at line 65 of file ndt_fuser_node.cpp.
bool NDTFuserNode::visualize [protected] |
Definition at line 72 of file ndt_fuser_node.cpp.
std::string NDTFuserNode::world_frame [protected] |
Definition at line 69 of file ndt_fuser_node.cpp.