ROS一个node中实现topic 发布和订阅 subscber

ROS中实现一个node中建立发布和订阅

在person_subscber2中实现消息的发布,同时实现监听。

person_subscber2 中代码

代码是在古月居上面进行的修改,感谢古月

其中最重要的地方主要是去掉 ros::spin(); 如果有ros::spin(); 就不会进入while循环,实现不了topic信息发布
在while循环中加入 ros::spinOnce(); 实现 监听

!!!要注意的事情!!!

因为person_subscber2 是发布的while循环中实现的监听,那也就以为着这个监听频率是跟发布的频率相关,也和监听缓冲区有关,当person_publlsher 中的发布频率超过 person_subscber2*缓冲区大小时 就会产生消息溢出,部分消息丢失。
如果想避免消息的丢失要合理设置监听缓冲区大小。
还有一个问题:这样的监听不具有实时性!!!
此处主要是进行实验验证~

/***********************************************************************
Copyright 2020 GuYueHome (www.guyuehome.com).
***********************************************************************/

/**
 * 该例程将订阅/person_info话题,自定义消息类型learning_topic::Person
 */
 
#include <ros/ros.h>
#include "learning_topic/Person.h"

// 接收到订阅的消息后,会进入消息回调函数
void personInfoCallback(const learning_topic::Person::ConstPtr& msg)
{
    // 将接收到的消息打印出来
    ROS_INFO("Subcribe2 Person Info: name:%s  age:%d  sex:%d", 
			 msg->name.c_str(), msg->age+1, msg->sex);
}

int main(int argc, char **argv)
{
    // 初始化ROS节点
    ros::init(argc, argv, "person_subscriber2");

    // 创建节点句柄
    ros::NodeHandle n;

    // 创建一个Subscriber,订阅名为/person_info的topic,注册回调函数personInfoCallback
    ros::Subscriber person_info_sub = n.subscribe("/person_info1", 10, personInfoCallback);
    //ros::spin();

    ros::Publisher person_info_pub3 = n.advertise<learning_topic::Person>("/person_info3", 10);
    ros::Rate loop_rate(1);
    // 循环等待回调函数
    
    while (ros::ok())
    {
        // 初始化learning_topic::Person类型的消息
        learning_topic::Person person_msg3;
        person_msg3.name = "gao";
        person_msg3.age  = 30;
        person_msg3.sex  = learning_topic::Person::female;

        // 发布消息
        person_info_pub3.publish(person_msg3);

        ROS_INFO("Publish3 Person Info: name:%s  age:%d  sex:%d", 
                  person_msg3.name.c_str(), person_msg3.age, person_msg3.sex);

        ros::spinOnce();
        

        // 按照循环频率延时
        loop_rate.sleep();
    }
    return 0;
}

person_publher中代码 基本完全辅助 古月的

/***********************************************************************
Copyright 2020 GuYueHome (www.guyuehome.com).
***********************************************************************/

/**
 * 该例程将发布/person_info话题,自定义消息类型learning_topic::Person
 */
 
#include <ros/ros.h>
#include "learning_topic/Person.h"

int main(int argc, char **argv)
{
    // ROS节点初始化
    ros::init(argc, argv, "person_publisher");

    // 创建节点句柄
    ros::NodeHandle n;

    // 创建一个Publisher,发布名为/person_info的topic,消息类型为learning_topic::Person,队列长度10
    ros::Publisher person_info_pub1 = n.advertise<learning_topic::Person>("/person_info1", 10);
    //ros::Publisher person_info_pub2 = n.advertise<learning_topic::Person>("/person_info2", 10);

    // 设置循环的频率  hz
    ros::Rate loop_rate(1);

    int count = 0;
    while (ros::ok())
    {
        // 初始化learning_topic::Person类型的消息
    	learning_topic::Person person_msg1;
		person_msg1.name = "Tom";
		person_msg1.age  = 18;
		person_msg1.sex  = learning_topic::Person::female;

        learning_topic::Person person_msg2;
        person_msg2.name = "luo";
        person_msg2.age  = 30;
        person_msg2.sex  = learning_topic::Person::male;

        // 发布消息
        person_info_pub1.publish(person_msg1);
        person_info_pub1.publish(person_msg2);

        ROS_INFO("Publish1 Person Info: name:%s  age:%d  sex:%d", 
                  person_msg1.name.c_str(), person_msg1.age, person_msg1.sex);
        ROS_INFO("Publish2 Person Info: name:%s  age:%d  sex:%d", 
                 person_msg2.name.c_str(), person_msg2.age, person_msg2.sex);

        ros::spinOnce();

        // 按照循环频率延时
        loop_rate.sleep();
    }

    return 0;
}

person_subscriber.cpp 中代码

/***********************************************************************
Copyright 2020 GuYueHome (www.guyuehome.com).
***********************************************************************/

/**
 * 该例程将订阅/person_info话题,自定义消息类型learning_topic::Person
 */
 
#include <ros/ros.h>
#include "learning_topic/Person.h"

// 接收到订阅的消息后,会进入消息回调函数
void personInfoCallback(const learning_topic::Person::ConstPtr& msg)
{
    // 将接收到的消息打印出来
    ROS_INFO("Subcribe Person Info: name:%s  age:%d  sex:%d", 
			 msg->name.c_str(), msg->age, msg->sex);
}

int main(int argc, char **argv)
{
    // 初始化ROS节点
    ros::init(argc, argv, "person_subscriber");

    // 创建节点句柄
    ros::NodeHandle n;

    // 创建一个Subscriber,订阅名为/person_info的topic,注册回调函数personInfoCallback
    ros::Subscriber person_info_sub = n.subscribe("/person_info3", 10, personInfoCallback);

    // 循环等待回调函数
    ros::spin();

    return 0;
}

  • 0
    点赞
  • 3
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值