fixing the type problem in insertPointCloud function (facontidavide#13)

TheoCorn · Sep 27, 2023 · b66c472 · b66c472
1 parent 417915c
commit b66c472
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/bonxai_map/include/bonxai_map/probabilistic_map.hpp b/bonxai_map/include/bonxai_map/probabilistic_map.hpp
@@ -168,7 +168,7 @@ inline void ProbabilisticMap::insertPointCloud(const std::vector<PointT, Alloc>&
     if (squared_norm >= max_range_sqr)
     {
       // The new point will have distance == max_range from origin
-      const Vector3D new_point = origin + ((vect / std::sqrt(squared_norm)) * max_range);
+      const Vector3D new_point = from + ((vect / std::sqrt(squared_norm)) * max_range);
       addMissPoint(new_point);
     }
     else {