ROS中两种获取消息的方式

ROS中有两种获取消息的方式。一种是同步的,一种是异步的。

一、同步的方式

函数为:

rospy.wait_for_message(topic name,message type,queue_size,buff_size)

返回值为所获取的消息。

调用后程序将在这里等待该消息,获得后会继续执行后续的程序。

二、异步的方式

异步的方式是通过subscriber,并使用回调函数的方式来实现的。

示例如下:

#!/usr/bin/python
import rospy
from rospy.client import init_node
from sensor_msgs.msg import XXX
class getMessage:
    def __init__(self):
        self.sub=rospy.Subscriber(name,type,self.CB,queue_size,buff_size)
    
    def CB(self,msg):
        #回调函数的内容。。。

    def main(self):
        rospy.spin()

if __name__=='__main__':
    rospy.init_node("get_message")
    gm=getMessage()
    gm.main()

其中,name表示要接受的topic的名字,type表示该消息的类型,可以在shell中用rostopic type 来查看。CB为回调函数,其参数msg就是接受到的消息。

使用这种方式,对方发送消息以后将执行CB函数中的内容。如果要总是接受最新的消息,可以设置queue_size=1,buff_size=52428800。原因见https://blog.csdn.net/qq_37082966/article/details/97172729

  • 0
    点赞
  • 14
    收藏
    觉得还不错? 一键收藏
  • 2
    评论
ROS,可以通过多种方式获取机器人的当前位姿,下面列举其两种方式: 1. 通过tf库获取机器人的位姿 tf库是ROS用于处理坐标变换的库,可以用于获取机器人的位姿。在使用tf库之前需要安装相应的依赖库,命令如下: ``` sudo apt-get install ros-kinetic-tf ros-kinetic-tf2 ros-kinetic-tf2-ros ``` 在使用tf库时,需要知道机器人的坐标系和参考坐标系,通过tf库可以将机器人坐标系转换为参考坐标系,并获取机器人在参考坐标系下的位姿。下面是一个简单的例子: ```python import rospy import tf if __name__ == '__main__': rospy.init_node('get_robot_pose') listener = tf.TransformListener() rate = rospy.Rate(10.0) while not rospy.is_shutdown(): try: (trans, rot) = listener.lookupTransform('/map', '/base_link', rospy.Time(0)) print("Robot pose: ", trans, rot) except (tf.LookupException, tf.ConnectivityException, tf.ExtrapolationException): continue rate.sleep() ``` 在上面的例子,'/map'是参考坐标系,'/base_link'是机器人坐标系。listener.lookupTransform()函数可以将机器人坐标系转换为参考坐标系,并返回机器人在参考坐标系下的位姿。其,trans表示机器人的位置坐标,rot表示机器人的姿态。 2. 通过ROS的机器人状态消息获取机器人的位姿 在ROS,机器人的状态可以通过机器人状态消息(nav_msgs/Odometry)来表示。nav_msgs/Odometry消息包含机器人的位置和姿态信息。下面是一个获取机器人状态消息的例子: ```python import rospy from nav_msgs.msg import Odometry def callback(data): print("Robot pose: ", data.pose.pose.position, data.pose.pose.orientation) if __name__ == '__main__': rospy.init_node('get_robot_pose') rospy.Subscriber('/odom', Odometry, callback) rospy.spin() ``` 在上面的例子,'/odom'是机器人状态消息的话题名称,callback函数是当接收到机器人状态消息时的回调函数。在回调函数,可以通过data.pose.pose.position获取机器人的位置坐标,通过data.pose.pose.orientation获取机器人的姿态。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 2
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值