12th 自定义msg的使用之消息订阅方(C++)

一、目标

编写发布订阅实现,要求发布方以10HZ(每秒10次)的频率发布自定义消息,订阅方订阅自定义消息并将消息内容打印输出。

二、分析

在模型实现中,ROS master 不需要实现,而连接的建立也已经被封装了,需要关注的关键点有三个:发布方、接收方、数据(此处为自定义消息)

流程:

  • 编写发布方实现;
  • 编写订阅方实现;
  • 编辑配置文件;
  • 编译并执行。

三、订阅方的实现

创建文件:

编写内容:

#include<ros/ros.h>
/*  #include<std_msgs/String.h> */
#include<plumbing_pub_sub/Person.h>   //刚刚自定义的头文件

/*
     订阅方:订阅人的消息
     1.包含头文件
     2.初始化节点
     3.创建ros的节点句柄
     4.创建订阅者对象
     5.编写回调函数,处理订阅的数据
     6.spin()  ,调用回调函数必须要有这句话
*/
void doPerson(const plumbing_pub_sub::Person::ConstPtr& person )
{
    ROS_INFO("订阅人的信息:%s,%d,%.2f",person->name.c_str(),person->age,person->height);
}

int main(int argc,char *argv[])
{
    setlocale(LC_ALL,"");
     //  2.初始化节点
    ros::init(argc,argv,"Person_msgs_sub");   
    //  3.创建ros的节点句柄
    ros::NodeHandle  nh;
    //  4.创建订阅者对象
    ros::Subscriber sub=nh.subscribe("LiaoTian",10,doPerson);
    //5.处理订阅的数据

    //6.调用spin()函数
    ros::spin();
    
    return 0;
}

配置编译文件CMakelist.txt:

编译:Ctrl + Shift +B

四、订阅发测试

  • 1
    点赞
  • 2
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 0
    评论
要将自定义消息类型通过UDP发送,需要按以下步骤进行操作: 1. 定义自定义消息类型 在ROS中,自定义消息类型通常是通过.msg文件定义的。您可以使用ROS提供的标准消息类型,也可以自己定义消息类型。例如,假设您希望定义一个名为“my_message”的自定义消息类型,可以按照以下步骤进行操作: - 在ROS工作空间中创建一个名为“my_message”的包。 - 在该包中创建一个名为“msg”的文件夹。 - 在“msg”文件夹中创建一个名为“MyMessage.msg”的文件。 - 在该文件中定义您的自定义消息类型,例如: ``` Header header uint16 id float32 x float32 y ``` 2. 生成消息源代码 在定义自定义消息类型后,需要使用ROS的消息生成工具生成消息源代码。运行以下命令: ``` $ cd <catkin_ws> $ catkin_make ``` 该命令将自动生成消息源代码,并将其放在“<catkin_ws>/devel/include”目录中。 3. 编写发送程序 现在,您可以编写发送程序来发送自定义消息类型。在ROS中,您可以使用ROS的发布者(Publisher)来发送消息。以下是一个简单的发送程序示例: ``` #include <ros/ros.h> #include <my_message/MyMessage.h> #include <netinet/in.h> #include <arpa/inet.h> #include <sys/socket.h> #include <unistd.h> int main(int argc, char **argv) { ros::init(argc, argv, "udp_publisher"); ros::NodeHandle nh; // 创建UDP套接字 int sock = socket(AF_INET, SOCK_DGRAM, 0); if (sock < 0) { perror("socket"); return 1; } // 设置目标地址和端口号 struct sockaddr_in addr; addr.sin_family = AF_INET; addr.sin_port = htons(12345); addr.sin_addr.s_addr = inet_addr("127.0.0.1"); // 创建ROS发布者 ros::Publisher pub = nh.advertise<my_message::MyMessage>("my_topic", 1000); // 发送消息 while (ros::ok()) { my_message::MyMessage msg; // 填充消息 msg.id = 1; msg.x = 1.0; msg.y = 2.0; pub.publish(msg); // 将消息序列化为字节数组 uint8_t buffer[1024]; ros::serialization::OStream stream(buffer, sizeof(buffer)); ros::serialization::serialize(stream, msg); // 发送消息 if (sendto(sock, buffer, stream.getLength(), 0, (struct sockaddr *)&addr, sizeof(addr)) < 0) { perror("sendto"); return 1; } // 等待1秒 ros::Duration(1.0).sleep(); } // 关闭UDP套接字 close(sock); return 0; } ``` 在该程序中,我们首先创建了一个UDP套接字,并设置目标地址和端口号。然后,我们创建了一个ROS发布者,并在循环中发送自定义消息类型。在发送消息之前,我们将消息序列化为字节数组,并使用sendto()函数将其发送到目标地址。 4. 运行程序 在编写发送程序后,您可以使用ROS的运行工具(如roslaunch)来启动程序。在启动之前,请确保ROS主节点已经运行。运行以下命令: ``` $ roslaunch my_package udp_publisher.launch ``` 在程序运行时,它将定期发送自定义消息类型。您可以使用ROS的订阅者(Subscriber)来接收该消息

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

是刃小木啦~

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值