进阶课程⑭ _ Apollo自动定位技术——三维几何变换和坐标系介绍

开垦者

空间坐标系
旋转是指在一个坐标系下，把一个点旋转到另一个位置的几何变换。
二维旋转
如上所示：将P旋转θ角到P'的位置,在二维坐标系下，由一个2×2的矩阵表示，如图中的R(θ)。点
的旋转其实也可以理解为两个坐标系的一个旋转。对于三维而言，多了一个维度，可以用3×3矩
阵来表示。
分解来看，可以通过X轴Y轴Z轴分别去旋转，对应的分量分别是RX，RY和RZ。三维旋转矩阵可
以由对应三个方向的基本旋转矩阵相乘来表示。三维旋转矩阵存在九个元素，对九个元素进行优
化是非常复杂。通常情况下会使用是欧拉角或者四元数的方式进行优化，如下图所示。