diff --git a/src/processor/processor_tracker_landmark_apriltag.cpp b/src/processor/processor_tracker_landmark_apriltag.cpp
index 15a5f59723825a508d38d5ee53b1fa4e1cc2af42..270c1b109673ca9ac2c77a0681596d7028c9a3a4 100644
--- a/src/processor/processor_tracker_landmark_apriltag.cpp
+++ b/src/processor/processor_tracker_landmark_apriltag.cpp
@@ -203,11 +203,8 @@ void ProcessorTrackerLandmarkApriltag::preProcess()
 
         if (!use_rotation){
 //            WOLF_INFO("Ambiguity on estimated rotation is likely");
-            // Put a very high covariance on angles measurements (low info matrix ?)
-//            cov.bottomRightCorner(3, 3) = 1000000*Eigen::Matrix3s::Identity();
-            Eigen::Matrix6s new_info = 0.001*Eigen::Matrix6s::Identity();
-            new_info.topLeftCorner(3, 3) = info.topLeftCorner(3, 3);
-            info = new_info;
+            // Put a very high covariance on angles measurements (low info matrix)
+            info.bottomRightCorner(3,3) = 0.001 * Eigen::Matrix3s::Identity();
         }
 
 //        FOR TEST ONLY