1 简介

本文基于对四轴飞行器的飞行原理,分析了其做各种飞行动作时的力学原理.在假设理想状态下通过坐标转换建立了动力学模型并进行进一步简化.最后采用增量式PID算法设计控制系统,在Simulink上搭建模型进行仿真,并对仿真结果分析.

2 部分代码

  1.  
  2.           
  3.           
  4.            
  5.            %%%%%%%%%%%%%%% desired position  %%%%%%%%%%%%%%%%%%%%%%
  6.            
  7.            xdes = 10;
  8.            
  9.            ydes = 18;
  10.            
  11.            zdes = -20;
  12.            
  13.            %%%%%%%%%%%%%%%structural parameters %%%%%%%%%%%%%%%%%%%
  14.            
  15.            m = 0.5;
  16.            
  17.            g = 9.8;
  18.            
  19.            Ixx =0.114;
  20.            
  21.            Iyy = 0.114;
  22.            
  23.            Izz = 0.158;
  24.            
  25.            yaw = 3/57.3;
  26.            
  27.            L = 0.2;
  28.            
  29.            %%%%%%%%%%%%%%%%%%  save PID for x  %%%%%%%%%%%%%%%%%%%%
  30.            
  31.            kpx = 0.8;
  32.            
  33.            kix = 1e-4;
  34.            
  35.            kdx = 1.3;
  36.            
  37.            %%%%%%%%%%%%%%%%%%  save PID for y  %%%%%%%%%%%%%%%%%%%%
  38.            
  39.            kpy = 0.8;
  40.            
  41.            kiy = 3e-4;
  42.            
  43.            kdy = 1.3;
  44.            
  45.            %%%%%%%%%%%%%%%%%%  save PID for z  %%%%%%%%%%%%%%%%%%%%
  46.            
  47.            kpz = 1.2;
  48.            
  49.            kiz = 1e-6;
  50.            
  51.            kdz = 2;
  52.            
  53.            %%%%%%%%%%%%%%%%%%  save PD for phi  %%%%%%%%%%%%%%%%%%%
  54.            
  55.            kpphi = 2000;
  56.            
  57.            kdphi = 4000;
  58.            
  59.            %%%%%%%%%%%%%%%%%%  save PD for theta  %%%%%%%%%%%%%%%%%
  60.            
  61.            kptheta = 2000;
  62.            
  63.            kdtheta = 4000;
  64.            
  65.            %%%%%%%%%%%%%%%%%%  save PD for psi  %%%%%%%%%%%%%%%%%%%
  66.            
  67.            kppsi = 800;
  68.            
  69.            kdpsi = 4000;
  70.            
  71.            %%%%%%%%%%%%%%%%%%% save tsim %%%%%%%%%%%%%%%%%%%%%%%%%%
  72.            
  73.            tsim = 20;
  74.           
  75.
  • 1.
  • 2.
  • 3.
  • 4.
  • 5.
  • 6.
  • 7.
  • 8.
  • 9.
  • 10.
  • 11.
  • 12.
  • 13.
  • 14.
  • 15.
  • 16.
  • 17.
  • 18.
  • 19.
  • 20.
  • 21.
  • 22.
  • 23.
  • 24.
  • 25.
  • 26.
  • 27.
  • 28.
  • 29.
  • 30.
  • 31.
  • 32.
  • 33.
  • 34.
  • 35.

3 仿真结果

【飞行器】模拟四旋翼飞行器飞行含Matlab源码_参考文献

【飞行器】模拟四旋翼飞行器飞行含Matlab源码_参考文献_02

4 参考文献

[1]黄伟. 四轴飞行器的动态特性及MATLAB仿真[J]. 福建质量管理, 2018, 000(019):298.

博主简介：擅长智能优化算法、神经网络预测、信号处理、元胞自动机、图像处理、路径规划、无人机等多种领域的Matlab仿真，相关matlab代码问题可私信交流。

部分理论引用网络文献，若有侵权联系博主删除。

【飞行器】模拟四旋翼飞行器飞行含Matlab源码_无人机_03