ROS2学习之路之话题发布(Publisher)

主要代码:

//topic-pub
rclcpp::Publisher<std_msgs::msg::String>::SharedPtr publisher_;
publisher_ = nodePtr_->create_publisher<std_msgs::msg::String>("topic", 10);
publisher_->publish(msg);

eg.1


#include <rclcpp/rclcpp.hpp>
#include <std_msgs/msg/int8.hpp>
#include <chrono>
#include <functional>
#include <memory>
#include <string>
#include "std_msgs/msg/string.hpp"

using namespace std::chrono_literals;


class MinimalPublisher
{
  private:
    rclcpp::Node::SharedPtr nodePtr_;
    rclcpp::TimerBase::SharedPtr timer_;
    rclcpp::Publisher<std_msgs::msg::String>::SharedPtr publisher_;
    size_t count_;
  public:
    MinimalPublisher(rclcpp::Node::SharedPtr& nodePtr):nodePtr_(nodePtr),count_(0)
    {
      publisher_ = nodePtr_->create_publisher<std_msgs::msg::String>("topic", 10);
      timer_ = nodePtr_->create_wall_timer(500ms, std::bind(&MinimalPublisher::timer_callback, this));
    }
    void timer_callback()
    {
      auto message = std_msgs::msg::String();
      message.data = "Hello, world! " + std::to_string(count_++);
      RCLCPP_INFO(nodePtr_->get_logger(), "Publishing: '%s'", message.data.c_str());
      publisher_->publish(message);
    }

};

int main(int argc, char** argv) {
  rclcpp::init(argc, argv);

  auto nodePtr = rclcpp::Node::make_shared("mpac_points_filter");
  auto heartBeatPubPtr = nodePtr->create_publisher<std_msgs::msg::Int8>("heartBeat", 10);

  std_msgs::msg::Int8 heartBeatData;
  heartBeatData.data = 6;  //6-filter node
  auto heartBeatTimer = nodePtr->create_wall_timer(std::chrono::seconds(1), [heartBeatPubPtr, heartBeatData]() { heartBeatPubPtr->publish(heartBeatData); });
  
  MinimalPublisher vc(nodePtr);

  rclcpp::spin(nodePtr);
  rclcpp::shutdown();

  return 0;
}

//topic-pub
rclcpp::Publisher<std_msgs::msg::String>::SharedPtr publisher_;
publisher_ = nodePtr_->create_publisher<std_msgs::msg::String>("topic", 10);
publisher_->publish(message);
  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
ROS中,你可以使用多线程来同时订阅和发布多个话题。下面是一个简单的示例代码,该代码使用三个线程同时订阅和发布三个不同的话题: ```c++ #include <ros/ros.h> #include <std_msgs/Int32.h> #include <thread> void thread1() { ros::NodeHandle n; ros::Publisher pub = n.advertise<std_msgs::Int32>("topic1", 1000); ros::Rate loop_rate(10); int count = 0; while (ros::ok()) { std_msgs::Int32 msg; msg.data = count; pub.publish(msg); ros::spinOnce(); loop_rate.sleep(); ++count; } } void thread2() { ros::NodeHandle n; ros::Publisher pub = n.advertise<std_msgs::Int32>("topic2", 1000); ros::Rate loop_rate(5); int count = 0; while (ros::ok()) { std_msgs::Int32 msg; msg.data = count; pub.publish(msg); ros::spinOnce(); loop_rate.sleep(); ++count; } } void thread3() { ros::NodeHandle n; ros::Subscriber sub = n.subscribe("topic3", 1000, [](const std_msgs::Int32::ConstPtr& msg) { ROS_INFO("Received: %d", msg->data); }); ros::spin(); } int main(int argc, char **argv) { ros::init(argc, argv, "multi_threads"); std::thread t1(thread1); std::thread t2(thread2); std::thread t3(thread3); t1.join(); t2.join(); t3.join(); return 0; } ``` 在这个例子中,我们创建了一个名为 `multi_threads` 的 ROS 节点,并在其中启动了三个线程。`thread1` 和 `thread2` 分别发布名为 `topic1` 和 `topic2` 的 `Int32` 消息,而 `thread3` 则订阅名为 `topic3` 的 `Int32` 消息,并输出接收到的消息。三个线程都使用了 `ros::spinOnce()` 函数来处理 ROS 事件,并使用了不同的发布和订阅频率。最后,在 `main` 函数中,我们使用 `std::thread` 类创建了三个线程,并等待它们全部完成后退出程序。 请注意,这只是一个简单的示例,如果你需要同时订阅和发布更多的话题,你需要确保你的代码可以处理更多的线程并发。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值