Use binary search in 'find_change_nts' (#5997) (#6028)

* Use binary search in 'find_change_nts' (#5997)

* Refs #23618: Use binary search in 'find_change_nts'

Signed-off-by: cferreiragonz <[email protected]>

* Refs #23618: Take into account changes with same sequence number

Signed-off-by: cferreiragonz <[email protected]>

---------

Signed-off-by: cferreiragonz <[email protected]>
(cherry picked from commit 434af1b)

# Conflicts:
#	src/cpp/rtps/history/History.cpp

* Resolving conflicts

Signed-off-by: Emilio Cuesta <[email protected]>

---------

Signed-off-by: Emilio Cuesta <[email protected]>
Co-authored-by: Carlos Ferreira González <[email protected]>
Co-authored-by: Emilio Cuesta <[email protected]>

Author: 3 people

src/cpp/rtps/history/History.cpp

@@ -23,6 +23,7 @@
 #include <fastdds/dds/log/Log.hpp>
 #include <fastdds/rtps/common/CacheChange.h>
 
+#include <rtps/common/ChangeComparison.hpp>
 #include <rtps/history/BasicPayloadPool.hpp>
 #include <rtps/history/CacheChangePool.h>
 
@@ -54,11 +55,15 @@ History::const_iterator History::find_change_nts(
         return const_iterator();
     }
 
-    return std::find_if(changesBegin(), changesEnd(), [this, ch](const CacheChange_t* chi)
-                   {
-                       // use the derived classes comparisson criteria for searching
-                       return this->matches_change(chi, ch);
-                   });
+    // Use binary search to find the first change with the same sequence number
+    auto lb = std::lower_bound(changesBegin(), changesEnd(), ch, fastdds::rtps::history_order_cmp);
+
+    if (lb != changesEnd() && matches_change(*lb, ch))
+    {
+        return lb;
+    }
+
+    return changesEnd();
 }
 
 bool History::matches_change(