Compare commits

..

1 Commits

Author SHA1 Message Date
Tomoya Fujita
0b04394806 keep the event alive throught the assertion, preveiting the race.
Signed-off-by: Tomoya Fujita <Tomoya.Fujita@sony.com>
2026-03-17 16:58:39 +09:00
7 changed files with 63 additions and 84 deletions

View File

@@ -287,7 +287,6 @@ class Service
public std::enable_shared_from_this<Service<ServiceT>>
{
public:
using ServiceType = ServiceT;
using CallbackType = std::function<
void (
const std::shared_ptr<typename ServiceT::Request>,

View File

@@ -551,15 +551,6 @@ public:
event_handlers_[event_type]->clear_on_ready_callback();
}
/// Check if content filtered topic feature of the subscription instance is supported.
/**
* \return boolean flag indicating if the content filtered topic of this subscription is
* supported.
*/
RCLCPP_PUBLIC
bool
is_cft_supported() const;
/// Check if content filtered topic feature of the subscription instance is enabled.
/**
* \return boolean flag indicating if the content filtered topic of this subscription is enabled.

View File

@@ -77,10 +77,6 @@ ParameterEventHandler::add_parameter_callback(
bool
ParameterEventHandler::configure_nodes_filter(const std::vector<std::string> & node_names)
{
if (!event_subscription_->is_cft_supported()) {
return false;
}
if (node_names.empty()) {
// Clear content filter
event_subscription_->set_content_filter("");

View File

@@ -480,12 +480,6 @@ SubscriptionBase::set_on_new_message_callback(
}
}
bool
SubscriptionBase::is_cft_supported() const
{
return rcl_subscription_is_cft_supported(subscription_handle_.get());
}
bool
SubscriptionBase::is_cft_enabled() const
{

View File

@@ -139,7 +139,8 @@ TEST_F(TestNodeGraph, construct_from_node)
EXPECT_NE(nullptr, node_graph()->get_graph_guard_condition());
// get_graph_event is non-const
EXPECT_NE(nullptr, node()->get_node_graph_interface()->get_graph_event());
auto event = node()->get_node_graph_interface()->get_graph_event();
EXPECT_NE(nullptr, event);
EXPECT_LE(1u, node_graph()->count_graph_users());
}

View File

@@ -108,21 +108,6 @@ bool operator==(const test_msgs::msg::BasicTypes & m1, const test_msgs::msg::Bas
m1.uint64_value == m2.uint64_value;
}
TEST_F(TestContentFilterSubscription, is_cft_supported)
{
{
auto mock = mocking_utils::patch_and_return(
"lib:rclcpp", rcl_subscription_is_cft_supported, false);
EXPECT_FALSE(sub->is_cft_supported());
}
{
auto mock = mocking_utils::patch_and_return(
"lib:rclcpp", rcl_subscription_is_cft_supported, true);
EXPECT_TRUE(sub->is_cft_supported());
}
}
TEST_F(TestContentFilterSubscription, is_cft_enabled)
{
{
@@ -180,7 +165,7 @@ TEST_F(TestContentFilterSubscription, get_content_filter)
TEST_F(TestContentFilterSubscription, set_content_filter)
{
if (sub->is_cft_supported()) {
if (sub->is_cft_enabled()) {
EXPECT_NO_THROW(
sub->set_content_filter(filter_expression_init, expression_parameters_2));
} else {
@@ -193,10 +178,8 @@ TEST_F(TestContentFilterSubscription, set_content_filter)
TEST_F(TestContentFilterSubscription, content_filter_get_begin)
{
std::string rmw_implementation_str = std::string(rmw_get_implementation_identifier());
// Run test only if rmw implementation supports content filter, otherwise skip it.
if (!sub->is_cft_supported()) {
GTEST_SKIP() << rmw_implementation_str << " doesn't support content filter";
if (rmw_implementation_str == "rmw_zenoh_cpp") {
GTEST_SKIP();
}
using namespace std::chrono_literals;
@@ -223,27 +206,28 @@ TEST_F(TestContentFilterSubscription, content_filter_get_begin)
EXPECT_TRUE(receive);
EXPECT_EQ(original_message, output_message);
EXPECT_NO_THROW(
sub->set_content_filter(filter_expression_init, expression_parameters_2));
// waiting to allow for filter propagation
std::this_thread::sleep_for(std::chrono::seconds(10));
if (sub->is_cft_enabled()) {
EXPECT_NO_THROW(
sub->set_content_filter(filter_expression_init, expression_parameters_2));
// waiting to allow for filter propagation
std::this_thread::sleep_for(std::chrono::seconds(10));
test_msgs::msg::BasicTypes message_to_be_filtered;
message_to_be_filtered.int32_value = original_message.int32_value;
pub->publish(message_to_be_filtered);
test_msgs::msg::BasicTypes original_message;
original_message.int32_value = 3;
pub->publish(original_message);
test_msgs::msg::BasicTypes output_message2;
receive = wait_for_message(output_message2, sub, context, 10s);
EXPECT_FALSE(receive);
test_msgs::msg::BasicTypes output_message;
bool receive = wait_for_message(output_message, sub, context, 10s);
EXPECT_FALSE(receive);
}
}
}
TEST_F(TestContentFilterSubscription, content_filter_get_later)
{
std::string rmw_implementation_str = std::string(rmw_get_implementation_identifier());
// Run test only if rmw implementation supports content filter, otherwise skip it.
if (!sub->is_cft_supported()) {
GTEST_SKIP() << rmw_implementation_str << " doesn't support content filter";
if (rmw_implementation_str == "rmw_zenoh_cpp") {
GTEST_SKIP();
}
using namespace std::chrono_literals;
@@ -267,30 +251,36 @@ TEST_F(TestContentFilterSubscription, content_filter_get_later)
test_msgs::msg::BasicTypes output_message;
bool receive = wait_for_message(output_message, sub, context, 10s);
EXPECT_FALSE(receive);
if (sub->is_cft_enabled()) {
EXPECT_FALSE(receive);
} else {
EXPECT_TRUE(receive);
EXPECT_EQ(original_message, output_message);
}
EXPECT_NO_THROW(
sub->set_content_filter(filter_expression_init, expression_parameters_2));
// waiting to allow for filter propagation
std::this_thread::sleep_for(std::chrono::seconds(10));
if (sub->is_cft_enabled()) {
EXPECT_NO_THROW(
sub->set_content_filter(filter_expression_init, expression_parameters_2));
// waiting to allow for filter propagation
std::this_thread::sleep_for(std::chrono::seconds(10));
test_msgs::msg::BasicTypes matching_message;
matching_message.int32_value = original_message.int32_value;
pub->publish(matching_message);
test_msgs::msg::BasicTypes original_message;
original_message.int32_value = 4;
pub->publish(original_message);
test_msgs::msg::BasicTypes output_message2;
receive = wait_for_message(output_message2, sub, context, 10s);
EXPECT_TRUE(receive);
EXPECT_EQ(matching_message, output_message2);
test_msgs::msg::BasicTypes output_message;
bool receive = wait_for_message(output_message, sub, context, 10s);
EXPECT_TRUE(receive);
EXPECT_EQ(original_message, output_message);
}
}
}
TEST_F(TestContentFilterSubscription, content_filter_reset)
{
std::string rmw_implementation_str = std::string(rmw_get_implementation_identifier());
// Run test only if rmw implementation supports content filter, otherwise skip it.
if (!sub->is_cft_supported()) {
GTEST_SKIP() << rmw_implementation_str << " doesn't support content filter";
if (rmw_implementation_str == "rmw_zenoh_cpp") {
GTEST_SKIP();
}
using namespace std::chrono_literals;
@@ -314,20 +304,28 @@ TEST_F(TestContentFilterSubscription, content_filter_reset)
test_msgs::msg::BasicTypes output_message;
bool receive = wait_for_message(output_message, sub, context, 10s);
EXPECT_FALSE(receive);
if (sub->is_cft_enabled()) {
EXPECT_FALSE(receive);
} else {
EXPECT_TRUE(receive);
EXPECT_EQ(original_message, output_message);
}
EXPECT_NO_THROW(sub->set_content_filter(""));
// waiting to allow for filter propagation
std::this_thread::sleep_for(std::chrono::seconds(10));
if (sub->is_cft_enabled()) {
EXPECT_NO_THROW(
sub->set_content_filter(""));
// waiting to allow for filter propagation
std::this_thread::sleep_for(std::chrono::seconds(10));
test_msgs::msg::BasicTypes unfiltered_message;
unfiltered_message.int32_value = original_message.int32_value;
pub->publish(unfiltered_message);
test_msgs::msg::BasicTypes original_message;
original_message.int32_value = 4;
pub->publish(original_message);
test_msgs::msg::BasicTypes output_message2;
receive = wait_for_message(output_message2, sub, context, 10s);
EXPECT_TRUE(receive);
EXPECT_EQ(unfiltered_message, output_message2);
test_msgs::msg::BasicTypes output_message;
bool receive = wait_for_message(output_message, sub, context, 10s);
EXPECT_TRUE(receive);
EXPECT_EQ(original_message, output_message);
}
}
}

View File

@@ -24,16 +24,16 @@ int main(int argc, char * argv[])
/// Component container with a multi-threaded executor.
rclcpp::init(argc, argv);
rclcpp::executors::MultiThreadedExecutor::SharedPtr exec = nullptr;
const auto node = std::make_shared<rclcpp_components::ComponentManager>();
auto exec = std::make_shared<rclcpp::executors::MultiThreadedExecutor>();
auto node = std::make_shared<rclcpp_components::ComponentManager>();
if (node->has_parameter("thread_num")) {
const auto thread_num = node->get_parameter("thread_num").as_int();
exec = std::make_shared<rclcpp::executors::MultiThreadedExecutor>(
rclcpp::ExecutorOptions{}, thread_num);
node->set_executor(exec);
} else {
exec = std::make_shared<rclcpp::executors::MultiThreadedExecutor>();
node->set_executor(exec);
}
node->set_executor(exec);
exec->add_node(node);
exec->spin();