Get all nodes in dense areas but make sure we don't underflow in sparse ones

plugins/map_matching.hpp

@@ -81,30 +81,18 @@ template <class DataFacadeT> class MapMatchingPlugin : public BasePlugin
                     route_parameters.coordinates[current_coordinate - 1],
                     route_parameters.coordinates[current_coordinate]);
 
-            std::cout << "Searching: " << current_coordinate << std::endl;
             std::vector<std::pair<PhantomNode, double>> candidates;
-            if (!facade->IncrementalFindPhantomNodeForCoordinateWithDistance(
+            if (!facade->IncrementalFindPhantomNodeForCoordinateWithMaxDistance(
                     route_parameters.coordinates[current_coordinate],
                     candidates,
-                    last_distance,
+                    last_distance/2.0,
                     5,
                     20))
             {
-                std::cout << "Nothing found for " << current_coordinate << std::endl;
-                continue;
+                return 400;
             }
 
             candidate_lists.push_back(candidates);
-
-            std::cout << current_coordinate << " (" << (last_distance / 2.0)  << ") : "
-                      << candidates.size() << std::endl;
-
-            BOOST_ASSERT(candidate_lists[current_coordinate].size() == 10);
-        }
-
-        if (2 > candidate_lists.size())
-        {
-            return 400;
         }
 
         // call the actual map matching