引言

本文是我在学习四旋翼飞行器建模时做的笔记，主要参考这个项目的文档。文中对基础力学知识进行了必要的阐述，虽不够详尽，但应足以辅助形象理解。

坐标轴和参考系

在四旋翼无人机的建模中，定义两种主要的坐标系，惯性坐标系和机体坐标系。惯性坐标系由、和定义，其中指向上方。惯性坐标系相当于在地面上观察无人机时所使用的固定坐标系。机体坐标系附着在无人机的重心上，随着无人机的运动而运动。轴通常指向无人机的正前方，轴垂直于旋翼平面，无人机悬停时指向正上方。机体坐标系用于描述无人机自身各个部件的相对位置和运动。

惯性特征

质量是物体抵抗「平动」的能力，而转动惯量则是物体抵抗「旋转」的能力。例如，一根长棍子，绕中心旋转容易（转动惯量小），绕端点旋转难（转动惯量大）。

惯性积描述绕不同轴的旋转之间的耦合效应。由于是主轴，四旋翼绕这些轴旋转时，不会产生交叉的惯性积（类似「不同方向的力不互相干扰」），因此相对于质心的惯性矩阵在坐标系下是一个对角矩阵：

绕的转动惯量绕的转动惯量绕的转动惯量

转动惯量矩阵是对角矩阵时，旋转动力学方程解耦，运动更加简单。从文档中给的实际数值看，绕的转动惯量最大，所以四旋翼绕垂直轴旋转更难，因为四个电机分布在平面内，远离旋转轴。

电机模型

回顾力矩的概念，力矩描述力对物体产生旋转效果的能力，是力与力臂的叉乘：。其中，是从转动轴到力作用点的位置矢量，是施加的力，向量叉乘的方向由右手定则确定。用扳手拧螺丝时，力越大（越大），或扳手越长（越大），拧螺丝越容易（力矩越大）。如果垂直于扳手施力，力矩最大；如果斜着推，力矩会减小（因为只有垂直分量的力有效）。

记旋翼角速度为，它的方向由右手定则判定。图1中，逆时针转时方向朝上（方向），顺时针转时方向朝下（方向）。旋翼旋转产生垂直推力，推力方向始终朝上（方向），与旋翼旋转方向无关（仅由桨叶攻角决定）。同时，旋翼旋转时，空气反作用产生反扭矩，反扭矩方向与角速度矢量方向相反。电机的响应特性可以用一阶微分方程描述：

其中、、均为参数。建模时可以假设电机控制器是理想的，即实际电机速度等于指令电机速度。

刚体动力学

运动学

四旋翼飞行器的姿态转换采用Z-X-Y欧拉角体系描述。从惯性坐标系到机体坐标系为的坐标系转换通过三次基本旋转实现：

1. 偏航角旋转：绕的Z轴（）旋转角（yaw），得到中间坐标系，对应旋转矩阵
2. 滚转角旋转：绕的X轴（）旋转角（roll），得到中间坐标系，对应旋转矩阵
3. 俯仰角旋转：绕的Y轴（）旋转角（pitch），最终得到机体坐标系，对应旋转矩阵

各基本旋转矩阵定义如下（，）：

这里先介绍坐标变换基本原理。设向量在惯性坐标系中的坐标表示为，当坐标系旋转角度后得到新坐标系，同一向量在中的坐标表示为，二者的坐标变换关系由旋转矩阵建立：

所以，将机体坐标系中的坐标左乘旋转矩阵，即可得到该向量在惯性坐标系中的坐标。

因此，根据坐标系旋转的链式法则，惯性坐标系与机体坐标系间的坐标变换关系为：

将三个基本旋转矩阵按Z-X-Y顺序相乘，得到完整的将机体坐标系中的向量转换到惯性坐标系的姿态旋转矩阵：

上标表示目标坐标系，即我们希望将向量转换到惯性坐标系中。下标表示源坐标系，即原始向量是在机体坐标系中表示的。

矩阵乘积的物理意义为：首先对向量施加绕当前坐标系Y轴的俯仰角旋转，再绕更新后X轴的滚转角旋转，最后绕原始Z轴的偏航角旋转。此矩阵可将机体坐标系中的向量映射至惯性坐标系，顺序正好和前面的Z-X-Y相反。

角速度矢量

符号中的上标表明角速度的参考系是，即我们是从参考系的视角来观察坐标系的旋转情况。下标表示这个角速度矢量的分量是在坐标系中表示的，即我们使用坐标系的基向量来描述角速度的大小和方向。角速度矢量分解到的三个正交基向量上，分别对应绕三个主轴的角速度分量：是绕轴的滚转角速度（roll），是绕轴的俯仰角速度（pitch），是绕轴的偏航角速度（yaw）。

在惯性坐标系中分析角速度时需通过旋转矩阵进行分量转换，直接使用机体坐标系的分量更方便。首先，机载陀螺仪直接测量，反映机体瞬时旋转状态；其次，姿态控制器设计基于机体坐标系，避免频繁坐标转换；最后，转动惯量矩阵在机体坐标系中为对角阵，动力学方程更简洁。因此，本文分析角速度时采用机体坐标系的分量，符合工程实际。

下面的公式描述了四旋翼飞行器的机体角速度与欧拉角的导数之间的转换关系：

平动动力学

四旋翼飞行器的平动动力学方程基于牛顿第二定律（Newton's laws of motion）建立，描述了质心在惯性坐标系中的加速度与外力的关系。其形式为：

在四旋翼中，合外力由重力和旋翼推力组成。方程中的列向量表示出了这两个力在惯性坐标系的三个轴上的分量。重力方向竖直向下，大小为。旋翼推力是四个旋翼产生的总推力，方向垂直于旋翼平面（沿机体坐标系的轴），可看作第一个输入信号。通过旋转矩阵将推力从机体坐标系转换到惯性坐标系。

主要用于控制飞行器的垂直运动，并通过姿态调整间接影响其水平移动。当四旋翼水平悬停时（），旋转矩阵为单位矩阵，推力完全沿惯性系轴（）方向，与重力平衡（）。当四旋翼倾斜（或）时，推力方向在惯性系中产生水平分量，驱动飞行器平动。推力与重力的合力决定飞行器的升降（如时加速上升）。推力的水平分量（由姿态角和决定）驱动飞行器前后或左右移动。

转动动力学

四旋翼飞行器的转动动力学方程基于欧拉方程（Euler's rotation equations）建立，描述了机体角加速度与外力矩（由旋翼推力差产生）及陀螺效应（角速度与角动量的耦合）的关系：

它是根据刚体转动的欧拉方程

得到的。其中为角加速度引起的惯性力矩，为陀螺效应（科里奥利力项），为外部力矩。

如图2所示，旋翼旋转产生的推力方向都朝上（方向）。旋翼2和4的推力差产生滚转力矩，绕轴：

旋翼3和1的推力差产生俯仰力矩，绕轴：

假设旋翼1和3旋转方向为方向（顺时针），旋翼2和4旋转方向为方向（逆时针）。反扭矩方向与旋翼旋转方向相反，所以和是方向，和是方向，如图2所示。旋翼反扭矩差产生偏航力矩，绕轴：

因此，第二个输入信号由旋翼推力差和反扭矩产生：

通过调整旋翼推力差产生控制力矩，实现对滚转、俯仰和偏航角的调节。增加旋翼2的推力（）或减少旋翼4的推力（），产生沿方向的逆时针滚转力矩，进行滚转控制。增加旋翼3的推力（）或减少旋翼1的推力（），产生沿方向的前倾俯仰力矩，进行俯仰控制。通过反扭矩差（），产生沿方向的逆时针偏航，进行偏航控制。

当四旋翼绕某一轴旋转时，角动量与其他轴的旋转耦合，产生额外的惯性力矩。由于四旋翼通常满足（对称设计），因此有

当四旋翼快速滚转（大）时，陀螺效应会导致俯仰轴产生额外的力矩（如），需控制器补偿。悬停时有，陀螺效应可忽略，方程则简化为。

总结

平动动力学方程与转动动力学方程共同构建了四旋翼飞行器的完整动力学模型体系。平动动力学方程在惯性坐标系中构建，完整表征了质心运动规律：

该方程通过旋转矩阵将机体坐标系下的总推力映射至惯性系，从而实现三维空间中的位置控制。转动动力学方程则在机体坐标系中构建，揭示刚体旋转特性：

力矩输入实现三轴独立控制，非线性项物理表征陀螺耦合效应。