Ros Odometry获取机器人位置-python 代码打印

纪念一下,辛苦了一天多,终于找出来了,经过网上的资料反向推出结构。

博主需要通过机器人的实时位置来进行计算。从网上查阅得知nav_msgs/Odometry消息中存储机器人的位置和速度估计等。

下面展示一下操作流程

1.首先通过  rostopic list 获得当前正在进行的话题,下面是我的当前活动话题

2. 然后用  rostopic info 相应话题         来获取关于话题的信息,包含订阅者、发布者、消息类型等。 

关于这个Type:放在pythonry代码里面是需要从nav_msgs.msg格式的消息中导入Odometry这个模块

3.接着通过   rosmsg show TYPE(我的是nav_msgs/Odometry)      可以获知消息的结构类型  

4.信息的数据结构类似于结构体。粗浅的说,顶格的是Odometry下的第一级,然后缩进下面的是第二级。根据我推测应该是这个意思,还望各位大神指教。 

这是我的python代码打印信息结果: 

附: 

 在py中还需导入如下模块

from  nav_msgs.msg  import Odometry

获取:

var=rospy.wait_for_message('/odom',Odometry,timeout=5)         #(topic,topic_type,timeout)

 打印:

print(var.pose.pose.position.x)

很是兴奋,希望能帮到你们,接着孤独的毕设

  • 10
    点赞
  • 42
    收藏
    觉得还不错? 一键收藏
  • 4
    评论
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获取机器人姿态
评论 4
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值