Change the BoundingBox to return no points, if no points where added

VirtualRobot/BoundingBox.cpp

@@ -47,6 +47,12 @@ namespace VirtualRobot
     {
         std::vector < Eigen::Vector3f > points;
 
+        if (std::isnan(min(0)) || std::isnan(min(1)) || std::isnan(min(2)) ||
+                std::isnan(max(0)) || std::isnan(max(1)) || std::isnan(max(2)))
+        {
+            return points;
+        }
+
         points.push_back(Eigen::Vector3f(min(0), min(1), min(2)));
         points.push_back(Eigen::Vector3f(min(0), min(1), max(2)));
         points.push_back(Eigen::Vector3f(min(0), max(1), min(2)));