1. 课程导入与无人机控制律设计全景
无人飞行器控制律设计,是把“任务想让它怎么飞”翻译成“舵面、电机或推力矢量在每个时刻该怎么动”的一门工程学科。它研究的对象不是单个零件,而是一个闭环系统:被控对象(机体动力学)、执行机构(舵机、电机、电调)、传感器(IMU、气压计、GNSS、磁罗盘、空速管)、机载计算机中的控制算法,以及外部环境扰动共同构成一个动态整体。控制律就是嵌在这个整体中的“决策规则”,它根据期望状态与实际状态的偏差,持续计算出执行机构指令,使飞行器在存在模型误差、风扰、噪声和约束的条件下,仍然完成既定任务。
要建立全景认识,先要明确四个基本问题:控制什么、控制到什么程度、受什么限制、如何证明它真的做到了。控制对象决定了控制律的结构。多旋翼靠改变各电机转速差产生力矩,属于欠驱动、强耦合、对姿态响应极敏感的系统;固定翼靠升降舵、副翼、方向舵和油门改变气动力与力矩,具有明显的纵向—横航向耦合和速度依赖特性;复合翼、倾转旋翼则在不同飞行阶段切换操纵方式,控制律需要处理模式过渡。控制目标通常分层给出:最内层是角速率稳定,往上是姿态角跟踪,再往上是速度与位置跟踪,最外层才是航迹、编队或任务级指标。约束则来自执行机构饱和、传感器量程与噪声、结构载荷、电池功率、实时计算周期以及安全边界。验证闭环回答的是最后一个问题:仿真、半物理试验和飞行试验各自能证明什么、不能证明什么。
从任务需求到飞行验证,控制律设计通常沿一条“需求—模型—结构—参数—验证”的主线推进。需求阶段要把“悬停精度优于 1 m”“航向保持误差小于 3°”“抗 8 m/s 阵风”这类任务语言,转成可测量的时域或频域指标,例如超调量、调节时间、稳态误差、幅值裕度和相位裕度。建模阶段要得到用于控制器设计的模型,可以是机理建模得到的非线性六自由度方程,也可以是通过扫频试飞辨识得到的频率响应模型。结构设计阶段决定用 PID、LQR、H∞、自抗扰还是模型预测控制,并确定反馈量、前馈通道和限幅逻辑。参数整定阶段在仿真和试验中反复调整增益、滤波器带宽和分配矩阵。验证阶段则按“数字仿真—半物理试验—系留/受限飞行—自由飞行”逐级放开风险。
一个典型的多旋翼姿态控制律示例(教学假设参数):角速率环采用 PI 控制,比例增益 Kp=0.12,积分增益 Ki=0.05,积分限幅 ±0.3;姿态角环采用 P 控制,Kp=4.5;期望姿态角限幅 ±35°,角速率指令限幅 ±180°/s。控制周期 400 Hz,陀螺低通滤波截止频率 80 Hz。这些数值仅用于说明参数关系,实际值必须通过辨识与试飞确定。
理解控制律,必须同时理解“信号链”和“能量链”。信号链从期望指令出发,经过制导律生成期望位置或航向,再经过姿态解算生成期望姿态,进入姿态控制器生成期望角速率,最后由角速率控制器生成力矩指令,经控制分配变成各电机 PWM 或舵面偏度。能量链则从电池、电调、电机、螺旋桨到机体,把电功率转化为推力与力矩。控制律设计得再好,如果执行机构已经饱和,闭环性能也会被物理上限截断。因此,限幅、抗积分饱和、控制分配优先级和故障降级逻辑,与控制参数同等重要。
验证闭环的核心思想是“逐级暴露风险、逐级增加置信度”。数字仿真可以快速遍历参数和故障场景,但它依赖模型精度;半物理试验把真实飞控板、真实传感器和真实执行机构接入仿真环境,能暴露时序、接口和实时性问题;系留飞行或带保护架的受限飞行可以验证基本稳定性和操纵方向;自由飞行才最终验证任务指标。每一级验证都要有明确的通过判据和退出条件,例如角速率跟踪误差均方根小于某阈值、阶跃响应超调小于 20%、相位裕度大于 45°、在指定风扰下位置漂移不超出安全半径。没有判据的“飞起来看看”不是验证,只是试错。
把上述框架落到具体设计,需要一套可操作的参数与判据体系。以姿态角速率环为例,设计时先确定带宽目标:多旋翼角速率环带宽通常取 10~25 rad/s,固定翼则根据机体尺寸和舵机速率取 3~15 rad/s。带宽不能无限提高,因为它受传感器噪声、滤波延迟、执行机构速率和结构模态限制。若陀螺噪声密度为 0.01 °/s/√Hz,低通滤波截止频率 80 Hz,则滤波引入的相位滞后在 20 rad/s 处约为 arctan(20/(2π×80))≈2.3°,影响有限;但若把截止频率降到 20 Hz,同样频率处滞后约 9°,会明显吃掉相位裕度。这就是为什么滤波器设计必须与控制带宽协同考虑。
控制分配是另一个容易被忽视但极其关键的环节。对于四旋翼,四个电机的推力到力矩的映射由机臂长度、电机位置和旋翼转向决定。若期望滚转力矩为 Mx、俯仰力矩为 My、偏航力矩为 Mz、总推力为 T,则分配矩阵把 [T, Mx, My, Mz] 映射为四个电机推力。当某个电机达到最大转速时,分配算法必须重新分配剩余力矩,否则会出现“指令饱和但积分器继续累积”的积分饱和现象,导致姿态响应迟滞甚至发散。工程上常用抗积分饱和策略:当执行机构饱和时暂停积分,或按饱和方向回退积分量。
验证判据应当与设计指标一一对应。例如,角速率阶跃响应要求上升时间小于 0.15 s、超调小于 15%、稳态误差小于 2%;姿态角跟踪要求正弦扫频下幅值衰减小于 3 dB、相位滞后小于 30°;位置悬停要求 60 s 内水平漂移均方根小于 0.5 m;抗风试验要求在 8 m/s 阵风下姿态角波动小于 5°、位置偏移小于 1.5 m。这些判据不是装饰,而是决定“能否进入下一级验证”的硬门槛。只有把需求、设计、验证串成一条可追溯的链条,控制律设计才从经验试凑变成可管理、可复现的工程过程。
学习建议:初学阶段不要急于调参。先画清楚信号链,确认每个环节的输入输出、量纲、正方向和限幅;再确认传感器反馈的延迟和噪声水平;最后才在仿真中从小增益开始逐步提高,观察阶跃响应、频响和抗扰表现。控制律的稳定性来自结构合理与裕度充足,而不是来自某一组“神奇参数”。
本课程后续将沿着这条主线展开:先建立飞行器动力学与坐标系约定,再分别讨论姿态控制、速度与位置控制、制导律、控制分配与容错,最后进入仿真、半物理和飞行验证方法。每一章都会围绕“对象—目标—约束—验证”四个维度展开,使读者不仅知道某个控制算法怎么写,更知道它为什么这样设计、在什么条件下有效、如何判断它是否真的达到了任务要求。