四轴飞行器基础知识学习笔记（一）— 旋转矩阵与欧拉角的关系

四轴飞行器基础知识学习笔记（一）— 旋转矩阵与欧拉角的关系

需要的数学知识有：

• 向量代数
• 解析几何
• 线性代数

参考书籍及文档：

• <<惯性器件与惯性导航系统>>
• Development of a quaternion-based quadrotor control system

1.方向余弦矩阵的几何意义

在研究三维立体的方向余弦矩阵之前先了解二维平面的方向余弦矩阵，设一矢量$\mathbf{R}$在二维平面O$xy$坐标系中有分量$R_x\mathbf{i}$和$R_y\mathbf{j}$，二维平面O$x_1{y}_1$坐标系为O$xy$坐标系逆时针旋转$\theta$得到，矢量$\mathbf{R}$在O$x_1{y}_1$坐标系分量为$R_{x_1}{\mathbf{i}}_1$和$R_{y_1}{\mathbf{j}}_1$，所以可以得到如下公式：
$$\begin{array}{rl}\mathbf{R}& =R_x\mathbf{i}+R_y\mathbf{j}\\ \mathbf{R}& =R_{x_1}{\mathbf{i}}_1+R_{y_1}{\mathbf{j}}_1\end{array}$$

由上式可以得到:
$$R_x\mathbf{i}+R_y\mathbf{j}=R_{x_1}{\mathbf{i}}_1+R_{y_1}{\mathbf{j}}_1$$

在等式两端同时乘以${\mathbf{i}}_1$或者${\mathbf{j}}_1$，得到如下等式：
$$\begin{array}{rl}{\mathbf{i}}_1\cdot (R_x\mathbf{i}+R_y\mathbf{j})& ={\mathbf{i}}_1\cdot (R_{x_1}{\mathbf{i}}_1+R_{y_1}{\mathbf{j}}_1)\\ {\mathbf{j}}_1\cdot (R_x\mathbf{i}+R_y\mathbf{j})& ={\mathbf{j}}_1\cdot (R_{x_1}{\mathbf{i}}_1+R_{y_1}{\mathbf{j}}_1)\end{array}$$

根据向量点乘公式 $\mathbf{a}\cdot \mathbf{b}=|a||b|\cos \angle (\mathbf{a},\mathbf{b})$，因为$\mathbf{i}$和$\mathbf{j}$是单位向量，所以$|i|=1,|j|=1$，化简得到：
$$\begin{array}{rl}{R}_{x_1}& =R_x\mathbf{i}\cdot {\mathbf{i}}_1+R_y\mathbf{j}\cdot {\mathbf{i}}_1\\ R_{y_1}& =R_x\mathbf{i}\cdot {\mathbf{j}}_1+R_y\mathbf{j}\cdot {\mathbf{j}}_1\end{array}$$

根据图中$\mathbf{i}$与${\mathbf{i}}_1$及$\mathbf{j}$与${\mathbf{j}}_1$夹角为$\theta$，$\mathbf{i}$与${\mathbf{i}}_1$及$\mathbf{j}$与${\mathbf{j}}_1$夹角为$90°-\theta$，继续将上式化简得到：
$$\begin{array}{rl}{R}_{x_1}& =R_x\cos (\theta )+R_y\cos (90°-\theta )=R_x\cos (\theta )+R_y\sin (\theta )\\ R_{y_1}& =R_x\cos (90°+\theta )+R_y\cos (\theta )=-R_x\sin (\theta )+R_y\cos (\theta )\end{array}$$

使用矩阵形式表示，则有：
$$\left[\begin{array}{c}{R}_{x_1}\\ R_{y_1}\end{array}\right]=\left[\begin{array}{cc}\cos (\theta )& \sin (\theta )\\ -\sin (\theta )& \cos (\theta )\end{array}\right][\begin{array}{c}{R}_x\\ R_y\end{array}$$