基于LQR控制的四旋翼无人机自主追踪系统设计

1. 项目概述

四旋翼无人机作为一种具有垂直起降能力的飞行平台，在监控、侦查、物流等领域展现出巨大潜力。本项目针对受限空域监控这一特定场景，设计了一套基于LQR（线性二次调节器）的控制系统，使四旋翼能够自主完成从巢穴起飞、追踪入侵无人机到最终捕获的全流程任务。

在实际应用中，这套系统需要解决三个核心问题：首先是稳定悬停控制，这是所有飞行任务的基础；其次是动态轨迹追踪，需要实时调整飞行姿态以匹配目标运动；最后是抗干扰返航，确保在捕获目标后能稳定返回。LQR控制因其在最优控制和抗干扰方面的优势，成为本项目的理想选择。

提示：四旋翼动力学具有强耦合、非线性的特点，直接设计控制器十分困难。通常的做法是在平衡点附近进行线性化，这也是本项目采用LQR控制的前提。

2. 系统建模与线性化

2.1 四旋翼动力学模型

四旋翼的动力学特性可以用12维状态向量描述，包括位置(x,y,z)、姿态角(φ,θ,ψ)及其对应的一阶导数。其非线性动力学方程可表示为：

code复制ẋ = vx
ẏ = vy
ż = vz
φ̇ = p
θ̇ = q
ψ̇ = r
v̇x = (sinψ sinφ + cosψ sinθ cosφ)U1/m
v̇y = (-cosψ sinφ + sinψ sinθ cosφ)U1/m 
v̇z = g - (cosθ cosφ)U1/m
ṗ = [Iy-Iz]/Ix q r + U2/Ix
q̇ = [Iz-Ix]/Iy p r + U3/Iy 
ṙ = [Ix-Iy]/Iz p q + U4/Iz

其中U1-U4为控制输入，分别对应总推力和三个轴向力矩。Ix,Iy,Iz为转动惯量，m为无人机质量。

2.2 平衡点线性化

为应用LQR控制，需要在悬停平衡点附近对系统进行线性化。选择典型的悬停状态作为工作点：

• 姿态角φ=θ=ψ=0
• 角速度p=q=r=0
• 位置任意，速度为零
• 控制输入U1=mg, U2=U3=U4=0

使用泰勒展开保留一阶项，得到线性化后的状态空间方程：

code复制ẋ = A x + B u
y = C x

其中A和B矩阵可通过计算雅可比矩阵得到。在MATLAB中，这一过程可以通过符号计算工具箱自动完成，如项目代码所示：

matlab复制% 定义状态变量和控制