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

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



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



---------


(cherry picked from commit 434af1b)

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

Author: mergify[bot]

src/cpp/rtps/history/History.cpp

@@ -23,6 +23,7 @@
 #include <fastdds/dds/log/Log.hpp>
 #include <fastdds/rtps/common/CacheChange.hpp>
 
+#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 comparison 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, history_order_cmp);
+
+    if (lb != changesEnd() && matches_change(*lb, ch))
+    {
+        return lb;
+    }
+
+    return changesEnd();
 }
 
 bool History::matches_change(