mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-05 01:07:49 +08:00
Fixed odom_sensor_sync inverted motion transform
This commit is contained in:
@@ -62,7 +62,7 @@ private:
|
||||
void callbackScan(const sensor_msgs::LaserScanConstPtr & msg)
|
||||
{
|
||||
// make sure the frame of the laser is updated during the whole scan time
|
||||
rtabmap::Transform tmpT = rtabmap_conversions::getTransform(
|
||||
rtabmap::Transform tmpT = rtabmap_conversions::getMovingTransform(
|
||||
msg->header.frame_id,
|
||||
fixedFrameId_,
|
||||
msg->header.stamp,
|
||||
|
||||
@@ -289,11 +289,11 @@ private:
|
||||
cloudMsgs[0]->header.stamp != cloudMsgs[i]->header.stamp)
|
||||
{
|
||||
// approx sync
|
||||
cloudDisplacement = rtabmap_conversions::getTransform(
|
||||
cloudDisplacement = rtabmap_conversions::getMovingTransform(
|
||||
frameId, //sourceTargetFrame
|
||||
fixedFrameId_, //fixedFrame
|
||||
cloudMsgs[i]->header.stamp, //stampSource
|
||||
cloudMsgs[0]->header.stamp, //stampTarget
|
||||
cloudMsgs[i]->header.stamp, //stampSource
|
||||
tfListener_,
|
||||
waitForTransformDuration_);
|
||||
}
|
||||
|
||||
@@ -160,11 +160,11 @@ private:
|
||||
if(!fixedFrameId_.empty())
|
||||
{
|
||||
// approx sync
|
||||
cloudDisplacement = rtabmap_conversions::getTransform(
|
||||
cloudDisplacement = rtabmap_conversions::getMovingTransform(
|
||||
pointCloud2Msg->header.frame_id,
|
||||
fixedFrameId_,
|
||||
cameraInfoMsg->header.stamp,
|
||||
pointCloud2Msg->header.stamp,
|
||||
cameraInfoMsg->header.stamp,
|
||||
*listener_,
|
||||
waitForTransform_);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user