@xzp 如果您想订阅带时间戳的速度信息,可以使用ROS中的nav_msgs/Odometry消息类型,该消息类型包含了机器人的位置、速度和姿态信息,并且带有时间戳。您可以在小车的控制节点中发布该消息类型,然后在数据融合节点中订阅该话题,使用TimeSynchronizer类来同步时间戳。
以下是一个示例代码,假设您的小车控制节点发布的话题名为/odom:
import rospy
from nav_msgs.msg import Odometry
from sensor_msgs.msg import LaserScan
from my_package.msg import MyMessage
from message_filters import TimeSynchronizer, Subscriber

def callback(odom, scan):
# 在这里进行数据融合的操作
# …

if name == ‘main’:
rospy.init_node(‘data_fusion_node’)

odom_sub = Subscriber('/odom', Odometry) scan_sub = Subscriber('/scan', LaserScan) ts = TimeSynchronizer([odom_sub, scan_sub], 10) ts.registerCallback(callback) rospy.spin()

在上面的代码中,我们使用Subscriber类来订阅/