建站行业现状,国外产品设计网,阿克苏网站怎么做seo,男女直接做的视频上那个网站目录
1.三维几何变换---旋转
2.三维几何变换----平移
2.1刚体的位置和朝向
3. 坐标系
3.1 ECI地心惯性坐标系
3.2 ECFF地心地固坐标系
3.3当地水平坐标系
3.4 UTM坐标系
3.5 车体坐标系
3.6IMU坐标系
3.7 相机坐标系
3.8 激光雷达坐标系
3.9 无人车定位信息中涉及…目录
1.三维几何变换---旋转
2.三维几何变换----平移
2.1刚体的位置和朝向
3. 坐标系
3.1 ECI地心惯性坐标系
3.2 ECFF地心地固坐标系
3.3当地水平坐标系
3.4 UTM坐标系
3.5 车体坐标系
3.6IMU坐标系
3.7 相机坐标系
3.8 激光雷达坐标系
3.9 无人车定位信息中涉及的坐标系 原文链接进阶课程⑭ | Apollo自动定位技术——三维几何变换和坐标系介绍 上周阿波君为大家详细介绍了「进阶课程 ⑬ | Apollo无人车自定位技术入门」。 详细讲解了什么是无人车的自定位系统以及无人车为什么需要精准的定位系统。最后详细讲解了激光定位、视觉定位和惯性导航。由于单一定位方式有缺陷因此产生了以卡尔曼滤波器为中心的多传感器融合定位系统。 本周阿波君将与大家分享Apollo自动定位技术——三维几何变换和坐标系介绍。下面我们一起进入进阶课程第14期。 本节主要介绍自定位的一些基础知识主要包括三维几何变换和几个坐标系。
根据各个轴位置关系的不同空间中的坐标系可以分为左手坐标系和右手坐标系。如下图所示。 空间坐标系
1.三维几何变换---旋转
旋转是指在一个坐标系下把一个点旋转到另一个位置的几何变换。 二维旋转
如上所示将P旋转θ角到P的位置,在二维坐标系下由一个2×2的矩阵表示如图中的R(θ)。点的旋转其实也可以理解为两个坐标系的一个旋转。对于三维而言多了一个维度可以用3×3矩阵来表示。
分解来看可以通过X轴Y轴Z轴分别去旋转对应的分量分别是RXRY和RZ。三维旋转矩阵可以由对应三个方向的基本旋转矩阵相乘来表示。三维旋转矩阵存在九个元素对九个元素进行优化是非常复杂。通常情况下会使用是欧拉角或者四元数的方式进行优化如下图所示。 三维旋转 2.三维几何变换----平移
平移是当前点相对于坐标原点的位置变化通常由当前位置的坐标表示由一个3x1的向量表示如下所示。 三维平移
2.1刚体的位置和朝向 刚体的位置和朝向
刚体是一种有限尺寸可以忽略形变的固体。自然界不存在完美的刚体但物体通常可以假定为完美刚体。自动驾驶中汽车可以认为是一个刚体。
刚体坐标系通常是取刚体内的一点P为原点建立的局部坐标系。刚体的位置可以看作刚体原点P相对于参考坐标系原点O所做的平移可以使用三维平移向量表示。刚体的朝向可以由刚体原点P的朝向来表示。 3. 坐标系
下面介绍一下定位里面常用的坐标系。
3.1 ECI地心惯性坐标系
ECI地心惯性坐标系也称i系这个坐标系如下图所示 地心惯性坐标系ECI
它圆心就是地球的原点Z轴沿地轴方向朝向北极 X轴和Y轴位于赤道平面内与Z轴满足右手法则并且X轴和Y轴分别指向两个恒星。也就是说不随着地球的自转而发生变化。它是一个非常固定的坐标系。IMU测量得到的加速度角速度都是相对于这个坐标系的。 3.2 ECFF地心地固坐标系
ECEF地心地固坐标系也称为e系它的原点也是地球的原点 Z轴指向北极 它与前面的ECI的区别就在于它的XY随着地球的自转而转动它是以地球为基准的。它的X轴指向格林威治的子午面的交线 Y轴在赤道平面内与X轴、Z轴满足右手系法则常用的如WGS84坐标系。其特点是与地球固定在一起随地球一起转动。 地心地固坐标系ECEF 3.3当地水平坐标系
当地水平坐标系一般也称为L系。如下图所示它的原点位于载体所在的地球表面X轴和Y轴在当地水平面内分别指向东向和北向Z轴垂直向上与X轴和Y轴满足右手法则。在导航解算过程中通常也把该坐标系选取为导航坐标系n系也称为“东-北-天E-N-U”坐标系。 当地水平坐标系 3.4 UTM坐标系
UTM(UNIVERSAL TRANSVERSE MERCARTOR GRIDSYSTEM通用横轴墨卡托格网系统)坐标是一种平面直角坐标这种坐标格网系统及其所依据的投影已经广泛用于地形图。其投影是一种“等角横轴割圆柱投影”椭圆柱割地球与南纬80度北纬84度两条等高圈投影后两条相割的经线上没有变形而中央经线上长度比为0.9996。该投影方法按经度把地球划分成了60个区域那么每6度一个区域例如北京其实在第50区。南北又做了划分相当于把地球划分成很多块。 UTM投影 3.5 车体坐标系
车体坐标系原点在载体质量中心与载体固连处相对于车载选取原点位于后轴中心位置X轴沿载体轴向指向右Y轴指向前Z轴与X轴和Y轴满足右手法则指向天向。该坐标系通常称为“右-前-上R-F-U”坐标系。它是一个局部坐标系它与N系或者导航坐标系、当地水平坐标系之间的旋转关系表示现在车的姿态。 车体坐标系 3.6IMU坐标系
IMU坐标系其实和车体坐标系基本上是一样它的原点在陀螺仪和加速度计的坐标原点XYZ三个轴方向分别与陀螺仪和加速度计对应的轴向平行。在不考虑安装误差角的情况下载体坐标系和IMU坐标系是一样的。 IMU坐标系特点 3.7 相机坐标系
相机坐标系以相机光心为原点Xc轴和Yc轴与成像平面坐标系的x轴和y轴平行Zc轴为摄像机的光轴和图像平面垂直。由点O与Xc、Yc、Zc轴组成的坐标系成为相机的坐标系如下图右边所示。通常情况下并不会将相机坐标系和其他的全局坐标系直接连接起来因为已经选IMU作为汽车原点。通过一个外参把相机和IMU关联起来也就是标定的外部参数。当知道IMU在世界坐标系的姿态和位置就可以得到相机坐标系到世界坐标系的转换。 相机坐标系 3.8 激光雷达坐标系
下图为激光雷达坐标系以及其俯视图从图中可以看出激光雷达坐标系的坐标原点位于多线束中点旋转轴的交点处Z轴沿轴线向上X和Y轴如俯视图所示。其测量的点坐标是在激光雷达坐标系下的三维坐标。
要转换到世界坐标系可以使用相机坐标系下点转换到世界坐标系的类似方法。通过IMU坐标系到激光雷达坐标系的外參以及IMU坐标系的姿态得到激光雷达坐标系到世界坐标系的转换。 激光雷达坐标系及其俯视图 3.9 无人车定位信息中涉及的坐标系
下图给出了定位模块中输出的各个坐标系下的信息以及不同坐标系之间的关系。 无人车定位信息中涉及的坐标系
定位输出信息主要包括UTM坐标系的XY,IMU的姿态四元数 ENU坐标系下的速度。另外还输出一些和车体相关信息例如车体姿态的四元数车体坐标系下的加速度和角速度。这些输出的信息可以给感知和PNC使用。各个坐标系之间是一些基本的旋转关系。
