无人机二维PID轨迹跟踪实现与参数整定指南

1. 从零实现二维无人机PID轨迹跟踪

去年给实验室的四旋翼飞行器做航迹跟踪时，我花了整整三周时间才调出理想的PID参数。当时最大的误区就是一开始就上三维空间，结果被欧拉角、姿态解耦等问题搞得焦头烂额。后来发现，从二维平面入手才是明智之选——既能验证核心算法，又避免了不必要的复杂度。

Matlab的Simulink环境简直是控制算法开发的利器。不需要焊接电路板，不用冒着炸机风险做实物测试，一个.m脚本就能完成从算法设计到效果验证的全流程。这次我们就用最基础的PID控制器，实现无人机对预设轨迹的跟踪控制。

重要提示：本文所有代码基于Matlab R2022a开发，部分函数在早期版本可能需要调整。建议使用2019b及以上版本运行示例。

2. 系统建模与问题定义

2.1 无人机简化动力学模型

在二维平面中，我们将四旋翼简化为一个质点，其运动方程可以表示为：

matlab复制% 状态向量定义 [x; y; vx; vy]
A = [0 0 1 0; 
     0 0 0 1;
     0 0 -0.2 0;  % x方向阻尼系数
     0 0 0 -0.2]; % y方向阻尼系数
B = [0 0;
     0 0;
     1 0;
     0 1];  % 控制输入矩阵
C = eye(4);
D = zeros(4,2);
sys = ss(A,B,C,D);  % 创建状态空间模型

这个模型忽略了姿态动力学，但包含了速度阻尼项（-0.2系数），更接近真实飞行器的行为。在实际调试中，我发现加入阻尼项后PID参数更容易收敛。

2.2 轨迹生成方法

常用的测试轨迹包括：

• 圆形轨迹：最考验控制器的动态性能
• 8字轨迹：包含方向突变，测试抗干扰能力
• 阶跃响应：验证稳态性能

这里以圆形轨迹为例：

matlab复制t = 0:0.1:20;
ref_x = 5*sin(0.5*t);  
ref_y = 5*cos(0.5*t);

2.3 PID控制器结构设计

采用位置式PID，控制框图如下：

code复制参考轨迹 → PID控制器 → 无人机模型 → 当前位置
                ↑                |
                └──