gazebo_plugin设定频率发布话题数据

最新推荐文章于 2024-08-03 23:54:38 发布

流浪者1015

最新推荐文章于 2024-08-03 23:54:38 发布

阅读量259

点赞数 1

分类专栏： ROS 常见知识点总结文章标签： ROS ubuntu

本文链接：https://blog.csdn.net/qq_35598561/article/details/138450424

版权

ROS 常见知识点总结专栏收录该内容

40 篇文章 5 订阅

订阅专栏

本文介绍了如何在Gazebo中创建一个简单的ROSPublisherPlugin，用于定期模拟发布`std_msgs::String`类型的消息，以满足特定场景下的数据源需求。

摘要由CSDN通过智能技术生成

一、引言：在某些场景下，需要使用Gazebo场景发布话题数据来模拟真实的数据源，此处仅简单设置发布ROS话题数据，按照预定的频率

#include <gazebo/gazebo.hh>
#include <ros/ros.h>
#include <std_msgs/String.h>

namespace gazebo
{
  class ROSPublisherPlugin : public WorldPlugin
  {
  public:
    void Load(physics::WorldPtr _world, sdf::ElementPtr _sdf) override
    {
      // Initialize ROS node
      ros::NodeHandle nh;

      // Create a ROS publisher
      pub = nh.advertise<std_msgs::String>("gazebo_topic", 10);

      // Create a Gazebo update event connection
      this->updateConnection = event::Events::ConnectWorldUpdateBegin(
          std::bind(&ROSPublisherPlugin::OnUpdate, this));
    }

    void OnUpdate()
    {
      if ((ros::Time::now() - lastPubTime)>= ros::Duration(0.1))
      {
        std_msgs::String msg;
        msg.data = "Hello, world";
        pub.publish(msg);
        lastPubTime = ros::Time::now();
      }
    }

  private:
    ros::Publisher pub;
        ros::Time lastPubTime;
    event::ConnectionPtr updateConnection;
  };

  GZ_REGISTER_WORLD_PLUGIN(ROSPublisherPlugin)
} // namespace gazebo

注：此处通过时间判断进行循环发布

 void OnUpdate()
    {
      if ((ros::Time::now() - lastPubTime)>= ros::Duration(0.1))
      {
        std_msgs::String msg;
        msg.data = "Hello, world";
        pub.publish(msg);
        lastPubTime = ros::Time::now();
      }
    }