ROS topic未发布排查:订阅话题运算后无法发布结果问题求助
ROS节点发布失败问题排查
问题汇总
- 类初始化逻辑错误:Python类的构造方法需命名为
__init__,原代码定义的init方法不会在实例化时自动执行,成员变量未正确初始化 - 订阅回调映射错误:第二个话题
~line_pose注册的回调函数名是callback_line_detect_xL15,但实际定义的回调是callback_line_pose,无法触发回调存储数据 - 回调数据存储错误:回调函数中直接保存了
Float32消息对象而非载荷数值,后续计算时会因类型不匹配报错,需改为取data.data - 核心方法未调用:实例化
exact_pose类后,没有调用订阅、发布、计算相关的方法,节点逻辑完全没有运行 rospy.spin()滥用:publisher方法和calculation循环里都调用了rospy.spin(),该方法是永久阻塞的,会导致后续逻辑完全无法执行Rate用法错误:rospy.Rate需要先实例化后调用sleep()方法,直接调用rospy.Rate.sleep()会报错- 计算逻辑取值错误:计算时使用了
self.line_pose_sub、self.car_yaw_sub这两个订阅器对象,而非回调存储的实际数据self.line_pose、self.car_yaw - 缺少数据就绪判断:没有判断两个订阅话题是否都收到数据就直接计算,会抛出空对象异常
修复后代码
#!/usr/bin/env python import rospy from std_msgs.msg import Float32 from math import cos, sin class ExactPose(): def __init__(self): # 初始化存储变量 self.car_yaw = None self.line_pose = None # 初始化发布器 self.exact_pose_pub = rospy.Publisher('exact_pose', Float32, queue_size=10) # 初始化订阅器 self.car_yaw_sub = rospy.Subscriber('~car/yaw', Float32, self.callback_car_yaw) self.line_pose_sub = rospy.Subscriber('~line_pose', Float32, self.callback_line_pose) # 初始化循环频率,可根据需求调整数值 self.rate = rospy.Rate(10) def callback_car_yaw(self, data): # 存储消息的数值载荷 self.car_yaw = data.data def callback_line_pose(self, data): # 存储消息的数值载荷 self.line_pose = data.data def run(self): while not rospy.is_shutdown(): # 只有两个数据都收到才进行计算发布 if self.car_yaw is not None and self.line_pose is not None: exact_pose_val = self.line_pose * cos(self.car_yaw) + self.line_pose * sin(self.car_yaw) info1 = Float32() info1.data = exact_pose_val self.exact_pose_pub.publish(info1) self.rate.sleep() if __name__ == '__main__': rospy.init_node('exact_pose', anonymous=True) try: node = ExactPose() node.run() except rospy.ROSInterruptException: pass
验证方式
运行节点后可通过rostopic list查看是否存在exact_pose话题,通过rostopic echo /exact_pose查看输出数据是否正常。
内容的提问来源于stack exchange,提问作者MEKH
相关产品推荐
相关产品推荐

