Skip to main content
 首页 » 编程设计

python之在 ROS之Python 中使用来自多个主题的数据

2025年01月19日11hnrainll

我能够显示来自两个主题的数据,但我无法在 ROS(用 Python 代码编写)中实时使用和计算来自这两个主题的数据。

您是否想过存储这些数据并进行实时计算?

谢谢;)

#!/usr/bin/env python 
 
import rospy 
import string 
from std_msgs.msg import String  
from std_msgs.msg import Float64MultiArray 
from std_msgs.msg import Float64 
import numpy as np 
 
 
class ListenerVilma: 
 
    def __init__(self): 
        self.orientation = rospy.Subscriber('/orientation', Float64MultiArray , self.orientation_callback) 
        self.velocidade = rospy.Subscriber('/velocidade', Float64MultiArray, self.velocidade_callback) 
 
    def orientation_callback(self, orientation): 
        print orientation 
 
    def velocidade_callback(self, velocidade): 
        print velocidade 
 
 
if __name__ == '__main__': 
   rospy.init_node('listener', anonymous=True) 
   myVilma = ListenerVilma() 
   rospy.spin() 

请您参考如下方法:

可能的解决方案:

#!/usr/bin/env python 
 
import rospy 
from std_msgs.msg import Float64MultiArray 
 
 
class Server: 
    def __init__(self): 
        self.orientation = None 
        self.velocity = None 
 
    def orientation_callback(self, msg): 
        # "Store" message received. 
        self.orientation = msg 
 
    def velocity_callback(self, msg): 
        # "Store" the message received. 
        self.velocity = msg 
 
 
if __name__ == '__main__': 
    rospy.init_node('listener') 
 
    server = Server() 
 
    rospy.Subscriber('/orientation', Float64MultiArray , server.orientation_callback) 
    rospy.Subscriber('/velocity', Float64MultiArray, server.velocity_callback) 
 
    rospy.spin() 

现在您有了 self.orientation 和 self.velocity 形式的“数据库存”,您可以使用它来“实时计算” .

例如:

#!/usr/bin/env python 
 
import rospy 
from std_msgs.msg import Float64MultiArray 
 
 
class Server: 
    def __init__(self): 
        self.orientation = None 
        self.velocity = None 
 
    def orientation_callback(self, msg): 
        # "Store" message received. 
        self.orientation = msg 
 
        # Compute stuff. 
        self.compute_stuff() 
 
    def velocity_callback(self, msg): 
        # "Store" the message received. 
        self.velocity = msg 
 
        # Compute stuff. 
        self.compute_stuff() 
 
    def compute_stuff(self): 
        if self.orientation is not None and self.velocity is not None: 
            pass  # Compute something. 
 
 
if __name__ == '__main__': 
    rospy.init_node('listener') 
 
    server = Server() 
 
    rospy.Subscriber('/orientation', Float64MultiArray , server.orientation_callback) 
    rospy.Subscriber('/velocity', Float64MultiArray, server.velocity_callback) 
 
    rospy.spin()