28.如何在实际项目中应用ROS导航相关（4）-获取机器人位置坐标

最新推荐文章于 2025-07-17 00:20:59 发布

原创最新推荐文章于 2025-07-17 00:20:59 发布 · 1.3w 阅读

136 ·

CC 4.0 BY-SA版权

ROS自主导航机器人专栏收录该内容

66 篇文章

订阅专栏

本文详细介绍了PIBOT模拟器的使用方法，包括启动流程、地图配置与坐标系理解，以及如何通过代码获取机器人在地图上的实时位置。适合初学者和开发者快速掌握模拟器操作与坐标定位技巧。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

文章目录

１.PIBOT模拟器
2.通过代码获取实时位置

通过 pibot_simulator我们看下地图与坐标的关系以及如何获取机器人在地图中的实时坐标

１.PIBOT模拟器

１.1模拟器使用

启动模拟器
roslaunch pibot_simulator nav.launch
启动Rviz
roslaunch pibot_navigation view_nav.launch

１.2地图

roscd pibot_simulator/launch
cat nav.launch

可以看到加载的是pibot_simulator/maps/test_map.yaml

image: test_map.pgm
resolution: 0.050000
origin: [-13.800000, -12.200000, 0.000000]
negate: 0
occupied_thresh: 0.9
free_thresh: 0.196

test_map.yaml 指定了使用的地图文件

１.3坐标＆分辨率

修改test_map.yaml中的origin项
origin: [0.00000, 0.00000, 0.000000]
重新启动模拟器和Rviz　

通过Rviz中地图与直接打开的地图对比可以看到机器人再地图的最左下角，也就是说最左下角是地图的原点(0,0),　方向正左为０度

选中Rviz工具栏中的Publish Point

分别移动鼠标至地图的四个角，通过状态栏卡可看到实时的坐标显示分别为

左下角　(0 ,0,0)
右下角　(28.8 ,0,0)
右上角　(28.8 ,27,0)
左上角　(0 ,27,0)

可以看到上图中的display 中的Map下显示地图的信息

这里0.05就是地图分辨率了　　一个像素表示0.05m,实际该该地图对应大小即为(576 * 0.05, 544 * 0.05)即(28.8, 27.2),对应到上面四个角的坐标我们就可以知道x,y 坐标系如何了，实际跟我们高中几何坐标系一样，横向x轴向左增大，纵向y轴向上增大, 角度也同样为跟x的夹角

1.4初始位置

1.3开头我们设置origin: [0.00000, 0.00000, 0.000000],现在我们修改回去origin: [-13.800000, -12.200000, 0.000000]再次重新启动模拟器，对比位置我们可以看到现在的坐标原点跑到了中间，但是坐标系仍是一样（横向x轴向左增大，纵向y轴向上增大, 角度也同样为跟x的夹角）

2.通过代码获取实时位置

通过base_link与map坐标的tf我们就可以得到机器人实时位置，之际贴代码

#!/usr/bin/env python
import rospy

from tf_conversions import transformations
from math import pi
import tf

class Robot:
    def __init__(self):
        self.tf_listener = tf.TransformListener()
        try:
            self.tf_listener.waitForTransform('/map', '/base_link', rospy.Time(), rospy.Duration(1.0))
        except (tf.Exception, tf.ConnectivityException, tf.LookupException):
            return

    def get_pos(self):
        try:
            (trans, rot) = self.tf_listener.lookupTransform('/map', '/base_link', rospy.Time(0))
        except (tf.LookupException, tf.ConnectivityException, tf.ExtrapolationException):
            rospy.loginfo("tf Error")
            return None
        euler = transformations.euler_from_quaternion(rot)
        #print euler[2] / pi * 180

        x = trans[0]
        y = trans[1]
        th = euler[2] / pi * 180
        return (x, y, th)

if __name__ == "__main__":
    rospy.init_node('get_pos_demo',anonymous=True)
    robot = Robot()
    r = rospy.Rate(100)
    r.sleep()
    while not rospy.is_shutdown():
        print robot.get_pos()
        r.sleep()