在ROS 2(Robot Operating System 2)中,節(jié)點(diǎn)之間的通信主要通過(guò)話題(Topics)、服務(wù)(Services)和動(dòng)作(Actions)來(lái)實(shí)現(xiàn)。下面是一個(gè)簡(jiǎn)單的C++ ROS 2節(jié)點(diǎn)通信示例,包括一個(gè)發(fā)布者(Publisher)和一個(gè)訂閱者(Subscriber)。
首先,確保你已經(jīng)安裝了ROS 2和相應(yīng)的開發(fā)工具。
創(chuàng)建一個(gè)新的ROS 2工作空間和包:
mkdir -p ~/ros2_ws/src
cd ~/ros2_ws/src
colcon build --symlink-install
source install/setup.bash
package.xml
文件中添加以下內(nèi)容,以創(chuàng)建一個(gè)名為my_package
的包,其中包含一個(gè)發(fā)布者(Publisher)和一個(gè)訂閱者(Subscriber):<package name="my_package" version="0.0.0">
<description>My ROS 2 package with publisher and subscriber</description>
<license>Apache License 2.0</license>
<authors>
<author email="user@example.com">Your Name</author>
</authors>
<build_type>ament_cmake</build_type>
<dependencies>
<dependency>rclcpp</dependency>
<dependency>std_msgs</dependency>
</dependencies>
</package>
創(chuàng)建一個(gè)名為my_package/src
的文件夾,并在其中創(chuàng)建兩個(gè)C++源文件:publisher.cpp
和subscriber.cpp
。
在publisher.cpp
文件中,編寫一個(gè)發(fā)布者節(jié)點(diǎn),用于發(fā)布名為my_topic
的話題:
#include <iostream>
#include <memory>
#include "rclcpp/rclcpp.hpp"
#include "std_msgs/msg/string.hpp"
class Publisher : public rclcpp::Node {
public:
Publisher() : Node("publisher") {
publisher_ = this->create_publisher<std_msgs::msg::String>("my_topic", 10);
timer_ = this->create_wall_timer(1000ms, std::bind(&Publisher::publish_message, this));
}
private:
void publish_message() {
auto message = std_msgs::msg::String();
message.data = "Hello, ROS 2!";
publisher_->publish(message);
RCLCPP_INFO(this->get_logger(), "Published: '%s'", message.data.c_str());
}
std::shared_ptr<rclcpp::Publisher<std_msgs::msg::String>> publisher_;
std::shared_ptr<rclcpp::TimerBase> timer_;
};
int main(int argc, char *argv[]) {
rclcpp::init(argc, argv);
rclcpp::spin(std::make_shared<Publisher>());
rclcpp::shutdown();
return 0;
}
subscriber.cpp
文件中,編寫一個(gè)訂閱者節(jié)點(diǎn),用于訂閱名為my_topic
的話題:#include <iostream>
#include <memory>
#include "rclcpp/rclcpp.hpp"
#include "std_msgs/msg/string.hpp"
class Subscriber : public rclcpp::Node {
public:
Subscriber() : Node("subscriber") {
subscription_ = this->create_subscription<std_msgs::msg::String>("my_topic", 10, std::bind(&Subscriber::callback, this, std::placeholders::_1));
}
private:
void callback(const std_msgs::msg::String::SharedPtr msg) {
RCLCPP_INFO(this->get_logger(), "Received: '%s'", msg->data.c_str());
}
std::shared_ptr<rclcpp::Subscription<std_msgs::msg::String>> subscription_;
};
int main(int argc, char *argv[]) {
rclcpp::init(argc, argv);
rclcpp::spin(std::make_shared<Subscriber>());
rclcpp::shutdown();
return 0;
}
my_package
文件夾中創(chuàng)建一個(gè)名為CMakeLists.txt
的文件,用于編譯源文件:cmake_minimum_required(VERSION 3.5)
project(my_package)
find_package(ament_cmake REQUIRED)
find_package(rclcpp REQUIRED)
find_package(std_msgs REQUIRED)
add_executable(publisher src/publisher.cpp)
add_executable(subscriber src/subscriber.cpp)
ament_target_dependencies(publisher rclcpp std_msgs)
ament_target_dependencies(subscriber rclcpp std_msgs)
install(TARGETS publisher subscriber LIBRARY DESTINATION ${CATKIN_PACKAGE_LIB_DESTINATION})
cd ~/ros2_ws
colcon build --symlink-install
source install/setup.bash
ros2 run my_package publisher
ros2 run my_package subscriber
現(xiàn)在,你應(yīng)該能看到發(fā)布者在每隔1秒發(fā)布一條消息,而訂閱者則接收并打印這些消息。這就是一個(gè)簡(jiǎn)單的C++ ROS 2節(jié)點(diǎn)通信示例。你可以根據(jù)需要擴(kuò)展此示例,以實(shí)現(xiàn)更復(fù)雜的消息傳遞和處理邏輯。