Add set_read_order reader API

Signed-off-by: Emerson Knapp <emerson.b.knapp@gmail.com>

rosbag2_storage_mcap/CMakeLists.txt

@@ -50,9 +50,10 @@ endif()
 if(${rosbag2_storage_VERSION} VERSION_GREATER_EQUAL 0.15.0)
   list(APPEND MCAP_COMPILE_DEFS ROSBAG2_STORAGE_MCAP_HAS_YAML_HPP)
 endif()
-# COMPATIBILITY(foxy, galactic, humble) - 0.17.x is the Rolling release.
+# COMPATIBILITY(foxy, galactic, humble) - 0.17.x is Rolling release as of this writing
 if(${rosbag2_storage_VERSION} VERSION_GREATER_EQUAL 0.17.0)
   list(APPEND MCAP_COMPILE_DEFS ROSBAG2_STORAGE_MCAP_HAS_STORAGE_FILTER_TOPIC_REGEX)
+  list(APPEND MCAP_COMPILE_DEFS ROSBAG2_STORAGE_MCAP_HAS_SET_READ_ORDER)
 endif()
 
 target_compile_definitions(${PROJECT_NAME} PRIVATE ${MCAP_COMPILE_DEFS})

rosbag2_storage_mcap/src/mcap_storage.cpp

@@ -175,6 +175,9 @@ class MCAPStorage : public rosbag2_storage::storage_interfaces::ReadWriteInterfa
   std::string get_storage_identifier() const override;
 
   /** BaseReadInterface **/
+#ifdef ROSBAG2_STORAGE_MCAP_HAS_SET_READ_ORDER
+  void set_read_order(rosbag2_storage::ReadOrder) override;
+#endif
   bool has_next() override;
   std::shared_ptr<rosbag2_storage::SerializedBagMessage> read_next() override;
   std::vector<rosbag2_storage::TopicMetadata> get_all_topics_and_types() override;
@@ -459,6 +462,23 @@ void MCAPStorage::ensure_summary_read() {
   }
 }
 
+#ifdef ROSBAG2_STORAGE_MCAP_HAS_SET_READ_ORDER
+void MCAPStorage::set_read_order(rosbag2_storage::ReadOrder read_order)
+{
+  auto next_read_order = read_order_;
+  switch (read_order) {
+    case rosbag2_storage::ReadOrder::TIMESTAMP:
+      next_read_order = mcap::ReadMessageOptions::ReadOrder::LogTimeOrder;
+    case rosbag2_storage::ReadOrder::REVERSE_TIMESTAMP:
+      next_read_order = mcap::ReadMessageOptions::ReadOrder::ReverseLogTimeOrder;
+  }
+  if (next_read_order != read_order_) {
+    read_order_ = next_read_order;
+    reset_iterator();
+  }
+}
+#endif
+
 bool MCAPStorage::has_next() {
   if (!linear_iterator_) {
     return false;