Merge branch 'master' of github.com:introlab/rtabmap_ros into fixing_…

…sync_and_delays
introlab · Dec 1, 2024 · 3a782a7 · 3a782a7
2 parents 723ac7c + e5667b2
commit 3a782a7
Showing 1 changed file with 19 additions and 0 deletions.
diff --git a/rtabmap_conversions/src/MsgConversion.cpp b/rtabmap_conversions/src/MsgConversion.cpp
@@ -3058,6 +3058,25 @@ bool deskew_impl(
 			}
 		}
 
+		if(secFirst > 1.e18)
+		{
+			// convert nanoseconds to seconds
+			secFirst /= 1.e9;
+			secLast /= 1.e9;
+		}
+		else if(secFirst > 1.e15)
+		{
+			// convert microseconds to seconds
+			secFirst /= 1.e6;
+			secLast /= 1.e6;
+		}
+		else if(secFirst > 1.e12)
+		{
+			// convert milliseconds to seconds
+			secFirst /= 1.e3;
+			secLast /= 1.e3;
+		}
+
 		firstStamp = timestampToROS(secFirst);
 		lastStamp = timestampToROS(secLast);
 	}