✅作者简介：热爱科研的Matlab仿真开发者，擅长数学建模、数据处理、建模仿真、程序设计、完整代码获取、论文复现及科研仿真。

🍎 往期回顾关注个人主页：Matlab科研工作室

 👇 关注我领取海量matlab电子书和数学建模资料 

🍊个人信条：格物致知,完整Matlab代码获取及仿真咨询内容私信。

🔥 内容介绍 

本套四旋翼无人机PID轨迹跟踪仿真模型，完全基于牛顿-欧拉六自由度动力学方程搭建，采用经典串级PID控制架构，完整覆盖三维位置环、姿态角内环的全链路闭环控制，仿真结束后可自动生成三维飞行轨迹图、三轴姿态角响应曲线、三维位置跟踪对比曲线四大类可视化结果，直观验证PID控制器的轨迹跟踪精度与动态响应性能，可直接用于无人机控制算法学习、参数整定与后续高级控制策略的基准对比测试。

1 仿真模型总体架构

整套Simulink模型采用模块化分层设计，从顶层到底层依次为参考轨迹生成模块、位置外环PID控制器、姿态解算模块、姿态内环PID控制器、六自由度非线性动力学模型、三维可视化子系统与结果自动绘图模块。模型仿真步长设置为0.005s，对应200Hz控制频率，完全匹配工程级无人机飞控的典型控制周期，所有物理参数完全参照0.2kg级微型四旋翼的真实物理特性配置，保证仿真结果与实机飞行特性高度吻合。

2 核心动力学模型搭建

基于牛顿-欧拉方程建立完整的六自由度刚体动力学模型，同时融合空气阻尼、陀螺效应与重力补偿项，真实还原四旋翼的欠驱动运动特性：

• 坐标系定义：明确惯性坐标系与机体坐标系的Z-Y-X欧拉角转换关系，通过旋转矩阵完成机体系力/力矩到惯性系的坐标变换，同时内置四元数姿态解算逻辑，避免欧拉角在±90°时出现奇异点问题

• 平移动力学：通过牛顿第二定律计算无人机三轴平动加速度，总升力直接映射到机体Z轴方向，经过坐标变换后在惯性系下完成三轴速度与位置的积分更新

• 旋转动力学：完整考虑转动惯量耦合项与陀螺效应，解算滚转、俯仰、偏航三个轴向的角加速度，积分更新角速度与欧拉角姿态

• 执行器模型：添加电机一阶惯性动态环节，模拟真实无人机旋翼的转速响应延迟，提升仿真结果的工程参考价值

3 串级PID控制器设计

采用“位置外环+姿态内环”的分层串级PID控制架构，完全适配四旋翼欠驱动系统的控制特性，内外环带宽解耦避免控制回路耦合震荡：

3.1 三维位置外环PID

以三维空间的期望位置与无人机实际位置的误差作为输入，通过PID控制器计算三轴期望加速度，再通过几何映射关系转换为期望滚转角、期望俯仰角与总升力指令。其中高度方向控制独立解算总升力，XY水平方向的位置误差通过反正切函数映射为对应的期望姿态角，同时添加姿态角限幅逻辑，将最大倾斜角度限制在±30°以内，保证飞行安全。位置环PID参数经过工程化整定，比例系数范围0.5~2.0，微分系数匹配0.1~0.3s的时间常数，保证位置跟踪响应快速且无明显超调。

3.2 姿态角内环PID

以期望姿态角与实际欧拉角的误差作为输入，通过PID控制器直接计算三个轴向的控制力矩，驱动无人机快速跟踪期望姿态指令。内环控制引入角速率反馈项，大幅提升姿态动态响应速度，抑制飞行过程中的姿态震荡。姿态环PID比例系数范围3.0~8.0，远高于位置环带宽，保证姿态回路响应速度远快于位置回路，避免系统出现耦合不稳定问题。

4 预设参考轨迹与仿真工况

模型内置可自定义的三维参考航点序列，默认配置7个连续航点，覆盖垂直起飞、水平巡航、空间爬升、定点悬停、返航降落全飞行流程：

• 航点1：从地面(0,0,0)垂直起飞至悬停点(0,0,1.5m)，完成定点悬停2s

• 航点2：水平移动至(2,0,1.5m)，完成直线轨迹跟踪

• 航点3：沿Y轴方向移动至(2,3,1.5m)，完成水平平面内的折线飞行

• 航点4：空间爬升移动至(2,3,3m)，验证高度与水平位置的协同跟踪能力

• 航点5：沿对角线移动至(0,0,3m)，完成斜向三维轨迹跟踪

• 航点6：保持在(0,0,3m)定点悬停3s，验证定点稳态精度

• 航点7：垂直降落返回原点(0,0,0)，完成整个飞行流程

所有航点设置0.3m的切换阈值，当无人机实际位置与当前目标航点的距离小于阈值时，自动平滑切换至下一个航点，全程无需人工干预。

5 自动可视化输出结果

仿真运行完成后，脚本自动生成四类核心可视化图像，完整展示全飞行过程的控制性能：

• 三维位置轨迹图：在三维坐标系中同时绘制参考期望轨迹与无人机实际飞行轨迹，标记所有航点位置与起终点，直观展示无人机三维空间飞行的轨迹重合度，可直接观察飞行过程中是否出现轨迹偏离与震荡

• 三轴姿态角度响应图：分三个子窗口分别绘制滚转角、俯仰角、偏航角的实际响应曲线与期望姿态指令曲线，清晰展示姿态跟踪的动态响应速度、超调量与稳态精度，验证姿态内环控制的稳定性

• 三维位置跟踪对比图：分别绘制X、Y、Z三个轴向的期望位置与实际位置的对比曲线，标注每个航点的切换时刻，直观展示每个轴向的位置跟踪收敛过程

• 位置误差与控制量曲线图：展示三维空间位置跟踪误差的实时变化曲线，以及四个旋翼的控制输入量变化，量化统计全飞行过程的最大跟踪误差与稳态误差。

⛳️ 运行结果

🔗 参考文献

🍅往期回顾扫扫下方二维码