1. 课程导入与多旋翼控制全景
多旋翼飞行器看起来只是“四个电机带一副桨”,但它能稳定悬停、沿指定轨迹飞行、在风中保持位置,靠的不是机械结构本身,而是一整套姿态控制与位置控制的闭环系统。姿态控制解决“机体朝哪、转多快”的问题,位置控制解决“飞到哪、走什么路径”的问题;两者串联工作,姿态环是内环,位置环是外环。理解这条主线,是学习本课程所有算法、参数与调试方法的起点。
研究对象:从机体到空间的六个自由度
为统一描述,本课程采用北东地(NED)惯性坐标系与前右下(FRD)机体坐标系。惯性系下,位置用 p = [x, y, z] 表示,其中 z 轴向下,因此悬停时 z 为负值;姿态用欧拉角 [φ, θ, ψ] 表示,分别对应绕机体 x、y、z 轴的滚转、俯仰、偏航。机体坐标系下,速度用 [u, v, w] 表示,角速度用 [p, q, r] 表示。全文与图示均遵循这一约定,后续章节不再重复说明。
多旋翼的六个自由度中,只有四个是直接可控的:总拉力 T、三轴力矩 [τx, τy, τz]。位置 x、y 与偏航 ψ 必须通过改变姿态间接实现,这就是“欠驱动”的本质。例如要让飞行器向前飞,必须先低头产生俯仰角,使总拉力在水平方向产生分量,再通过位置环修正。这一约束决定了几乎所有多旋翼控制器的分层结构。
核心问题:三个必须同时回答的问题
第一,姿态如何快速、无超调地跟踪期望角。典型四旋翼在悬停时,姿态环带宽通常设计在 5~15 rad/s,角速度环带宽可达 50~200 rad/s。第二,位置如何在外扰下保持精度。以 GPS 定位为例,水平精度约 1~3 m,气压高度精度约 0.5~2 m,因此位置环带宽通常只有 0.5~2 rad/s,远低于姿态环。第三,两者如何协调。位置环输出期望姿态角,姿态环输出电机转速,中间还夹着控制分配与电机动力学。任何一个环节延迟过大,都会让外环失稳。
一个典型教学示例:四旋翼质量 m = 1.2 kg,轴距 L = 0.25 m,悬停时每个电机需提供约 2.94 N 拉力。若希望以 2 m/s² 向前加速,所需俯仰角约为 arctan(2/9.81) ≈ 11.5°。这个角度就是位置环交给姿态环的“期望值”。
典型应用场景与控制需求差异
不同任务对控制的要求差别很大。航拍要求姿态平稳、画面无抖动,偏航角速度通常限制在 30°/s 以内;物流配送要求位置精度高、抗风能力强,水平误差常需控制在 1 m 内;农业植保要求定高稳定、航线笔直,高度波动一般不超过 0.3 m;竞速穿越则要求姿态响应极快,角速度可达 800°/s 以上。同一套控制框架,通过调整带宽、限幅和滤波参数,可以覆盖这些差异巨大的场景。
课程知识地图与学习路径
本课程共 30 章,按“建模—姿态—位置—综合”四条主线展开。前段建立坐标系、动力学与电机模型;中段深入姿态环的 PID、串级结构与参数整定;后段进入位置环、轨迹跟踪与抗扰设计;最后通过综合案例把各环节串起来。学习时建议始终抓住“内环快、外环慢”的带宽分离原则,并亲手推导一次从期望加速度到期望姿态角的转换关系。
学习建议与常见误区
初学者最容易犯的错误,是把位置环和姿态环当成两个独立问题分别调参。实际上,位置环的输出就是姿态环的输入,位置环的稳定性直接受姿态环响应速度制约。如果姿态环存在明显超调或延迟,位置环无论怎么调都会出现“画龙”或低频振荡。建议在仿真中先固定姿态环参数,再逐步增加位置环增益,观察阶跃响应中位置误差与姿态角的变化关系。
本课程后续所有公式与图示均采用 NED 惯性系与 FRD 机体系。若你使用其他约定(如 ENU + 前左上),请在代入前统一转换,否则俯仰角与高度方向的正负号会全部相反。
掌握全景之后,接下来要做的第一件事,是把“期望加速度如何变成期望姿态角”这一步推导清楚。它是连接位置环与姿态环的桥梁,也是后续所有轨迹跟踪算法的共同基础。