i/rtabmap_ros
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap_ros.git synced 2026-10-04 16:57:46 +08:00
Code Issues Packages Projects Releases Wiki Activity

Fixed imus ignored (bug previous commit)

Browse Source
This commit is contained in:
matlabbe
2025-09-07 20:06:13 -07:00
parent 0ad034680b
commit f64fb02eab
1 changed files with 3 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
rtabmap_odom/src/OdometryROS.cpp
+3 -2
View File
@@ -564,10 +564,11 @@ void OdometryROS::processData()
{
++iterEnd;
}
for(std::map<double, sensor_msgs::msg::Imu::ConstSharedPtr>::iterator iter=imus_.begin(); iter!=iterEnd;)
std::map<double, sensor_msgs::msg::Imu::ConstSharedPtr>::iterator iterFirst = imus_.begin();
for(std::map<double, sensor_msgs::msg::Imu::ConstSharedPtr>::iterator iter=iterFirst; iter!=iterEnd;)
{
// Because we always keep the last processed imu in the buffer, skip the first one when processing again the buffer.
if(iter!=imus_.begin()) {
if(iter!=iterFirst) {
imus.push_back(*iter);
}
if(iter!=iterLast) {