mirrors/rf2o_laser_odometry
1
0
Fork 0
mirror of https://github.com/MAPIRlab/rf2o_laser_odometry.git synced 2023-04-06 19:28:55 +08:00
Code Issues Packages Projects Releases Wiki Activity

Merge pull request #2 from dronecrew/tf

Browse Source 
TF fixes.
This commit is contained in:
Javier G. Monroy
2017-02-27 09:21:15 +01:00
committed by GitHub
parent d10fe943b7 2c715fd7a8
commit b1f2418c87
2 changed files with 6 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
CMakeLists.txt
View File

@@ -16,7 +16,7 @@ find_package(catkin REQUIRED COMPONENTS
## System dependencies are found with CMake's conventions
find_package(Boost REQUIRED COMPONENTS system)
find_package(cmake_modules REQUIRED)
find_package(Eigen REQUIRED)
find_package(Eigen3 REQUIRED)
find_package(MRPT REQUIRED base obs maps slam)
#include_directories(${MRPT_INCLUDE_DIRS})
#MESSAGE( STATUS "MRPT_INCLUDE_DIRS: " ${MRPT_INCLUDE_DIRS})
@@ -38,7 +38,7 @@ catkin_package(
INCLUDE_DIRS include
LIBRARIES laser_odometry
CATKIN_DEPENDS nav_msgs roscpp sensor_msgs std_msgs tf
DEPENDS system_lib
#DEPENDS system_lib
)
## Specify additional locations of header files

8
src/CLaserOdometry2D.cpp
View File

@@ -80,7 +80,7 @@ void CLaserOdometry2D::Init()
tf::StampedTransform transform;
try
{
tf_listener.lookupTransform("/base_link", last_scan.header.frame_id, ros::Time(0), transform);
tf_listener.lookupTransform(base_frame_id, last_scan.header.frame_id, ros::Time(0), transform);
}
catch (tf::TransformException &ex)
{
@@ -918,7 +918,7 @@ void CLaserOdometry2D::PoseUpdate()
tf::StampedTransform transform;
try
{
tf_listener.lookupTransform(last_scan.header.frame_id, "/base_link", ros::Time(0), transform);
tf_listener.lookupTransform(last_scan.header.frame_id, base_frame_id, ros::Time(0), transform);
}
catch (tf::TransformException &ex)
{
@@ -978,8 +978,8 @@ void CLaserOdometry2D::PoseUpdate()
//---------------------------------------
geometry_msgs::TransformStamped odom_trans;
odom_trans.header.stamp = ros::Time::now();
odom_trans.header.frame_id = odom_frame_id;
odom_trans.child_frame_id = base_frame_id;
odom_trans.header.frame_id = base_frame_id;
odom_trans.child_frame_id = odom_frame_id;
odom_trans.transform.translation.x = robot_pose.x();
odom_trans.transform.translation.y = robot_pose.y();
odom_trans.transform.translation.z = 0.0;