ROS自学实践(10)：ROS节点同时订阅多个话题并进行消息时间同步

原创最新推荐文章于 2026-07-07 13:10:34 发布 1.4w 阅读 AI写同款

Eonekne

231粉丝47篇原创

关注

ROS机器人制作（二）—— ROS话题订阅与发布（二）ROS话题通信1：发布话题2：订阅话题3：自定义消息数据类型4：命令行 ROS话题通信：支持一对多的异步通信，发布者发布消息到话题上，订阅者从话题上订阅消息。 1：发布话题创建节点句柄： ros::NodeHandle nh; 创建一个发布者：<话题的消息数据类型> <话题名> <消息缓存长度> ros::Publisher pub = nh.advertise<std_msgs::String>("topic_name 阅读详情

AI摘要

本文介绍如何使用ROS操作系统实现多传感器数据的时间戳同步，通过C++和Python代码示例，展示了如何创建节点来同时接收激光雷达和定位信息，并实现数据的实时感知和处理。

一、前言

在进行SLAM建图或自动驾驶系统设计的过程中，往往涉及到多种传感器进行环境感知和信息采集，这就不仅需要一个节点接收多个传感器数据，还要求传感器数据的时间戳同步，这样才能实现环境数据的实时感知和处理。本文基于ROS操作系统，从C++和python两个角度进行试验，方便后续的开发工作。

二、创建ROS包

mkdir -p multi_receive/src
cd multi_receive/src
catkin_create_pkg multi_receive roscpp rospy sensor_msgs geometry_msgs
cd ..
catkin_make

三、创建multi_receive.cpp文件(C++版)

#include <ros/ros.h>
#include "sensor_msgs/LaserScan.h"
#include "geometry_msgs/PoseWithCovarianceStamped.h"
#include <message_filters/subscriber.h>
#include <message_filters/synchronizer.h>
#include <message_filters/sync_policies/approximate_time.h>
#include <message_filters/time_synchronizer.h>
#include <boost/thread/thread.hpp>
#include <iostream>

void multi_callback(const sensor_msgs::LaserScanConstPtr& scan, const geometry_msgs::PoseWithCovarianceStampedConstPtr