我能够显示来自两个主题的数据,但我无法在 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()
