Apollo自动定位技术——三维几何变换和坐标系介绍
根据各个轴位置关系的不同,空间中的坐标系可以分为左手坐标系和右手坐标系。
三维几何变换——旋转
旋转是指在一个坐标系下,把一个点旋转到另一个位置的几何变换
如上所示:将P旋转θ角到P’的位置,在二维坐标系下,由一个2×2的矩阵表示,如图中的R(θ)。点的旋转其实也可以理解为两个坐标系的一个旋转。对于三维而言,多了一个维度,可以用3×3矩阵来表示。
分解来看,可以通过X轴Y轴Z轴分别去旋转,对应的分量分别是RX,RY和RZ。三维旋转矩阵可以由对应三个方向的基本旋转矩阵相乘来表示。三维旋转矩阵存在九个元素,对九个元素进行优化是非常复杂。通常情况下会使用是欧拉角或者四元数的方式进行优化。
三维几何变换——平移
平移是当前点相对于坐标原点的位置变化,通常由当前位置的坐标表示,由一个3x1的向量表示,如下所示。