4. 多旋翼飞行器模型线性化与解耦
前三节建立的非线性六自由度模型虽然精确,却难以直接用于控制器设计:姿态通道与位置通道通过旋转矩阵耦合,气动力与速度呈平方关系,四个旋翼转速到六个自由度的映射存在冗余。工程上普遍采用“悬停点附近线性化 + 小扰动假设”的方法,把非线性模型转化为线性时不变(LTI)状态空间模型,再据此推导传递函数、分析通道耦合、设计解耦控制器。本节围绕这一主线展开。
一、为什么在悬停点线性化
多旋翼最典型、最频繁的工作状态是悬停或低速平飞。此时姿态角接近零,机体近似水平,旋翼拉力方向几乎与机体 z 轴重合,气动阻尼项可忽略。设平衡点为:位置任意、速度为零、姿态角为零、角速度为零、四个旋翼转速相等为 Ω₀。在该点附近,系统各状态量只发生小幅度变化,非线性项可用一阶泰勒展开近似,从而得到线性模型。
小扰动假设的具体含义是:滚转 φ、俯仰 θ 满足 sinθ≈θ、cosθ≈1、tanθ≈θ,且 φθ、θψ 等二阶乘积项可忽略;速度分量 u、v、w 远小于悬停诱导速度,气动力近似线性;旋翼转速增量 ΔΩ 远小于 Ω₀,拉力增量与转速增量近似成正比。这些假设把原本复杂的耦合关系简化为可解析处理的线性关系。
二、状态空间表达
取状态向量 x = [φ, θ, ψ, p, q, r, u, v, w, x, y, z]ᵀ,输入向量 u = [ΔΩ₁, ΔΩ₂, ΔΩ₃, ΔΩ₄]ᵀ(四旋翼为例,ΔΩᵢ 为各旋翼转速相对悬停平衡值的增量)。线性化后系统可写成 ẋ = Ax + Bu 的标准形式。其中 A 矩阵由姿态运动学、刚体转动动力学和平移动力学三部分构成,B 矩阵描述四个旋翼转速增量对力矩与合力的影响。
为便于理解,把 A、B 按物理意义分块:姿态角与角速度构成 6 维姿态子系统,速度与位置构成 6 维位置子系统,两者通过姿态角对拉力的投影方向耦合。B 矩阵中,四个旋翼转速增量先经混控矩阵映射为总拉力增量 ΔT、滚转力矩增量 ΔL、俯仰力矩增量 ΔM、偏航力矩增量 ΔN,再分别作用于对应通道。这一“转速→力矩/拉力→状态”的两级映射,正是后续解耦设计的切入点。
三、传递函数推导
在零初始条件下对线性状态空间模型取拉普拉斯变换,可得 sX(s) = AX(s) + BU(s),整理得 X(s) = (sI − A)⁻¹BU(s)。对某一输出 y = Cx,传递函数为 G(s) = C(sI − A)⁻¹B。以滚转通道为例,若只保留 φ、p 与 ΔL 的关系,忽略其他通道影响,可得到简化传递函数:
φ(s) / ΔL(s) = 1 / (Ixx · s²)
考虑旋翼一阶动态(时间常数 τ)后:
φ(s) / ΔL(s) = 1 / [Ixx · s² · (τs + 1)]
该式表明:滚转角对滚转力矩的响应是双积分环节,叠加旋翼动态后为三阶系统。同理,俯仰通道形式相同,偏航通道因反扭矩与转速关系不同,传递函数中会出现一阶惯性项。高度通道为 z(s)/ΔT(s) = 1/(m·s²),水平位置通道则通过姿态角间接耦合,例如 x(s)/θ(s) = g/s²(小角度下重力分量提供水平加速度)。
这些传递函数是后续 PID 整定、频域分析和解耦补偿器设计的基础。实际工程中,常把姿态内环设计为高带宽,使姿态角快速跟踪指令,从而把位置外环近似为“姿态指令→水平加速度”的线性关系,实现位置与姿态的层级解耦。
四、通道耦合分析与解耦思路
线性化模型虽然简化了非线性,但通道间耦合并未完全消失。主要耦合路径有三条:其一,滚转与偏航通过角速度交叉项 p·r、q·r 耦合,在大角速度机动时明显;其二,俯仰角 θ 同时影响水平 x 方向加速度和高度 z 方向拉力分量,形成“俯仰—高度”耦合;其三,四个旋翼转速到四个控制量的混控矩阵若设计不当,会产生通道间静态耦合。
解耦的工程做法通常分两步。第一步是静态解耦:通过混控矩阵的逆运算,把期望的总拉力、三轴力矩指令分配到四个旋翼转速,使输入到力矩/拉力的映射近似对角化。第二步是动态解耦:在姿态控制器中引入交叉前馈或采用 LQR、H∞ 等现代控制方法,抑制角速度交叉项和姿态—位置耦合。对于大多数中小型多旋翼,姿态内环带宽做到位置外环的 5~10 倍,即可在工程精度内近似认为通道独立。
五、从模型到控制器的衔接
线性化与解耦的最终目的是得到一组可独立设计的通道模型。姿态通道可视为三个近似独立的双积分(或三阶)系统,位置通道可视为三个近似独立的双积分系统,输入分别为姿态角和总拉力。基于此,工程上常采用串级 PID:位置外环输出姿态角指令,姿态内环输出力矩指令,混控模块把力矩指令转为旋翼转速。整定时先内环后外环,先滚转/俯仰后偏航,先悬停后低速平飞,逐步验证线性化假设的适用范围。
需要强调的是,线性化模型只在悬停点附近成立。当飞行器做大倾角机动、高速飞行或强风扰动时,非线性项不可忽略,此时应回到非线性模型,或采用增益调度、反馈线性化等方法扩展控制器的有效范围。理解线性化的边界,与掌握线性化方法本身同样重要。