i/rtabmap_ros
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap_ros.git synced 2026-10-05 01:07:49 +08:00
Code Issues Packages Projects Releases Wiki Activity

Fixed #1186

Browse Source
This commit is contained in:
matlabbe
2024-07-21 16:20:34 -07:00
parent 680fe729c5
commit a97efff760
2 changed files with 111 additions and 113 deletions
Download Patch File Download Diff File Expand all files Collapse all files
.devcontainer/devcontainer.json
+2 -1
View File
@@ -7,5 +7,6 @@
}, },
"workspaceMount": "source=${localWorkspaceFolder},target=/catkin_ws/src/rtabmap_ros,type=bind", "workspaceMount": "source=${localWorkspaceFolder},target=/catkin_ws/src/rtabmap_ros,type=bind",
"workspaceFolder": "/catkin_ws", "workspaceFolder": "/catkin_ws",
"postAttachCommand": "echo 'Initialize catkin: source /opt/ros/noetic/setup.bash && cd /catkin_ws/src && catkin_init_workspace && cd /catkin_ws && catkin_make'" "postAttachCommand": "echo 'Initialize catkin: source /opt/ros/noetic/setup.bash && cd /catkin_ws/src && catkin_init_workspace && cd /catkin_ws && catkin_make'",
"runArgs": ["--privileged"]
} }
rtabmap_odom/src/OdometryROS.cpp
+1 -4
View File
@@ -932,8 +932,6 @@ void OdometryROS::processData(SensorData & data, const std_msgs::Header & header
} }
} }
if(!data.imageRaw().empty() || !data.laserScanRaw().isEmpty())
{
if(odomSensorDataPub_.getNumSubscribers() || odomSensorDataFeaturesPub_.getNumSubscribers()) if(odomSensorDataPub_.getNumSubscribers() || odomSensorDataFeaturesPub_.getNumSubscribers())
{ {
rtabmap_msgs::SensorData msg; rtabmap_msgs::SensorData msg;
@@ -1039,7 +1037,7 @@ void OdometryROS::processData(SensorData & data, const std_msgs::Header & header
} }
statusDiagnostic_.setStatus(pose.isNull()); statusDiagnostic_.setStatus(pose.isNull());
if(syncDiagnostic_.get() && !pose.isNull()) if(syncDiagnostic_.get())
{ {
double curentRate = 1.0/(ros::WallTime::now()-time).toSec(); double curentRate = 1.0/(ros::WallTime::now()-time).toSec();
syncDiagnostic_->tick(header.stamp, syncDiagnostic_->tick(header.stamp,
@@ -1049,7 +1047,6 @@ void OdometryROS::processData(SensorData & data, const std_msgs::Header & header
} }
previousStamp_ = header.stamp.toSec(); previousStamp_ = header.stamp.toSec();
}
} }
bool OdometryROS::reset(std_srvs::Empty::Request&, std_srvs::Empty::Response&) bool OdometryROS::reset(std_srvs::Empty::Request&, std_srvs::Empty::Response&)