Fixed - Out of bounds for single depth anchored if depth becomes nega…

…tive
rpng · Apr 27, 2020 · 9e3faeb · 9e3faeb
1 parent 10b33a8
commit 9e3faeb
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/ov_core/src/types/Landmark.h b/ov_core/src/types/Landmark.h
@@ -79,8 +79,8 @@ namespace ov_type {
             set_value(_value+dx);
             // Ensure we are not near zero in the z-direction
             if (LandmarkRepresentation::is_relative_representation(_feat_representation) && _value(_value.rows()-1) < 1e-8) {
-                printf(YELLOW "WARNING DEPTH %.8f BECAME CLOSE TO ZERO IN UPDATE!!!\n" RESET, _value(2));
-                _value(2) = 1e-8;
+                printf(YELLOW "WARNING DEPTH %.8f BECAME CLOSE TO ZERO IN UPDATE!!!\n" RESET, _value(_value.rows()-1));
+                //_value(2) = 1e-8;
             }
         }