ROS中的坐标系

最新推荐文章于 2024-07-19 15:00:25 发布

lzp_k2

最新推荐文章于 2024-07-19 15:00:25 发布

阅读量3.6k

点赞数 1

文章标签： ROS 坐标系

在ROS中，

坐标轴规定可以参考 ROS-REP 103 [http://www.ros.org/reps/rep-0103.html]，

坐标系可以参考 ROS-REP 105 [http://www.ros.org/reps/rep-0105.html]，

为了方便大家的理解，这里结合模拟器做简单的讲解。

常规用来表示三维位置关系时，使用的是右手坐标系，何为右手坐标系呢？我们来看下图：

右手坐标系定义(注1)
把右手放在原点的位置，使大姆指，食指和中指互成直角，把 大姆指 指向 Z轴的正方向，食指指向X轴的正方向时向时，中指所指的方向就是 Y轴的正方向

通常相对于我们的身体而言

举例:
坐标点 (3,4,5) 表示距原点 前3个单位 ，并向 左4个单位以及向 上5个单位 的位置。

有了三维坐标轴的定义，那么对于旋转的定义也就比较容易了，对于一个三维空间里面的旋转，可以分解成绕着坐标轴的旋转。旋转的方向使用右手法则定义：

绕坐标轴旋转定义
用右手握住坐标轴，大拇指 的方向朝着坐标轴朝向的正方向，四指环绕的方向定义沿着这个坐标轴旋转的正方向

一般来说

举例:
我们通常用来表述小车运动的二维平面指的是 X-Y平面，也就是X轴和Y轴张成的平面，在这个平面中，用来描述 小车转弯的角就是绕Z轴的旋转，也就是经常说的航向角。Z轴朝上，所以按照右手法则可以知道小车向 左转为正，右转为负。

空间中的同一位置，在不同坐标系下，其坐标值也不相同。

在上图中，有两个坐标系，分别为坐标系A和坐标系B，其中 橘红色坐标轴表示X轴(朝前)，蓝色坐标轴表示Y轴(朝左)。对于坐标系A中，粉色的圆点的坐标为(3, -3)，对于坐标系B中，粉色的圆点的坐标为(5, 1)

在ROS中，定义了许多坐标系，这里介绍几个常见的坐标系，为了比较直观的解释这几个坐标系，我们使用一个小例子来说明。

图(1-1)

在刚开始的时候，按照之前坐标轴的定义，将小车的朝向方向作为X轴，正左方标识为Y轴，并将小车所在的位置定义为原点，如图(1-1)。

图(1-2)

如图(1-2)，在原点插一面小旗子，并控制小车行驶一段距离，这个时候我们能得到三个位置信息

在上面的例子中，三个坐标值都相同。但真实情况下，三个坐标值由于测量误差或者其他原因导致坐标值并不相同，然而这三个坐标都用来表示小车中心在空间中的位置，这就引出了不同坐标系。

对于第一种测量，称之为真实坐标系，这是一个理想的坐标系，即我们拥有一种绝对准确的测量方式获得小车相对于地图原点的坐标，但这种坐标系在真实情况下是不存在的。
对于第二种测量，称之为里程计坐标系，在这个坐标系中得到的测量值通常是基于轮速里程计，视觉里程计或者惯性单元得到的。在这个坐标系中，新坐标值通常是根据前一个时刻坐标得到的，一般使用odom来表示。
- 优点: 坐标值是连续的并且以平稳的方式演变，没有离散的跳跃
- 缺点: 测量产生的误差会累计
- 适合: 短时程相对定位
对于第三种测量，称之为地图坐标系，在这个坐标系中得到坐标值通常是通过传感器的数据重新计算或测量得到的，一般使用map来表示
- 优点:由于每次得到的坐标点都是重新测量计算得到的，累计误差影响较小
- 缺点: 坐标数据会有跳变
- 适合: 长时程绝对定位

假设对于上面描述的三种测量是以下结果

图(1-3)

那么坐标系表示如图(1-3)

模拟器除了沿袭上面讲述的两个坐标系(odom, map)之外，同时还引入了真实坐标系(real_map)。

由于是模拟器，所以可以精确的知道小车的真实位置，在simulation_base模块中，会发布两种坐标系的坐标

小车在odom坐标系下的坐标：发布的坐标是模拟轮速里程计产生的，我们可以在simulation_base模块中设置轮速里程计噪音，用于模拟真实情况。但由于存在噪音，所以在odom坐标系下的小车坐标并不等于其真实位置。
小车在real_map坐标系下的坐标：发布的坐标是根据上层控制速度结合小车底层限制(小车的最大速度，加速度等信息)产生的，在这个坐标系下会排除轮速里程计产生的噪声，输出小车的真实坐标。

对于map坐标系下的坐标，并不由模拟器产生，而是通过上层的定位算法得到的。