more precise router selection

libi2pd/NetDb.cpp

@@ -1223,24 +1223,34 @@ namespace data
 	{
 		if (m_RouterInfos.empty())
 			return 0;
-		uint32_t ind = rand () % m_RouterInfos.size ();
-		for (int j = 0; j < 2; j++)
-		{
-			uint32_t i = 0;
 		std::unique_lock<std::mutex> l(m_RouterInfosMutex);
-			for (const auto& it: m_RouterInfos)
-			{
-				if (i >= ind)
+		auto ind = rand () % m_RouterInfos.size ();
+		auto it = m_RouterInfos.begin ();
+		std::advance (it, ind);
+		// try random router
+		if (it != m_RouterInfos.end () && !it->second->IsUnreachable () && filter (it->second))
+			return it->second;
+		// try closest routers
+		auto it1 = it; it1++;	
+		// forward
+		while (it1 != m_RouterInfos.end ())
 		{
-					if (!it.second->IsUnreachable () && filter (it.second))
-						return it.second;
+			if (!it1->second->IsUnreachable () && filter (it1->second))
+				return it1->second;
+			it1++;
 		}	
-				else
-					i++;
+		// still not found, try from the beginning
+		if (ind)
+		{	
+			it1 = m_RouterInfos.begin ();
+			while (it1 != it || it1 != m_RouterInfos.end ())
+			{
+				if (!it1->second->IsUnreachable () && filter (it1->second))
+				return it1->second;
+				it1++;
 			}	
-			// we couldn't find anything, try second pass
-			ind = 0;
 		}	       
+			
 		return nullptr; // seems we have too few routers
 	}