You need to enable JavaScript to run this app. ROS topic未发布排查:订阅话题运算后无法发布结果问题求助
优惠活动
大模型
产品
解决方案
定价
更多

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

相关产品推荐
方舟 Agent Plan

超全模态模型 × Harness 升级,最新支持 Deepseek-V4.1-Flash、GLM-5.3 系列、Doubao-Seedream-5.0-pro、Kimi-K3 (部分), 限时 9.9 元起

最近更新时间:2026.10.19 03:15:02