基于LQR控制的四旋翼无人机拦截系统设计与仿真

1. 项目概述

这个项目实现了一个基于LQR控制的四旋翼无人机系统，用于监控受限空域并拦截未经授权的入侵无人机。系统需要完成三个关键任务：稳定悬停、追踪拦截入侵目标、以及在干扰环境下携带捕获的无人机返回巢穴。整个控制系统采用Matlab进行建模和仿真，验证了LQR控制在复杂无人机任务中的有效性。

四旋翼无人机因其垂直起降能力和灵活机动性，在安防监控领域具有独特优势。但它的非线性动力学特性也给精确控制带来了挑战。本项目通过线性化处理和LQR控制设计，实现了对无人机复杂飞行状态的有效控制，为类似安防应用提供了可参考的技术方案。

2. 系统建模与线性化

2.1 四旋翼动力学模型

四旋翼无人机的动力学模型可以用以下方程描述：

code复制位置动力学：
m·ẍ = (cosφsinθcosψ + sinφsinψ)·u1 - kx·ẋ
m·ÿ = (cosφsinθsinψ - sinφcosψ)·u1 - ky·ẏ
m·z̈ = (cosφcosθ)·u1 - mg - kz·ż

姿态动力学：
Ixx·φ̈ = θ̇·ψ̇(Iyy - Izz) + l·u2 - kφ·φ̇ 
Iyy·θ̈ = φ̇·ψ̇(Izz - Ixx) + l·u3 - kθ·θ̇
Izz·ψ̈ = φ̇·θ̇(Ixx - Iyy) + u4 - kψ·ψ̇

其中，u1是总升力，u2-u4是三个轴向的力矩，l是电机到重心的距离，k是阻尼系数。

2.2 线性化处理

由于原始模型具有强非线性特性，我们在悬停状态附近进行线性化：

1. 假设俯仰和滚转角很小（φ≈0，θ≈0）
2. 忽略高阶小量
3. 在平衡点进行泰勒展开

线性化后的状态空间方程为：

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

其中状态向量x包含位置、姿态及其导数，控制向量u包含四个电机的推力。通过Matlab符号计算得到的雅可比矩阵：

matlab复制% 计算雅可比矩阵
A = jacobian(f, z);
B = jacobian(f, u);

% 在平衡点求值
for i = 1:4
    A = subs(A, u(i), p(3)*p(1)/4); 
    B = subs(B, u(i), p(3)*p(1)/4);
end
A = dou