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、串级结构与参数整定;后段进入位置环、轨迹跟踪与抗扰设计;最后通过综合案例把各环节串起来。学习时建议始终抓住“内环快、外环慢”的带宽分离原则,并亲手推导一次从期望加速度到期望姿态角的转换关系。

多旋翼姿态与位置控制全景 位置环(外环) 输入:期望位置 p_d、期望速度 v_d 反馈:GPS / 光流 / 气压高度 输出:期望加速度 a_d 带宽:0.5~2 rad/s 水平精度约 1~3 m(GPS) 姿态环(内环) 输入:期望姿态角 φ_d, θ_d, ψ_d 反馈:IMU 陀螺仪 + 加速度计 输出:期望力矩 τx, τy, τz 带宽:5~15 rad/s 角速度环带宽可达 50~200 rad/s 控制分配与电机 输入:T, τx, τy, τz 混控矩阵 → 四电机转速 电调 + 螺旋桨推力 输出:机体运动 示例:m=1.2 kg,悬停单桨 2.94 N 期望姿态 力矩 机体实际位置与姿态反馈(IMU / GPS / 气压计) 欠驱动约束:4 个独立控制量(T, τx, τy, τz)→ 6 个自由度 x、y 位置与偏航 ψ 必须通过改变姿态间接控制,因此位置环输出的是期望姿态角 带宽分离原则:内环快、外环慢 姿态环带宽 ≈ 位置环带宽的 5~10 倍,才能保证串级系统稳定且不产生振荡

学习建议与常见误区

初学者最容易犯的错误,是把位置环和姿态环当成两个独立问题分别调参。实际上,位置环的输出就是姿态环的输入,位置环的稳定性直接受姿态环响应速度制约。如果姿态环存在明显超调或延迟,位置环无论怎么调都会出现“画龙”或低频振荡。建议在仿真中先固定姿态环参数,再逐步增加位置环增益,观察阶跃响应中位置误差与姿态角的变化关系。

本课程后续所有公式与图示均采用 NED 惯性系与 FRD 机体系。若你使用其他约定(如 ENU + 前左上),请在代入前统一转换,否则俯仰角与高度方向的正负号会全部相反。

掌握全景之后,接下来要做的第一件事,是把“期望加速度如何变成期望姿态角”这一步推导清楚。它是连接位置环与姿态环的桥梁,也是后续所有轨迹跟踪算法的共同基础。