掘金 人工智能 04月27日 12:43
ROS2 Jazzy:创建自定义的消息和服务接口(C++)
index_new5.html
../../../zaker_core/zaker_tpl_static/wap/tpl_guoji1.html

 

本文介绍了如何在ROS2中创建和使用自定义的消息和服务接口。首先,创建一个独立的ROS2软件包用于存放自定义的.msg和.srv文件,并在其中定义消息和服务的数据结构。接着,配置CMakeLists.txt和package.xml文件,添加必要的依赖和编译选项。编译该软件包后,可以使用ros2 interface show命令验证接口是否成功创建。最后,通过修改之前的发布/订阅和服务/客户端软件包,演示了如何实际应用这些自定义接口,包括发布数值消息和使用三整数加法服务。

📦 创建自定义接口软件包:在ROS2工作空间中,创建一个独立的软件包(如tutorial_interfaces)来存放自定义的.msg和.srv文件,用于定义消息和服务的数据结构。

⚙️ 配置CMakeLists.txt和package.xml:在CMakeLists.txt中,使用`find_package`添加geometry_msgs和rosidl_default_generators依赖,并使用`rosidl_generate_interfaces`将定义的接口文件转换为特定语言的代码。在package.xml中,添加geometry_msgs依赖,以及rosidl_default_generators和rosidl_default_runtime的编译和执行依赖,并将软件包加入rosidl_interface_packages组。

🧪 验证接口创建:编译自定义接口软件包后,使用`ros2 interface show`命令来确认接口是否成功创建,检查返回的消息和服务定义是否正确。

📡 实际应用自定义接口:通过修改已有的发布/订阅和服务/客户端软件包,将标准的消息和服务替换为自定义的接口,例如将字符串消息替换为数值消息Num.msg,或将两整数加法服务替换为三整数加法服务AddThreeInts.srv,验证自定义接口的可用性。

目标

创建自定义的接口文件(.msg.srv),并在节点中使用它们。

背景信息

在之前的教程中,你使用消息和服务接口学习了话题、服务,以及简单的发布者/订阅者(C++)和服务/客户端节点。在那些案例中,你使用的接口是预先定义好的。

虽然使用预定义的接口定义是一种良好的做法,但有时你可能也需要定义自己的消息和服务。本文将向你介绍创建自定义接口定义的最简单方法。

先决条件

你应该有一个 ROS2 工作空间。

本文还会使用之前在发布者/订阅者以及服务/客户端教程中创建的软件包来测试新的自定义消息。

操作步骤

1. 创建一个新的软件包

在本文中,你将在一个单独的软件包中创建自定义的 .msg.srv 文件,然后在另一个软件包中使用它们。这两个软件包应该位于同一个工作空间中。

由于我们将使用之前教程中创建的发布/订阅和服务/客户端软件包,所以请确保你处于与这些软件包相同的工作空间(ros2_ws/src)中,然后运行以下命令来创建一个新的软件包:

ros2 pkg create --build-type ament_cmake --license Apache-2.0 tutorial_interfaces

tutorial_interfaces 是新软件包的名称。请注意,虽然它只能是一个 CMake 软件包,但这并不限制你在何种类型的软件包中使用你的消息和服务。你可以在一个 CMake 软件包中创建自己的自定义接口,然后在 C++ 或 Python 节点中使用它,这将在最后一部分进行介绍。

.msg.srv 文件需要分别放在名为 msgsrv 的目录中。在 ros2_ws/src/tutorial_interfaces 中创建这些目录:

mkdir msg srv
2. 创建自定义消息和服务
2.1 msg 定义

在你刚刚创建的 tutorial_interfaces/msg 目录中,创建一个名为 Num.msg 的新文件,其中包含一行代码来声明其数据结构:

int64 num

这是一个自定义消息,用于传输一个名为 num 的 64 位整数。

同样在你刚刚创建的 tutorial_interfaces/msg 目录中,创建一个名为 Sphere.msg 的新文件,内容如下:

geometry_msgs/Point centerfloat64 radius

这个自定义消息使用了另一个消息包中的消息(在这种情况下是 geometry_msgs/Point)。

2.2 srv 定义

回到你刚刚创建的 tutorial_interfaces/srv 目录,创建一个名为 AddThreeInts.srv 的新文件,其请求和响应结构如下:

int64 aint64 bint64 c---int64 sum

这是你的自定义服务,它请求三个名为 abc 的整数,并以一个名为 sum 的整数作为响应。

3. CMakeLists.txt 文件配置

为了将你定义的接口转换为特定语言的代码(如 C++ 和 Python),以便在这些语言中使用,将以下行添加到 CMakeLists.txt 中:

find_package(geometry_msgs REQUIRED)find_package(rosidl_default_generators REQUIRED)rosidl_generate_interfaces(${PROJECT_NAME}  "msg/Num.msg"  "msg/Sphere.msg"  "srv/AddThreeInts.srv"  DEPENDENCIES geometry_msgs # 添加上述消息所依赖的软件包,在这种情况下,Sphere.msg 依赖于 geometry_msgs)

注意rosidl_generate_interfaces 中的第一个参数(库名)必须以软件包的名称开头,例如,简单地使用 ${PROJECT_NAME}${PROJECT_NAME}_suffix。具体请参阅 github.com/ros2/rosidl…

4. package.xml 文件配置

由于接口依赖于 rosidl_default_generators 来生成特定语言的代码,你需要声明对它的编译工具依赖。rosidl_default_runtime 是一个运行时或执行阶段的依赖项,后续使用接口时需要它。你的接口依赖rosidl_interface_packages group,所以你的软件包 tutorial_interfaces 应该使用 <member_of_group> 标签与之关联。

package.xml<package> 元素内添加以下行:

<depend>geometry_msgs</depend><buildtool_depend>rosidl_default_generators</buildtool_depend><exec_depend>rosidl_default_runtime</exec_depend><member_of_group>rosidl_interface_packages</member_of_group>
5. 编译 tutorial_interfaces 软件包

现在,你自定义接口软件包的所有部分都已就位,你可以编译该软件包了。在你的工作空间根目录(~/ros2_ws)中,运行以下命令:

colcon build --packages-select tutorial_interfaces

现在,其他 ROS2 软件包就可以发现这些接口了。

6. 确认 msg 和 srv 文件已创建

在一个新的终端中,在你的工作空间(ros2_ws)内运行以下命令来加载环境:

source install/setup.bash

现在,你可以使用 ros2 interface show 命令来确认你的接口创建是否成功:

ros2 interface show tutorial_interfaces/msg/Num

应该返回:

int64 num

以及

ros2 interface show tutorial_interfaces/msg/Sphere

应该返回:

geometry_msgs/Point center        float64 x        float64 y        float64 zfloat64 radius

还有

ros2 interface show tutorial_interfaces/srv/AddThreeInts

应该返回:

int64 aint64 bint64 c---int64 sum
7. 测试新接口

在这一步,你可以使用在之前教程中创建的软件包。对节点CMakeLists.txtpackage.xml 文件进行一些简单的修改,就可以使用你的新接口了。

7.1 使用发布/订阅测试 Num.msg

对之前教程中创建的发布者/订阅者软件包进行一些修改,你就可以看到 Num.msg 的实际应用了。由于你将把标准的字符串消息改为数值消息,输出会稍有不同。

发布者(C++)

#include <chrono>#include <memory>#include "rclcpp/rclcpp.hpp"#include "tutorial_interfaces/msg/num.hpp"  // 新的num msg 头文件using namespace std::chrono_literals;class MinimalPublisher : public rclcpp::Node{public:  MinimalPublisher()  : Node("minimal_publisher"), count_(0)  {    publisher_ = this->create_publisher<tutorial_interfaces::msg::Num>("topic", 10);  // 创建num msg发布者    auto timer_callback = [this](){      auto message = tutorial_interfaces::msg::Num();                                   // 建num msg      message.num = this->count_++;                                                     // 增加计数      RCLCPP_INFO_STREAM(this->get_logger(), "Publishing: '" << message.num << "'");    // 输出message.num日志      publisher_->publish(message);    };    timer_ = this->create_wall_timer(500ms, timer_callback);  }private:  rclcpp::TimerBase::SharedPtr timer_;  rclcpp::Publisher<tutorial_interfaces::msg::Num>::SharedPtr publisher_;             // 定义num msg发布者  size_t count_;};int main(int argc, char * argv[]){  rclcpp::init(argc, argv);  rclcpp::spin(std::make_shared<MinimalPublisher>());  rclcpp::shutdown();  return 0;}

订阅者(C++)

#include <functional>#include <memory>#include "rclcpp/rclcpp.hpp"#include "tutorial_interfaces/msg/num.hpp" // 新的num msg 头文件using std::placeholders::_1;class MinimalSubscriber : public rclcpp::Node{public:  MinimalSubscriber()  : Node("minimal_subscriber")  {    auto topic_callback = [this](const tutorial_interfaces::msg::Num & msg){     // 创建 num msg 定阅者回回调      RCLCPP_INFO_STREAM(this->get_logger(), "I heard: '" << msg.num << "'");    // 收到 msg msg 后输出日志    };    subscription_ = this->create_subscription<tutorial_interfaces::msg::Num>(    // 创建定阅者      "topic", 10, topic_callback);  }private:  rclcpp::Subscription<tutorial_interfaces::msg::Num>::SharedPtr subscription_;  // 定义定阅者};int main(int argc, char * argv[]){  rclcpp::init(argc, argv);  rclcpp::spin(std::make_shared<MinimalSubscriber>());  rclcpp::shutdown();  return 0;}

CMakeLists.txt(C++)添加以下行:

#...find_package(ament_cmake REQUIRED)find_package(rclcpp REQUIRED)find_package(tutorial_interfaces REQUIRED)                      # 添加依赖add_executable(talker src/publisher_member_function.cpp)ament_target_dependencies(talker rclcpp tutorial_interfaces)    # 增加可执行文件add_executable(listener src/subscriber_member_function.cpp)ament_target_dependencies(listener rclcpp tutorial_interfaces)  # 增加可执行文件install(TARGETS  talker  listener  DESTINATION lib/${PROJECT_NAME})ament_package()

package.xml添加以下行:

<depend>tutorial_interfaces</depend>

进行上述编辑并保存所有更改后,编译软件包:

colcon build --packages-select cpp_pubsub
colcon build --merge-install --packages-select cpp_pubsub

然后打开两个新终端,在每个终端中加载 ros2_ws 环境,然后运行:

ros2 run cpp_pubsub talkerros2 run cpp_pubsub listener

由于 Num.msg 只传递一个整数,发布者应该发布整数值,而不是之前发布的字符串:

[INFO] [minimal_publisher]: Publishing: '0'[INFO] [minimal_publisher]: Publishing: '1'[INFO] [minimal_publisher]: Publishing: '2'
7.2 使用服务/客户端测试 AddThreeInts.srv

对之前教程中创建的服务/客户端软件包(C++ 或 Python)进行一些修改,你就可以看到 AddThreeInts.srv 的实际应用了。由于你将把原来的两个整数请求服务改为三个整数请求服务,输出会稍有不同。

服务端(C++)

#include "rclcpp/rclcpp.hpp"#include "tutorial_interfaces/srv/add_three_ints.hpp"                                        // 更改#include <memory>void add(const std::shared_ptr<tutorial_interfaces::srv::AddThreeInts::Request> request,     // 更改          std::shared_ptr<tutorial_interfaces::srv::AddThreeInts::Response>       response)  // 更改{  response->sum = request->a + request->b + request->c;                                      // 更改  RCLCPP_INFO(rclcpp::get_logger("rclcpp"), "Incoming request\na: %ld" " b: %ld" " c: %ld",  // 更改                request->a, request->b, request->c);                                         // 更改  RCLCPP_INFO(rclcpp::get_logger("rclcpp"), "sending back response: [%ld]", (long int)response->sum);}int main(int argc, char **argv){  rclcpp::init(argc, argv);  std::shared_ptr<rclcpp::Node> node = rclcpp::Node::make_shared("add_three_ints_server");   // 更改  rclcpp::Service<tutorial_interfaces::srv::AddThreeInts>::SharedPtr service =               // 更改    node->create_service<tutorial_interfaces::srv::AddThreeInts>("add_three_ints",  &add);   // 更改  RCLCPP_INFO(rclcpp::get_logger("rclcpp"), "Ready to add three ints.");                     // 更改  rclcpp::spin(node);  rclcpp::shutdown();}

客户端(C++)

#include "rclcpp/rclcpp.hpp"#include "tutorial_interfaces/srv/add_three_ints.hpp"                                       // 更改#include <chrono>#include <cstdlib>#include <memory>using namespace std::chrono_literals;int main(int argc, char **argv){  rclcpp::init(argc, argv);  if (argc != 4) { // 更改      RCLCPP_INFO(rclcpp::get_logger("rclcpp"), "usage: add_three_ints_client X Y Z");      // 更改      return 1;  }  std::shared_ptr<rclcpp::Node> node = rclcpp::Node::make_shared("add_three_ints_client");  // 更改  rclcpp::Client<tutorial_interfaces::srv::AddThreeInts>::SharedPtr client =                // 更改    node->create_client<tutorial_interfaces::srv::AddThreeInts>("add_three_ints");          // 更改  auto request = std::make_shared<tutorial_interfaces::srv::AddThreeInts::Request>();       // 更改  request->a = atoll(argv[1]);  request->b = atoll(argv[2]);  request->c = atoll(argv[3]);                                                              // 更改  while (!client->wait_for_service(1s)) {    if (!rclcpp::ok()) {      RCLCPP_ERROR(rclcpp::get_logger("rclcpp"), "Interrupted while waiting for the service. Exiting.");      return 0;    }    RCLCPP_INFO(rclcpp::get_logger("rclcpp"), "service not available, waiting again...");  }  auto result = client->async_send_request(request);  // 等待结果  if (rclcpp::spin_until_future_complete(node, result) ==    rclcpp::FutureReturnCode::SUCCESS)  {    RCLCPP_INFO(rclcpp::get_logger("rclcpp"), "Sum: %ld", result.get()->sum);  } else {    RCLCPP_ERROR(rclcpp::get_logger("rclcpp"), "Failed to call service add_three_ints");    // 更改  }  rclcpp::shutdown();  return 0;}

CMakeLists.txt(C++)添加以下行:

#...find_package(ament_cmake REQUIRED)find_package(rclcpp REQUIRED)find_package(tutorial_interfaces REQUIRED)         # 更改add_executable(server src/add_two_ints_server.cpp)ament_target_dependencies(server  rclcpp tutorial_interfaces)                      # 更改add_executable(client src/add_two_ints_client.cpp)ament_target_dependencies(client  rclcpp tutorial_interfaces)                      # 更改install(TARGETS  server  client  DESTINATION lib/${PROJECT_NAME})ament_package()

package.xml添加以下行:

<depend>tutorial_interfaces</depend>

进行上述编辑并保存所有更改后,构建软件包:

colcon build --packages-select cpp_srvcli
colcon build --merge-install --packages-select cpp_srvcli

然后打开两个新终端,在每个终端中加载 ros2_ws 环境,然后运行:

ros2 run cpp_srvcli serverros2 run cpp_srvcli client 2 3 1

总结

在本教程中,你学习了如何在自己的软件包中创建自定义接口,以及如何在其他软件包中使用这些接口。


关注【智践行】公众号,发送 【机器人】 获得机器人经典学习资料

Fish AI Reader

Fish AI Reader

AI辅助创作,多种专业模板,深度分析,高质量内容生成。从观点提取到深度思考,FishAI为您提供全方位的创作支持。新版本引入自定义参数,让您的创作更加个性化和精准。

FishAI

FishAI

鱼阅,AI 时代的下一个智能信息助手,助你摆脱信息焦虑

联系邮箱 441953276@qq.com

相关标签

ROS2 自定义接口 消息 服务
相关文章