fix missing copy covariance in Pose3DQuaternionCovarianceRPYTo3DRPYCo…

…variance
andreaostuni · Nov 7, 2023 · db31db1 · db31db1
1 parent 9180ae4
commit db31db1
Showing 1 changed file with 2 additions and 0 deletions.
diff --git a/src/pose_covariance_representation.cpp b/src/pose_covariance_representation.cpp
@@ -71,6 +71,8 @@ void Pose3DQuaternionCovarianceRPYTo3DRPYCovariance(
 {
   // Convert pose
   Pose3DQuaternionTo3DRPY(pose_quaternion_covariance_rpy.first, pose_rpy_covariance.first);
+  // Copy covariance
+  pose_rpy_covariance.second = pose_quaternion_covariance_rpy.second;
 }
 
 void Pose3DQuaternionCovarianceRPYTo3DQuaternionCovariance(