四旋翼无人机动力学建模与LQR控制算法实践

1. 四旋翼无人机系统概述

四旋翼无人机作为典型的欠驱动系统，凭借其结构简单、机动性强等特点，在航拍、巡检、农业植保等领域获得广泛应用。这类飞行器通过四个旋翼转速的协调控制实现六自由度运动，其动力学特性表现出强非线性、强耦合的特点。我在实际飞控系统开发中发现，精确的数学模型和先进的控制算法是保证飞行性能的关键。

典型的四旋翼系统包含以下几个核心子系统：

• 机体动力学模型：描述飞行器在三维空间中的运动规律
• 传感器系统：包括IMU、气压计等用于状态感知
• 控制算法：将期望轨迹转化为电机控制指令
• 状态估计模块：从噪声观测中重构系统状态

2. 四旋翼动力学建模

2.1 坐标系定义

建立合理的坐标系是建模的基础步骤。通常采用两种坐标系：

1. 地面惯性坐标系（I系）：固定于地面，Z轴垂直向上
2. 机体坐标系（B系）：固连于无人机质心，X轴指向机头方向

两坐标系间的转换通过旋转矩阵R∈SO(3)实现，该矩阵由欧拉角(φ,θ,ψ)或四元数描述。实际应用中我推荐使用四元数表示，可避免万向节锁问题。

2.2 刚体动力学方程

基于牛顿-欧拉方程，四旋翼的六自由度动力学模型可表示为：

平移动力学：
m(d²r/dt²) = R·F - mg·ez

旋转动力学：
I·(dω/dt) + ω×(I·ω) = M

其中：

• m为无人机质量
• I∈R^(3×3)为惯性张量矩阵
• F=[0,0,∑Fi]^T为总升力
• M=[Mx,My,Mz]^T为机体力矩

2.3 旋翼动力学特性

每个旋翼产生的升力Fi和反扭矩Mi可建模为：
Fi = kF·ωi²
Mi = kM·ωi²

其中ωi为第i个电机的转速，kF和kM为升力和扭矩系数。在实际系统辨识中，我发现这两个参数会随电池电压变化而漂移，需要在线校准。

3. 带积分动作的LQR控制器设计

3.1 系统线性化

在悬停点附近对非线性模型进行泰勒展开，得到线性化模型：
ẋ = Ax + Bu

状态向量x通常选取为：
x = [Δx,Δy,Δz,Δvx,Δvy,Δvz,Δφ,Δθ,Δψ,Δp,Δq,Δr]^T

3.2 LQR控制器设计

线性二次型调节器通过最小化代价函数：
J = ∫(x^TQx + u^TRu)dt

求解Riccati方程得到最优