Skip to content
Open
Show file tree
Hide file tree
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
5 changes: 3 additions & 2 deletions rosbag2_storage/include/rosbag2_storage/yaml.hpp
Original file line number Diff line number Diff line change
Expand Up @@ -104,9 +104,10 @@ struct convert<rclcpp::Duration>
{
static Node encode(const rclcpp::Duration & duration)
{
const builtin_interfaces::msg::Duration duration_msg = duration;
Node node;
node["sec"] = duration.nanoseconds() / 1000000000;
node["nsec"] = duration.nanoseconds() % 1000000000;
node["sec"] = duration_msg.sec;
node["nsec"] = duration_msg.nanosec;
return node;
}

Expand Down
4 changes: 4 additions & 0 deletions rosbag2_transport/CMakeLists.txt
Original file line number Diff line number Diff line change
Expand Up @@ -559,6 +559,10 @@ if(BUILD_TESTING)
test/rosbag2_transport/test_record_options.cpp)
target_link_libraries(test_record_options ${PROJECT_NAME})

ament_add_gmock(test_play_options
test/rosbag2_transport/test_play_options.cpp)
target_link_libraries(test_play_options ${PROJECT_NAME})

ament_add_gmock(test_type_description_hash
test/rosbag2_transport/test_type_description_hash.cpp)
target_link_libraries(test_type_description_hash ${PROJECT_NAME})
Expand Down
8 changes: 8 additions & 0 deletions rosbag2_transport/src/rosbag2_transport/play_options.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -77,6 +77,8 @@ bool convert<rosbag2_transport::PlayOptions>::decode(
node, "topics_to_filter", play_options.topics_to_filter);
optional_assign<std::vector<std::string>>(
node, "services_to_filter", play_options.services_to_filter);
optional_assign<std::vector<std::string>>(
node, "actions_to_filter", play_options.actions_to_filter);
optional_assign<std::string>(node, "regex_to_filter", play_options.regex_to_filter);
optional_assign<std::string>(
node, "exclude_regex_to_filter",
Expand All @@ -85,10 +87,16 @@ bool convert<rosbag2_transport::PlayOptions>::decode(
node, "exclude_topics", play_options.exclude_topics_to_filter);
optional_assign<std::vector<std::string>>(
node, "exclude_services", play_options.exclude_services_to_filter);
optional_assign<std::vector<std::string>>(
node, "exclude_actions", play_options.exclude_actions_to_filter);

optional_assign<std::unordered_map<std::string, rclcpp::QoS>>(
node, "topic_qos_profile_overrides", play_options.topic_qos_profile_overrides);

optional_assign<bool>(node, "loop", play_options.loop);
optional_assign<std::vector<std::string>>(
node, "topic_remapping_options", play_options.topic_remapping_options);

optional_assign<double>(node, "clock_publish_frequency", play_options.clock_publish_frequency);

optional_assign<bool>(
Expand Down
104 changes: 104 additions & 0 deletions rosbag2_transport/test/rosbag2_transport/test_play_options.cpp
Original file line number Diff line number Diff line change
@@ -0,0 +1,104 @@
// Copyright 2026 Old-Ding
//
// Licensed under the Apache License, Version 2.0 (the "License");
// you may not use this file except in compliance with the License.
// You may obtain a copy of the License at
//
// http://www.apache.org/licenses/LICENSE-2.0
//
// Unless required by applicable law or agreed to in writing, software
// distributed under the License is distributed on an "AS IS" BASIS,
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
// See the License for the specific language governing permissions and
// limitations under the License.

#include <gmock/gmock.h>

#include <chrono>
#include <sstream>
#include <string>

#include "rosbag2_transport/play_options.hpp"

TEST(play_options, yaml_round_trip_preserves_encoded_options)
{
rosbag2_transport::PlayOptions original;
original.read_ahead_queue_size = 42;
original.node_prefix = "prefix";
original.rate = 2.5f;
original.topics_to_filter = {"topic", "other_topic"};
original.services_to_filter = {"service", "other_service"};
original.actions_to_filter = {"action", "other_action"};
original.regex_to_filter = "include.*";
original.exclude_regex_to_filter = "exclude.*";
original.exclude_topics_to_filter = {"excluded_topic"};
original.exclude_services_to_filter = {"excluded_service"};
original.exclude_actions_to_filter = {"excluded_action", "other_excluded_action"};
original.topic_qos_profile_overrides.emplace(
"topic", rclcpp::QoS(10).transient_local());
original.loop = true;
original.topic_remapping_options = {"--ros-args", "-r", "input:=output"};
original.clock_publish_frequency = 10.0;
original.clock_publish_on_topic_publish = true;
original.clock_trigger_topics = {"trigger_topic"};
original.delay = rclcpp::Duration(1, 2);
original.playback_duration = rclcpp::Duration(3, 4);
original.playback_until_timestamp = 5;
original.start_paused = true;
original.start_offset = 6;
original.disable_keyboard_controls = true;
original.wait_acked_timeout = 7;
original.disable_loan_message = true;
original.progress_bar_update_rate = 8;
original.progress_bar_separation_lines = 9;

auto node = YAML::convert<rosbag2_transport::PlayOptions>::encode(original);
std::stringstream serializer;
serializer << node;
auto reconstructed = YAML::Load(serializer.str()).as<rosbag2_transport::PlayOptions>();

#define CHECK(field) EXPECT_EQ(original.field, reconstructed.field)
CHECK(read_ahead_queue_size);
CHECK(node_prefix);
CHECK(rate);
CHECK(topics_to_filter);
CHECK(services_to_filter);
CHECK(actions_to_filter);
CHECK(regex_to_filter);
CHECK(exclude_regex_to_filter);
CHECK(exclude_topics_to_filter);
CHECK(exclude_services_to_filter);
CHECK(exclude_actions_to_filter);
CHECK(topic_qos_profile_overrides);
CHECK(loop);
CHECK(topic_remapping_options);
CHECK(clock_publish_frequency);
CHECK(clock_publish_on_topic_publish);
CHECK(clock_trigger_topics);
CHECK(delay);
CHECK(playback_duration);
CHECK(playback_until_timestamp);
CHECK(start_paused);
CHECK(start_offset);
CHECK(disable_keyboard_controls);
CHECK(wait_acked_timeout);
CHECK(disable_loan_message);
CHECK(progress_bar_update_rate);
CHECK(progress_bar_separation_lines);
#undef CHECK
}

TEST(play_options, yaml_round_trip_preserves_default_negative_ack_timeout)
{
rosbag2_transport::PlayOptions original;

auto node = YAML::convert<rosbag2_transport::PlayOptions>::encode(original);
EXPECT_EQ(-1, node["wait_acked_timeout"]["sec"].as<int32_t>());
EXPECT_EQ(999999999U, node["wait_acked_timeout"]["nsec"].as<uint32_t>());

std::stringstream serializer;
serializer << node;
auto reconstructed = YAML::Load(serializer.str()).as<rosbag2_transport::PlayOptions>();

EXPECT_EQ(original.wait_acked_timeout, reconstructed.wait_acked_timeout);
}