释放 Fast DDS 中间件的潜力 [社区贡献]
目标:本教程将展示如何在 ROS 2 中使用 Fast DDS 的扩展配置功能。
教程级别:高级
时间:20 分钟
背景
ROS 2 堆栈和 Fast DDS 之间的接口由 ROS 2 中间件实现 rmw_fastrtps 提供。 此实现在所有 ROS 2 发行版中都可用,包括二进制文件和源代码。
ROS 2 RMW 仅允许配置某些中间件 QoS
(请参阅:doc:ROS 2 QoS 策略)。
但是,rmw_fastrtps
提供了扩展配置功能,可以充分利用 Fast DDS 中的功能。
本教程将指导您完成一系列示例,解释如何使用 XML 文件解锁此扩展配置。
为了获取有关在 ROS 2 上使用 Fast DDS 的更多信息,请查看`以下文档 <https://fast-dds.docs.eprosima.com/en/latest/fastdds/ros2/ros2.html>`__。
先决条件
本教程假设您知道如何 创建包。
它还假设您知道如何编写 简单的发布者和订阅者 和 简单的服务和客户端。 尽管这些示例是用 C++ 实现的,但相同的概念也适用于 Python 包。
在同一节点中混合同步和异步发布
在此第一个示例中,将创建一个具有两个发布者的节点,其中一个具有同步发布模式,另一个具有异步发布模式。
rmw_fastrtps
默认使用同步发布模式。
使用同步发布模式,数据直接在用户线程的上下文中发送。
这意味着在写入操作期间发生的任何阻塞调用都会阻塞用户线程,从而阻止应用程序继续运行。 但是,这种模式通常会在较低的延迟下产生更高的吞吐率,因为线程之间没有通知或上下文切换。
另一方面,使用异步发布模式,每次发布者调用写入操作时,数据都会被复制到队列中, 后台线程(异步线程)会收到有关队列添加的通知,并在实际发送数据之前将线程的控制权返回给用户。 后台线程负责使用队列并将数据发送给每个匹配的读取器。
使用发布者创建节点
首先,在新的工作区上创建一个名为“sync_async_node_example_cpp”的新包:
mkdir -p ~/ros2_ws/src
cd ~/ros2_ws/src
ros2 pkg create --build-type ament_cmake --license Apache-2.0 --dependencies rclcpp std_msgs -- sync_async_node_example_cpp
mkdir -p ~/ros2_ws/src
cd ~/ros2_ws/src
ros2 pkg create --build-type ament_cmake --license Apache-2.0 --dependencies rclcpp std_msgs -- sync_async_node_example_cpp
md \ros2_ws\src
cd \ros2_ws\src
ros2 pkg create --build-type ament_cmake --license Apache-2.0 --dependencies rclcpp std_msgs -- sync_async_node_example_cpp
然后,向包中添加一个名为“src/sync_async_writer.cpp”的文件,内容如下。 请注意,同步发布者将在主题“sync_topic”上发布,而异步发布者将在主题“async_topic”上发布。
#include <chrono>
#include <functional>
#include <memory>
#include <string>
#include "rclcpp/rclcpp.hpp"
#include "std_msgs/msg/string.hpp"
using namespace std::chrono_literals;
class SyncAsyncPublisher : public rclcpp::Node
{
public:
SyncAsyncPublisher()
: Node("sync_async_publisher"), count_(0)
{
// Create the synchronous publisher on topic 'sync_topic'
sync_publisher_ = this->create_publisher<std_msgs::msg::String>("sync_topic", 10);
// Create the asynchronous publisher on topic 'async_topic'
async_publisher_ = this->create_publisher<std_msgs::msg::String>("async_topic", 10);
// This timer will trigger the publication of new data every half a second
timer_ = this->create_wall_timer(
500ms, std::bind(&SyncAsyncPublisher::timer_callback, this));
}
private:
/**
* Actions to run every time the timer expires
*/
void timer_callback()
{
// Create a new message to be sent
auto sync_message = std_msgs::msg::String();
sync_message.data = "SYNC: Hello, world! " + std::to_string(count_);
// Log the message to the console to show progress
RCLCPP_INFO(this->get_logger(), "Synchronously publishing: '%s'", sync_message.data.c_str());
// Publish the message using the synchronous publisher
sync_publisher_->publish(sync_message);
// Create a new message to be sent
auto async_message = std_msgs::msg::String();
async_message.data = "ASYNC: Hello, world! " + std::to_string(count_);
// Log the message to the console to show progress
RCLCPP_INFO(this->get_logger(), "Asynchronously publishing: '%s'", async_message.data.c_str());
// Publish the message using the asynchronous publisher
async_publisher_->publish(async_message);
// Prepare the count for the next message
count_++;
}
// This timer will trigger the publication of new data every half a second
rclcpp::TimerBase::SharedPtr timer_;
// A publisher that publishes asynchronously
rclcpp::Publisher<std_msgs::msg::String>::SharedPtr async_publisher_;
// A publisher that publishes synchronously
rclcpp::Publisher<std_msgs::msg::String>::SharedPtr sync_publisher_;
// Number of messages sent so far
size_t count_;
};
int main(int argc, char * argv[])
{
rclcpp::init(argc, argv);
rclcpp::spin(std::make_shared<SyncAsyncPublisher>());
rclcpp::shutdown();
return 0;
}
现在打开“CMakeLists.txt”文件并添加一个新的可执行文件并将其命名为“SyncAsyncWriter”,以便您可以使用“ros2 run”运行您的节点:
add_executable(SyncAsyncWriter src/sync_async_writer.cpp)
ament_target_dependencies(SyncAsyncWriter rclcpp std_msgs)
最后,添加“install(TARGETS…)”部分,以便“ros2 run”可以找到您的可执行文件:
install(TARGETS
SyncAsyncWriter
DESTINATION lib/${PROJECT_NAME})
您可以通过删除一些不必要的部分和注释来清理您的“CMakeLists.txt”,因此它看起来像这样:
cmake_minimum_required(VERSION 3.8)
project(sync_async_node_example_cpp)
# Default to C++14
if(NOT CMAKE_CXX_STANDARD)
set(CMAKE_CXX_STANDARD 14)
endif()
if(CMAKE_COMPILER_IS_GNUCXX OR CMAKE_CXX_COMPILER_ID MATCHES "Clang")
add_compile_options(-Wall -Wextra -Wpedantic)
endif()
find_package(ament_cmake REQUIRED)
find_package(rclcpp REQUIRED)
find_package(std_msgs REQUIRED)
add_executable(SyncAsyncWriter src/sync_async_writer.cpp)
ament_target_dependencies(SyncAsyncWriter rclcpp std_msgs)
install(TARGETS
SyncAsyncWriter
DESTINATION lib/${PROJECT_NAME})
ament_package()
如果现在构建并运行此节点,则两个发布者的行为将相同,在两个主题中异步发布,因为这是默认发布模式。 可以在节点启动期间使用 XML 文件在运行时更改默认发布模式配置。
使用配置文件配置创建 XML 文件
创建名为“SyncAsync.xml”的文件,内容如下:
<?xml version="1.0" encoding="UTF-8" ?>
<profiles xmlns="http://www.eprosima.com/XMLSchemas/fastRTPS_Profiles">
<!-- default publisher profile -->
<publisher profile_name="default_publisher" is_default_profile="true">
<historyMemoryPolicy>DYNAMIC</historyMemoryPolicy>
</publisher>
<!-- default subscriber profile -->
<subscriber profile_name="default_subscriber" is_default_profile="true">
<historyMemoryPolicy>DYNAMIC</historyMemoryPolicy>
</subscriber>
<!-- publisher profile for topic sync_topic -->
<publisher profile_name="/sync_topic">
<historyMemoryPolicy>DYNAMIC</historyMemoryPolicy>
<qos>
<publishMode>
<kind>SYNCHRONOUS</kind>
</publishMode>
</qos>
</publisher>
<!-- publisher profile for topic async_topic -->
<publisher profile_name="/async_topic">
<historyMemoryPolicy>DYNAMIC</historyMemoryPolicy>
<qos>
<publishMode>
<kind>ASYNCHRONOUS</kind>
</publishMode>
</qos>
</publisher>
</profiles>
请注意,已定义多个发布者和订阅者的配置文件。 两个默认配置文件,将“is_default_profile”设置为“true”,还有两个配置文件,其名称与先前定义的主题的名称一致:“sync_topic”和另一个“async_topic”。 最后这两个配置文件相应地将发布模式设置为“SYNCHRONOUS”或“ASYNCHRONOUS”。 还请注意,所有配置文件都指定了一个“historyMemoryPolicy”值,这是示例运行所必需的,原因将在本教程的后面解释。
执行发布者节点
您需要导出以下环境变量才能加载 XML:
export RMW_IMPLEMENTATION=rmw_fastrtps_cpp
export RMW_FASTRTPS_USE_QOS_FROM_XML=1
export FASTRTPS_DEFAULT_PROFILES_FILE=path/to/SyncAsync.xml
export RMW_IMPLEMENTATION=rmw_fastrtps_cpp
export RMW_FASTRTPS_USE_QOS_FROM_XML=1
export FASTRTPS_DEFAULT_PROFILES_FILE=path/to/SyncAsync.xml
SET RMW_IMPLEMENTATION=rmw_fastrtps_cpp
SET RMW_FASTRTPS_USE_QOS_FROM_XML=1
SET FASTRTPS_DEFAULT_PROFILES_FILE=path/to/SyncAsync.xml
最后,确保您已获取安装文件并运行节点:
source install/setup.bash
ros2 run sync_async_node_example_cpp SyncAsyncWriter
您应该看到发布者从发布节点发送数据,如下所示:
[INFO] [1612972049.994630332] [sync_async_publisher]: Synchronously publishing: 'SYNC: Hello, world! 0'
[INFO] [1612972049.995097767] [sync_async_publisher]: Asynchronously publishing: 'ASYNC: Hello, world! 0'
[INFO] [1612972050.494478706] [sync_async_publisher]: Synchronously publishing: 'SYNC: Hello, world! 1'
[INFO] [1612972050.494664334] [sync_async_publisher]: Asynchronously publishing: 'ASYNC: Hello, world! 1'
[INFO] [1612972050.994368474] [sync_async_publisher]: Synchronously publishing: 'SYNC: Hello, world! 2'
[INFO] [1612972050.994549851] [sync_async_publisher]: Asynchronously publishing: 'ASYNC: Hello, world! 2'
现在,您已在同一个节点内运行同步发布者和异步发布者。
创建一个具有订阅者的节点
接下来,将创建一个具有订阅者的新节点,该节点将监听“sync_topic”和“async_topic”发布。 在名为“src/sync_async_reader.cpp”的新源文件中写入以下内容:
#include <functional>
#include <memory>
#include "rclcpp/rclcpp.hpp"
#include "std_msgs/msg/string.hpp"
using std::placeholders::_1;
class SyncAsyncSubscriber : public rclcpp::Node
{
public:
SyncAsyncSubscriber()
: Node("sync_async_subscriber")
{
// Create the synchronous subscriber on topic 'sync_topic'
// and tie it to the topic_callback
sync_subscription_ = this->create_subscription<std_msgs::msg::String>(
"sync_topic", 10, std::bind(&SyncAsyncSubscriber::topic_callback, this, _1));
// Create the asynchronous subscriber on topic 'async_topic'
// and tie it to the topic_callback
async_subscription_ = this->create_subscription<std_msgs::msg::String>(
"async_topic", 10, std::bind(&SyncAsyncSubscriber::topic_callback, this, _1));
}
private:
/**
* Actions to run every time a new message is received
*/
void topic_callback(const std_msgs::msg::String & msg) const
{
RCLCPP_INFO(this->get_logger(), "I heard: '%s'", msg.data.c_str());
}
// A subscriber that listens to topic 'sync_topic'
rclcpp::Subscription<std_msgs::msg::String>::SharedPtr sync_subscription_;
// A subscriber that listens to topic 'async_topic'
rclcpp::Subscription<std_msgs::msg::String>::SharedPtr async_subscription_;
};
int main(int argc, char * argv[])
{
rclcpp::init(argc, argv);
rclcpp::spin(std::make_shared<SyncAsyncSubscriber>());
rclcpp::shutdown();
return 0;
}
打开“CMakeLists.txt”文件,在之前的“SyncAsyncWriter”下添加一个新的可执行文件,命名为“SyncAsyncReader”:
add_executable(SyncAsyncReader src/sync_async_reader.cpp)
ament_target_dependencies(SyncAsyncReader rclcpp std_msgs)
install(TARGETS
SyncAsyncReader
DESTINATION lib/${PROJECT_NAME})
执行订阅者节点
在一个终端中运行发布者节点后,打开另一个终端并导出要加载的 XML 所需的环境变量:
export RMW_IMPLEMENTATION=rmw_fastrtps_cpp
export RMW_FASTRTPS_USE_QOS_FROM_XML=1
export FASTRTPS_DEFAULT_PROFILES_FILE=path/to/SyncAsync.xml
export RMW_IMPLEMENTATION=rmw_fastrtps_cpp
export RMW_FASTRTPS_USE_QOS_FROM_XML=1
export FASTRTPS_DEFAULT_PROFILES_FILE=path/to/SyncAsync.xml
SET RMW_IMPLEMENTATION=rmw_fastrtps_cpp
SET RMW_FASTRTPS_USE_QOS_FROM_XML=1
SET FASTRTPS_DEFAULT_PROFILES_FILE=path/to/SyncAsync.xml
最后,确保您已获取安装文件并运行节点:
source install/setup.bash
ros2 run sync_async_node_example_cpp SyncAsyncReader
您应该看到订阅者从发布节点接收数据,如下所示:
[INFO] [1612972054.495429090] [sync_async_subscriber]: I heard: 'SYNC: Hello, world! 10'
[INFO] [1612972054.995410057] [sync_async_subscriber]: I heard: 'ASYNC: Hello, world! 10'
[INFO] [1612972055.495453494] [sync_async_subscriber]: I heard: 'SYNC: Hello, world! 11'
[INFO] [1612972055.995396561] [sync_async_subscriber]: I heard: 'ASYNC: Hello, world! 11'
[INFO] [1612972056.495534818] [sync_async_subscriber]: I heard: 'SYNC: Hello, world! 12'
[INFO] [1612972056.995473953] [sync_async_subscriber]: I heard: 'ASYNC: Hello, world! 12'
示例分析
配置文件 XML
XML 文件为发布者和订阅者定义了几种配置。 您可以有一个默认发布者配置文件和几个特定于主题的发布者配置文件。 唯一的要求是所有发布者配置文件都有不同的名称,并且只有一个默认配置文件。 订阅者也是如此。
为了为特定主题定义配置,只需以 ROS 2 主题名称命名配置文件(如示例中的“/sync_topic”和“/async_topic”), 并且“rmw_fastrtps”会将此配置文件应用于该主题的所有发布者和订阅者。 默认配置文件由设置为“true”的属性“is_default_profile”标识,当没有其他名称与主题名称匹配的配置文件时,它将充当后备配置文件。
环境变量 FASTRTPS_DEFAULT_PROFILES_FILE
用于通知 Fast DDS 要加载的配置文件的 XML 文件的路径。
RMW_FASTRTPS_USE_QOS_FROM_XML
在所有可配置属性中,rmw_fastrtps
对 publishMode
和 historyMemoryPolicy
的处理方式不同。
默认情况下,在 rmw_fastrtps
实现中,这些值设置为 ASYNCHRONOUS
和 PREALLOCATED_WITH_REALLOC
,并且 XML 文件上设置的值将被忽略。
为了使用 XML 文件中的值,必须将环境变量 RMW_FASTRTPS_USE_QOS_FROM_XML
设置为 1
。
但是,这又带来了**另一个警告**:如果设置了 RMW_FASTRTPS_USE_QOS_FROM_XML
,但 XML 文件未定义
publishMode
或 historyMemoryPolicy
,则这些属性将采用 Fast DDS 默认值,而不是 rmw_fastrtps
默认值。
这很重要,尤其是对于 historyMemoryPolicy
,因为 Fast DDS 默认值是 PREALLOCATED
,它不适用于 ROS2 主题数据类型。
因此,在示例中,已明确设置此策略的有效值(“DYNAMIC”)。
rmw_qos_profile_t 的优先级
rmw_qos_profile_t 中包含的 ROS 2 QoS 始终被遵守,除非设置为 *_SYSTEM_DEFAULT
。
在这种情况下,将应用 XML 值(或在没有 XML 值的情况下的 Fast DDS 默认值)。
这意味着,如果 rmw_qos_profile_t
中的任何 QoS 设置为 *_SYSTEM_DEFAULT
以外的值,则 XML 中的相应值将被忽略。
通过 XML 使用其他 FastDDS 功能
尽管我们已经创建了一个具有两个配置不同的发布者的节点,但要检查它们的行为是否不同并不容易。
现在已经介绍了 XML 配置文件的基础知识,让我们使用它们来配置对节点有一定视觉效果的东西。
具体来说,将设置其中一个发布者上的最大匹配订阅者数量和另一个发布者上的分区定义。
请注意,这些只是可以通过 XML 文件在 rmw_fastrtps
上调整的所有配置属性中非常简单的示例。
请参阅 *Fast DDS* 文档 以查看可以通过 XML 文件配置的完整属性列表。
限制匹配订阅者的数量
向 /async_topic
发布者配置文件添加最大匹配订阅者数量。
它应该看起来像这样:
<!-- publisher profile for topic async_topic -->
<publisher profile_name="/async_topic">
<historyMemoryPolicy>DYNAMIC</historyMemoryPolicy>
<qos>
<publishMode>
<kind>ASYNCHRONOUS</kind>
</publishMode>
</qos>
<matchedSubscribersAllocation>
<initial>0</initial>
<maximum>1</maximum>
<increment>1</increment>
</matchedSubscribersAllocation>
</publisher>
匹配订阅者的数量被限制为一个。
现在打开三个终端,不要忘记获取安装文件并设置所需的环境变量。
在第一个终端上运行发布者节点,在另外两个终端上运行订阅者节点。
您应该看到只有第一个订阅者节点接收来自两个主题的消息。
第二个订阅者节点无法在 /async_topic
中完成匹配过程,因为发布者阻止了它,因为它已经达到了匹配发布者的最大数量。
因此,只有来自 /sync_topic
的消息才会在第三个终端中接收:
[INFO] [1613127657.088860890] [sync_async_subscriber]: I heard: 'SYNC: Hello, world! 18'
[INFO] [1613127657.588896594] [sync_async_subscriber]: I heard: 'SYNC: Hello, world! 19'
[INFO] [1613127658.088849401] [sync_async_subscriber]: I heard: 'SYNC: Hello, world! 20'
在主题中使用分区
分区功能可用于控制哪些发布者和订阅者在同一主题内交换信息。
分区在域 ID 引起的物理隔离内引入了逻辑实体隔离级别概念。 发布者要与订阅者通信,他们必须至少属于一个公共分区。 分区代表了域和主题之外的另一个级别,用于将发布者和订阅者分开。 与域和主题不同,一个端点可以同时属于多个分区。 对于要在不同的域或主题上共享的某些数据,每个域或主题必须有不同的发布者,共享其自己的更改历史记录。 但是,单个发布者可以使用单个主题数据更改在不同的分区上共享相同的数据样本,从而减少网络过载。
让我们将 /sync_topic
发布者更改为分区 part1
,并创建一个使用分区 part2
的新 /sync_topic
订阅者。
他们的个人资料现在应如下所示:
<!-- publisher profile for topic sync_topic -->
<publisher profile_name="/sync_topic">
<historyMemoryPolicy>DYNAMIC</historyMemoryPolicy>
<qos>
<publishMode>
<kind>SYNCHRONOUS</kind>
</publishMode>
<partition>
<names>
<name>part1</name>
</names>
</partition>
</qos>
</publisher>
<!-- subscriber profile for topic sync_topic -->
<subscriber profile_name="/sync_topic">
<historyMemoryPolicy>DYNAMIC</historyMemoryPolicy>
<qos>
<partition>
<names>
<name>part2</name>
</names>
</partition>
</qos>
</subscriber>
打开两个终端。
不要忘记获取安装文件并设置所需的环境变量。
在第一个终端上运行发布者节点,在另一个终端上运行订阅者节点。
您应该看到只有 /async_topic
消息到达订阅者。
/sync_topic
订阅者未接收数据,因为它与相应的发布者位于不同的分区中。
[INFO] [1612972054.995410057] [sync_async_subscriber]: I heard: 'ASYNC: Hello, world! 10'
[INFO] [1612972055.995396561] [sync_async_subscriber]: I heard: 'ASYNC: Hello, world! 11'
[INFO] [1612972056.995473953] [sync_async_subscriber]: I heard: 'ASYNC: Hello, world! 12'
配置服务和客户端
服务和客户端各有一个发布者和一个订阅者,它们通过两个不同的主题进行通信。 例如,对于名为“ping”的服务,有:
服务订阅者在“/rq/ping”上监听请求。
服务发布者在“/rr/ping”上发送响应。
客户端发布者在“/rq/ping”上发送请求。
客户端订阅者在“/rr/ping”上监听响应。
虽然您可以使用这些主题名称在 XML 上设置配置文件,但有时您可能希望将相同的配置文件应用于节点上的所有服务或客户端。 您不必复制为所有服务生成的所有主题名称相同的配置文件,只需创建一个名为“service”的发布者和订阅者配置文件对即可。 对于创建名为“client”的对的客户端,也可以执行相同的操作。
创建具有服务和客户端的节点
开始创建带有服务的节点。 在您的包中添加一个名为“src/ping_service.cpp”的新源文件,其中包含以下内容:
#include <memory>
#include "rclcpp/rclcpp.hpp"
#include "example_interfaces/srv/trigger.hpp"
/**
* Service action: responds with success=true and prints the request on the console
*/
void ping(const std::shared_ptr<example_interfaces::srv::Trigger::Request> request,
std::shared_ptr<example_interfaces::srv::Trigger::Response> response)
{
// The request data is unused
(void) request;
// Build the response
response->success = true;
// Log to the console
RCLCPP_INFO(rclcpp::get_logger("ping_server"), "Incoming request");
RCLCPP_INFO(rclcpp::get_logger("ping_server"), "Sending back response");
}
int main(int argc, char **argv)
{
rclcpp::init(argc, argv);
// Create the node and the service
std::shared_ptr<rclcpp::Node> node = rclcpp::Node::make_shared("ping_server");
rclcpp::Service<example_interfaces::srv::Trigger>::SharedPtr service =
node->create_service<example_interfaces::srv::Trigger>("ping", &ping);
// Log that the service is ready
RCLCPP_INFO(rclcpp::get_logger("ping_server"), "Ready to serve.");
// run the node
rclcpp::spin(node);
rclcpp::shutdown();
}
在名为“src/ping_client.cpp”的文件中创建客户端,内容如下:
#include <chrono>
#include <memory>
#include "rclcpp/rclcpp.hpp"
#include "example_interfaces/srv/trigger.hpp"
using namespace std::chrono_literals;
int main(int argc, char **argv)
{
rclcpp::init(argc, argv);
// Create the node and the client
std::shared_ptr<rclcpp::Node> node = rclcpp::Node::make_shared("ping_client");
rclcpp::Client<example_interfaces::srv::Trigger>::SharedPtr client =
node->create_client<example_interfaces::srv::Trigger>("ping");
// Create a request
auto request = std::make_shared<example_interfaces::srv::Trigger::Request>();
// Wait for the service to be available
while (!client->wait_for_service(1s)) {
if (!rclcpp::ok()) {
RCLCPP_ERROR(rclcpp::get_logger("ping_client"), "Interrupted while waiting for the service. Exiting.");
return 0;
}
RCLCPP_INFO(rclcpp::get_logger("ping_client"), "Service not available, waiting again...");
}
// Now that the service is available, send the request
RCLCPP_INFO(rclcpp::get_logger("ping_client"), "Sending request");
auto result = client->async_send_request(request);
// Wait for the result and log it to the console
if (rclcpp::spin_until_future_complete(node, result) ==
rclcpp::FutureReturnCode::SUCCESS)
{
RCLCPP_INFO(rclcpp::get_logger("ping_client"), "Response received");
} else {
RCLCPP_ERROR(rclcpp::get_logger("ping_client"), "Failed to call service ping");
}
rclcpp::shutdown();
return 0;
}
打开“CMakeLists.txt”文件,添加两个新的可执行文件“ping_service”和“ping_client”:
find_package(example_interfaces REQUIRED)
add_executable(ping_service src/ping_service.cpp)
ament_target_dependencies(ping_service example_interfaces rclcpp)
add_executable(ping_client src/ping_client.cpp)
ament_target_dependencies(ping_client example_interfaces rclcpp)
install(TARGETS
ping_service
DESTINATION lib/${PROJECT_NAME})
install(TARGETS
ping_client
DESTINATION lib/${PROJECT_NAME})
最后,构建包。
为服务和客户端创建 XML 配置文件
创建一个名为“ping.xml”的文件,内容如下:
<?xml version="1.0" encoding="UTF-8" ?>
<profiles xmlns="http://www.eprosima.com/XMLSchemas/fastRTPS_Profiles">
<!-- default publisher profile -->
<publisher profile_name="default_publisher" is_default_profile="true">
<historyMemoryPolicy>DYNAMIC</historyMemoryPolicy>
</publisher>
<!-- default subscriber profile -->
<subscriber profile_name="default_subscriber" is_default_profile="true">
<historyMemoryPolicy>DYNAMIC</historyMemoryPolicy>
</subscriber>
<!-- service publisher is SYNC -->
<publisher profile_name="service">
<historyMemoryPolicy>DYNAMIC</historyMemoryPolicy>
<qos>
<publishMode>
<kind>SYNCHRONOUS</kind>
</publishMode>
</qos>
</publisher>
<!-- client publisher is ASYNC -->
<publisher profile_name="client">
<historyMemoryPolicy>DYNAMIC</historyMemoryPolicy>
<qos>
<publishMode>
<kind>ASYNCHRONOUS</kind>
</publishMode>
</qos>
</publisher>
</profiles>
此配置文件将服务上的发布模式设置为“同步”,将客户端上的发布模式设置为“异步”。
请注意,我们只为服务和客户端定义发布者配置文件,但也可以提供订阅者配置文件。
执行节点
打开两个终端并在每个终端上获取安装文件。 然后设置要加载的 XML 所需的环境变量:
export RMW_IMPLEMENTATION=rmw_fastrtps_cpp
export RMW_FASTRTPS_USE_QOS_FROM_XML=1
export FASTRTPS_DEFAULT_PROFILES_FILE=path/to/ping.xml
export RMW_IMPLEMENTATION=rmw_fastrtps_cpp
export RMW_FASTRTPS_USE_QOS_FROM_XML=1
export FASTRTPS_DEFAULT_PROFILES_FILE=path/to/ping.xml
SET RMW_IMPLEMENTATION=rmw_fastrtps_cpp
SET RMW_FASTRTPS_USE_QOS_FROM_XML=1
SET FASTRTPS_DEFAULT_PROFILES_FILE=path/to/ping.xml
在第一个终端上运行服务节点。
ros2 run sync_async_node_example_cpp ping_service
您应该看到服务正在等待请求:
[INFO] [1612977403.805799037] [ping_server]: Ready to serve
在第二个终端上,运行客户端节点。
ros2 run sync_async_node_example_cpp ping_client
您应该看到客户端发送请求并接收响应:
[INFO] [1612977404.805799037] [ping_client]: Sending request
[INFO] [1612977404.825473835] [ping_client]: Response received
同时,服务器控制台中的输出也已经更新:
[INFO] [1612977403.805799037] [ping_server]: Ready to serve
[INFO] [1612977404.807314904] [ping_server]: Incoming request
[INFO] [1612977404.836405125] [ping_server]: Sending back response