四旋翼无人机8字形轨迹的LPV-MPC控制方法

1. 项目概述

四旋翼无人机的轨迹跟踪控制一直是控制领域的研究热点。8字形轨迹作为一种典型的复杂空间路径，包含了直线、圆弧和过渡段等多种运动形态，对控制系统的动态性能和鲁棒性提出了较高要求。传统PID控制方法在处理这种复杂轨迹时往往力不从心，而线性MPC在面对无人机强非线性特性时也存在明显局限。

本项目创新性地采用了位置-姿态双闭环控制架构，其中姿态内环采用LPV-MPC（线性参数变化模型预测控制）技术。这种架构设计充分考虑了四旋翼系统的动力学特性：位置环负责宏观轨迹跟踪，姿态环则处理快速动态响应。LPV-MPC的引入使得系统能够实时适应无人机在不同飞行状态下的非线性特性，同时通过模型预测控制的滚动优化机制，有效处理了执行器约束问题。

2. 系统建模与问题描述

2.1 四旋翼动力学模型

四旋翼无人机是一个典型的欠驱动系统，具有6个自由度（位置x,y,z和姿态φ,θ,ψ）却只有4个控制输入（四个电机的转速）。其动力学模型可以表示为：

位置动力学：
mẍ = (cosφsinθcosψ + sinφsinψ)u₁
mÿ = (cosφsinθsinψ - sinφcosψ)u₁
mz̈ = (cosφcosθ)u₁ - mg

姿态动力学：
Iₓφ̈ = θ̇ψ̇(I_y - I_z) + lu₂
I_yθ̈ = φ̇ψ̇(I_z - Iₓ) + lu₃
I_zψ̈ = φ̇θ̇(Iₓ - I_y) + u₄

其中u₁～u₄为虚拟控制量，与四个电机的转速平方和、差相关。这种强耦合的非线性特性是控制设计的主要挑战。

2.2 8字形轨迹定义

本项目设计的8字形轨迹由两个半径相同的圆在水平面内相切拼接而成，同时在垂直方向线性爬升。数学表达式为：

水平面：
x(t) = R·sign(sin(πt/T))·(1 - cos(2πt/T))
y(t) = R·sin(2πt/T)

垂直方向：
z(t) = z₀ + v_z·t

其中R为圆的半径，T为完成一个完整8字的时间周期，v_z为垂直爬升速度。这种轨迹包含了速度方向突变、曲率变化等典型挑战。

3. 控制架构设计

3.1 双闭环控制结构

系统采用分层控制策略，分为位置外环和姿态内环：

位置环（20ms周期）：

1. 接收轨迹生成器提供的参考位置、速度和加