scan_tools::LaserScanMatcher Class Reference

#include <laser_scan_matcher.h>

List of all members.

Public Member Functions
	LaserScanMatcher (ros::NodeHandle nh, ros::NodeHandle nh_private)
	~LaserScanMatcher ()
Private Member Functions
void	cloudCallback (const PointCloudT::ConstPtr &cloud)
void	createCache (const sensor_msgs::LaserScan::ConstPtr &scan_msg)
void	createTfFromXYTheta (double x, double y, double theta, tf::Transform &t)
bool	getBaseToLaserTf (const std::string &frame_id)
void	getPrediction (double &pr_ch_x, double &pr_ch_y, double &pr_ch_a, double dt)
double	getYawFromQuaternion (const geometry_msgs::Quaternion &quaternion)
double	getYawFromQuaternion (const tf::Quaternion &quaternion)
void	imuCallback (const sensor_msgs::ImuPtr &imu_msg)
void	initParams ()
void	laserScanToLDP (const sensor_msgs::LaserScan::ConstPtr &scan_msg, LDP &ldp)
void	odomCallback (const nav_msgs::Odometry::ConstPtr &odom_msg)
void	PointCloudToLDP (const PointCloudT::ConstPtr &cloud, LDP &ldp)
void	processScan (LDP &curr_ldp_scan, const ros::Time &time)
void	scanCallback (const sensor_msgs::LaserScan::ConstPtr &scan_msg)
Private Attributes
std::vector< double >	a_cos_
std::vector< double >	a_sin_
double	alpha_
std::string	base_frame_
tf::Transform	base_to_laser_
double	beta_
double	cloud_range_max_
double	cloud_range_min_
ros::Subscriber	cloud_subscriber_
std::string	cloud_topic_
std::string	fixed_frame_
std::string	frameid_
ros::Subscriber	imu_subscriber_
std::string	imu_topic_
bool	initialized_
sm_params	input_
tf::Transform	laser_to_base_
ros::Time	last_icp_time_
double	last_imu_yaw_
nav_msgs::Odometry	last_odom_
double	latest_imu_yaw_
nav_msgs::Odometry	latest_odom_
boost::mutex	mutex_
ros::NodeHandle	nh_
ros::NodeHandle	nh_private_
ros::Subscriber	odom_subscriber_
std::string	odom_topic_
sm_result	output_
geometry_msgs::Pose2D::Ptr	pose2d_msg_
ros::Publisher	pose2d_publisher_
std::string	pose2d_topic_
geometry_msgs::PoseStamped::Ptr	pose_msg_
ros::Publisher	pose_publisher_
std::string	pose_topic_
LDP	prev_ldp_scan_
bool	publish_pose2d_
bool	publish_pose_
bool	publish_tf_
bool	received_imu_
bool	received_odom_
ros::Subscriber	scan_subscriber_
std::string	scan_topic_
ros::Publisher	test_pub_
tf::TransformBroadcaster	tf_broadcaster_
tf::TransformListener	tf_listener_
bool	use_alpha_beta_
bool	use_cloud_input_
bool	use_imu_
bool	use_odom_
double	v_a_
double	v_x_
double	v_y_
ros::Publisher	vel_publisher_
tf::Transform	w2b_

---

Detailed Description

Definition at line 76 of file laser_scan_matcher.h.

---

Constructor & Destructor Documentation

scan_tools::LaserScanMatcher::LaserScanMatcher	(	ros::NodeHandle	nh,
		ros::NodeHandle	nh_private
	)

Definition at line 43 of file laser_scan_matcher.cpp.

scan_tools::LaserScanMatcher::~LaserScanMatcher

(

)

Definition at line 111 of file laser_scan_matcher.cpp.

---

Member Function Documentation

void scan_tools::LaserScanMatcher::cloudCallback

(

const PointCloudT::ConstPtr &

cloud

)

[private]

Definition at line 340 of file laser_scan_matcher.cpp.

void scan_tools::LaserScanMatcher::createCache

(

const sensor_msgs::LaserScan::ConstPtr &

scan_msg

)

[private]

Definition at line 656 of file laser_scan_matcher.cpp.

void scan_tools::LaserScanMatcher::createTfFromXYTheta	(	double	x,
		double	y,
		double	theta,
		tf::Transform &	t
	)		[private]

Definition at line 756 of file laser_scan_matcher.cpp.

bool scan_tools::LaserScanMatcher::getBaseToLaserTf

(

const std::string &

frame_id

)

[private]

Definition at line 672 of file laser_scan_matcher.cpp.

void scan_tools::LaserScanMatcher::getPrediction	(	double &	pr_ch_x,
		double &	pr_ch_y,
		double &	pr_ch_a,
		double	dt
	)		[private]

Definition at line 697 of file laser_scan_matcher.cpp.

double scan_tools::LaserScanMatcher::getYawFromQuaternion

(

const geometry_msgs::Quaternion &

quaternion

)

[private]

Definition at line 748 of file laser_scan_matcher.cpp.

double scan_tools::LaserScanMatcher::getYawFromQuaternion

(

const tf::Quaternion &

quaternion

)

[private]

Definition at line 739 of file laser_scan_matcher.cpp.

void scan_tools::LaserScanMatcher::imuCallback

(

const sensor_msgs::ImuPtr &

imu_msg

)

[private]

Definition at line 318 of file laser_scan_matcher.cpp.

void scan_tools::LaserScanMatcher::initParams

(

)

[private]

Definition at line 116 of file laser_scan_matcher.cpp.

void scan_tools::LaserScanMatcher::laserScanToLDP	(	const sensor_msgs::LaserScan::ConstPtr &	scan_msg,
		LDP &	ldp
	)		[private]

Definition at line 614 of file laser_scan_matcher.cpp.

void scan_tools::LaserScanMatcher::odomCallback

(

const nav_msgs::Odometry::ConstPtr &

odom_msg

)

[private]

Definition at line 329 of file laser_scan_matcher.cpp.

void scan_tools::LaserScanMatcher::PointCloudToLDP	(	const PointCloudT::ConstPtr &	cloud,
		LDP &	ldp
	)		[private]

Definition at line 566 of file laser_scan_matcher.cpp.

void scan_tools::LaserScanMatcher::processScan	(	LDP &	curr_ldp_scan,
		const ros::Time &	time
	)		[private]

Definition at line 392 of file laser_scan_matcher.cpp.

void scan_tools::LaserScanMatcher::scanCallback

(

const sensor_msgs::LaserScan::ConstPtr &

scan_msg

)

[private]

Definition at line 365 of file laser_scan_matcher.cpp.

---

Member Data Documentation

std::vector<double> scan_tools::LaserScanMatcher::a_cos_ [private]

Definition at line 164 of file laser_scan_matcher.h.

std::vector<double> scan_tools::LaserScanMatcher::a_sin_ [private]

Definition at line 165 of file laser_scan_matcher.h.

double scan_tools::LaserScanMatcher::alpha_ [private]

Definition at line 134 of file laser_scan_matcher.h.

std::string scan_tools::LaserScanMatcher::base_frame_ [private]

Definition at line 113 of file laser_scan_matcher.h.

tf::Transform scan_tools::LaserScanMatcher::base_to_laser_ [private]

Definition at line 103 of file laser_scan_matcher.h.

double scan_tools::LaserScanMatcher::beta_ [private]

Definition at line 135 of file laser_scan_matcher.h.

double scan_tools::LaserScanMatcher::cloud_range_max_ [private]

Definition at line 117 of file laser_scan_matcher.h.

double scan_tools::LaserScanMatcher::cloud_range_min_ [private]

Definition at line 116 of file laser_scan_matcher.h.

ros::Subscriber scan_tools::LaserScanMatcher::cloud_subscriber_ [private]

Definition at line 96 of file laser_scan_matcher.h.

std::string scan_tools::LaserScanMatcher::cloud_topic_ [private]

Definition at line 84 of file laser_scan_matcher.h.

std::string scan_tools::LaserScanMatcher::fixed_frame_ [private]

Definition at line 114 of file laser_scan_matcher.h.

std::string scan_tools::LaserScanMatcher::frameid_ [private]

Definition at line 115 of file laser_scan_matcher.h.

ros::Subscriber scan_tools::LaserScanMatcher::imu_subscriber_ [private]

Definition at line 98 of file laser_scan_matcher.h.

std::string scan_tools::LaserScanMatcher::imu_topic_ [private]

Definition at line 86 of file laser_scan_matcher.h.

bool scan_tools::LaserScanMatcher::initialized_ [private]

Definition at line 139 of file laser_scan_matcher.h.

sm_params scan_tools::LaserScanMatcher::input_ [private]

Definition at line 167 of file laser_scan_matcher.h.

tf::Transform scan_tools::LaserScanMatcher::laser_to_base_ [private]

Definition at line 104 of file laser_scan_matcher.h.

ros::Time scan_tools::LaserScanMatcher::last_icp_time_ [private]

Definition at line 156 of file laser_scan_matcher.h.

double scan_tools::LaserScanMatcher::last_imu_yaw_ [private]

Definition at line 159 of file laser_scan_matcher.h.

nav_msgs::Odometry scan_tools::LaserScanMatcher::last_odom_ [private]

Definition at line 162 of file laser_scan_matcher.h.

double scan_tools::LaserScanMatcher::latest_imu_yaw_ [private]

Definition at line 158 of file laser_scan_matcher.h.

nav_msgs::Odometry scan_tools::LaserScanMatcher::latest_odom_ [private]

Definition at line 161 of file laser_scan_matcher.h.

boost::mutex scan_tools::LaserScanMatcher::mutex_ [private]

Definition at line 144 of file laser_scan_matcher.h.

ros::NodeHandle scan_tools::LaserScanMatcher::nh_ [private]

Definition at line 92 of file laser_scan_matcher.h.

ros::NodeHandle scan_tools::LaserScanMatcher::nh_private_ [private]

Definition at line 93 of file laser_scan_matcher.h.

ros::Subscriber scan_tools::LaserScanMatcher::odom_subscriber_ [private]

Definition at line 97 of file laser_scan_matcher.h.

std::string scan_tools::LaserScanMatcher::odom_topic_ [private]

Definition at line 85 of file laser_scan_matcher.h.

sm_result scan_tools::LaserScanMatcher::output_ [private]

Definition at line 168 of file laser_scan_matcher.h.

geometry_msgs::Pose2D::Ptr scan_tools::LaserScanMatcher::pose2d_msg_ [private]

Definition at line 146 of file laser_scan_matcher.h.

ros::Publisher scan_tools::LaserScanMatcher::pose2d_publisher_ [private]

Definition at line 108 of file laser_scan_matcher.h.

std::string scan_tools::LaserScanMatcher::pose2d_topic_ [private]

Definition at line 89 of file laser_scan_matcher.h.

geometry_msgs::PoseStamped::Ptr scan_tools::LaserScanMatcher::pose_msg_ [private]

Definition at line 147 of file laser_scan_matcher.h.

ros::Publisher scan_tools::LaserScanMatcher::pose_publisher_ [private]

Definition at line 107 of file laser_scan_matcher.h.

std::string scan_tools::LaserScanMatcher::pose_topic_ [private]

Definition at line 90 of file laser_scan_matcher.h.

LDP scan_tools::LaserScanMatcher::prev_ldp_scan_ [private]

Definition at line 169 of file laser_scan_matcher.h.

bool scan_tools::LaserScanMatcher::publish_pose2d_ [private]

Definition at line 119 of file laser_scan_matcher.h.

bool scan_tools::LaserScanMatcher::publish_pose_ [private]

Definition at line 120 of file laser_scan_matcher.h.

bool scan_tools::LaserScanMatcher::publish_tf_ [private]

Definition at line 118 of file laser_scan_matcher.h.

bool scan_tools::LaserScanMatcher::received_imu_ [private]

Definition at line 141 of file laser_scan_matcher.h.

bool scan_tools::LaserScanMatcher::received_odom_ [private]

Definition at line 142 of file laser_scan_matcher.h.

ros::Subscriber scan_tools::LaserScanMatcher::scan_subscriber_ [private]

Definition at line 95 of file laser_scan_matcher.h.

std::string scan_tools::LaserScanMatcher::scan_topic_ [private]

Definition at line 83 of file laser_scan_matcher.h.

ros::Publisher scan_tools::LaserScanMatcher::test_pub_ [private]

Definition at line 106 of file laser_scan_matcher.h.

tf::TransformBroadcaster scan_tools::LaserScanMatcher::tf_broadcaster_ [private]

Definition at line 101 of file laser_scan_matcher.h.

tf::TransformListener scan_tools::LaserScanMatcher::tf_listener_ [private]

Definition at line 100 of file laser_scan_matcher.h.

bool scan_tools::LaserScanMatcher::use_alpha_beta_ [private]

Definition at line 132 of file laser_scan_matcher.h.

bool scan_tools::LaserScanMatcher::use_cloud_input_ [private]

Definition at line 122 of file laser_scan_matcher.h.

bool scan_tools::LaserScanMatcher::use_imu_ [private]

Definition at line 130 of file laser_scan_matcher.h.

bool scan_tools::LaserScanMatcher::use_odom_ [private]

Definition at line 131 of file laser_scan_matcher.h.

double scan_tools::LaserScanMatcher::v_a_ [private]

Definition at line 154 of file laser_scan_matcher.h.

double scan_tools::LaserScanMatcher::v_x_ [private]

Definition at line 152 of file laser_scan_matcher.h.

double scan_tools::LaserScanMatcher::v_y_ [private]

Definition at line 153 of file laser_scan_matcher.h.

ros::Publisher scan_tools::LaserScanMatcher::vel_publisher_ [private]

Definition at line 109 of file laser_scan_matcher.h.

tf::Transform scan_tools::LaserScanMatcher::w2b_ [private]

Definition at line 150 of file laser_scan_matcher.h.

---

The documentation for this class was generated from the following files:

• laser_scan_matcher.h
• laser_scan_matcher.cpp