【控制】基于气动力的导弹姿态控制含Matlab源码附报告
2024-05-16 04:25:22
1 简介
对于大气层内飞行的导弹，为了使其准确的完成飞行，首要任务是使其姿态保持稳定。导弹的姿态控制系统是导弹飞行成败的关键系统之一，姿态控制过程和方法一直备受关注，它在导弹设计、使用、储存的整个生命周期中都意义重大。在此背景下，本文针对大气层内导弹的姿态控制方法进行研究。
首先建立了一系列坐标系来描述大气层内导弹的飞行特性，包括弹体坐标系、地面惯性坐标系、速度坐标系和弹道坐标系，之后对这些坐标系之间的变转换关系进行了推导。然后，推导计算大气层内导弹的动力学方程组、运动学方程组、攻角和侧滑角计算模型、弹道倾角和弹道偏角计算模型、气动力模型、气动力矩模型以及重力模型，由上述模型得出导弹的姿态控制系统数学模型。由于大气层内导弹的姿态控制数学模型具有强耦合、非线性的特点，因此先对其进行解耦和线性化处理，而后进行控制器设计。本文应用小扰动假设下的线性化方法，分别建立了各通道的传递函数。之后，运用PD控制方法对三个通道的控制律分别进行设计，使导弹能在要求时间内达到目标姿态。最后，设计MATLAB仿真程序，对控制律进行仿真验证，并对仿真结果进行分析。
仿真结果表明，对大气层内导弹姿态控制模型进行线性化及各通道解耦处理后，应用PD控制方法设计控制律，能够使系统实现快速、稳定的达到目标姿态的目的。
2 部分代码
clc;clear;%------------------------定义导弹、大气、地球等固定参数---------------------%Jx=2.95;Jy=168.2;Jz=168.2;m=300;S=0.0616;L=0.3;rho=1.2;g=9.8;i=10000;ii=i/10;t=zeros(1,ii-1);dt=0.001;H=pi/180;K=180/pi;%-------------------------定义初始位置参数---------------------------------%x=zeros(1,i);y=zeros(1,i);z=zeros(1,i);y(1)=30000;%-------------------------定义初始速度参数---------------------------------%V=zeros(1,i);Vx=zeros(1,i);Vy=zeros(1,i);Vz=zeros(1,i);V(1)=2275;Vx(1)=2275;%-------------------------定义初始弹道参数---------------------------------%theta=zeros(1,i);psiv=zeros(1,i);gammav=zeros(1,i);theta(1)=(40*pi)/180;%-------------------------定义初始姿态参数---------------------------------%htheta=zeros(1,i);psi=zeros(1,i);gamma=zeros(1,i);htheta(1)=40*H;psi(1)=0*H;gamma(1)=5*H;htheta0=50*H;psi0=10*H;gamma0=0*H;%---------------------------定义初始舵偏角---------------------------------%deltax=zeros(1,i);deltay=zeros(1,i);deltaz=zeros(1,i);%--------------------------定义初始姿态角速度参数---------------------------%omegax=zeros(1,i);omegay=zeros(1,i);omegaz=zeros(1,i);%-------------------------定义攻角/侧滑角----------------------------------%alpha=zeros(1,i);beta=zeros(1,i);dalpha=0;dbeta=0;%--------------------定义空气动力和空气动力矩-------------------------------%X=zeros(1,i);Y=zeros(1,i);Z=zeros(1,i);Mx=zeros(1,i);My=zeros(1,i);Mz=zeros(1,i);%--------------------------定义控制律参数----------------------------------%Kpx=-1.5; Kdx=-0.018;Kpy=-1.5; Kdy=-0.05;Kpz=-1.8; Kdz=-0.05;%--------------------------------定义绘图用数组----------------------------%hthetat=zeros(1,ii-1);psit=zeros(1,ii-1);gammat=zeros(1,ii-1);omegaxt=zeros(1,ii-1);omegayt=zeros(1,ii-1);omegazt=zeros(1,ii-1);xt=zeros(1,ii-1);yt=zeros(1,ii-1);zt=zeros(1,ii-1);Mxt=zeros(1,ii-1);Myt=zeros(1,ii-1);Mzt=zeros(1,ii-1);deltaxt=zeros(1,ii-1);deltayt=zeros(1,ii-1);deltazt=zeros(1,ii-1);%------------------------定义气动力、气动力矩的插值矩阵---------------------%B = [-6,-4,-2,0,2,4,6];A = [-6;-4;-2;0;2;3;4;6;8;10];CX = [0.926,0.750,0.636,0.583,0.614,0.722,0.888;0.758,0.596,0.511,0.468,0.489,0.570,0.726;0.644,0.504,0.426,0.398,0.411,0.487,0.614;0.602,0.477,0.399,0.367,0.390,0.458,0.574;0.650,0.508,0.428,0.410,0.415,0.502,0.627;0.699,0.547,0.463,0.434,0.449,0.533,0.674;0.762,0.601,0.512,0.471,0.497,0.585,0.739;0.921,0.749,0.628,0.578,0.613,0.735,0.902;1.136,0.949,0.817,0.763,0.800,0.934,1.115;1.405,1.212,1.080,1.029,1.067,1.200,1.388];CY = [-2.694,-2.563,-2.426,-2.351,-2.427,-2.605,-2.686;-1.854,-1.710,-1.642,-1.593,-1.618,-1.711,-1.800;-0.920,-0.818,-0.802,-0.794,-0.797,-0.798,-0.873;0.034,0.036,0.015,0.033,0.009,0.004,0.031;0.930,0.894,0.868,0.808,0.802,0.836,0.928;1.373,1.331,1.275,1.190,1.233,1.257,1.340;1.825,1.751,1.685,1.566,1.633,1.715,1.787;2.704,2.647,2.460,2.344,2.428,2.583,2.677;3.411,3.458,3.365,3.276,3.312,3.397,3.392;4.175,4.292,4.283,4.241,4.218,4.263,4.181];CZ = [2.703,1.833,0.932,0,-0.932,-1.833,-2.703;2.619,1.753,0.880,0,-0.880,-1.753,-2.619;2.479,1.634,0.846,0,-0.846,-1.634,-2.479;2.447,1.620,0.806,0,-0.806,-1.620,-2.447;2.513,1.670,0.816,0,-0.816,-1.670,-2.513;2.582,1.693,0.829,0,-0.829,-1.693,-2.582;2.637,1.719,0.845,0,-0.845,-1.719,-2.637;2.717,1.823,0.931,0,-0.931,-1.823,-2.717;2.700,1.930,1.000,0,-1.000,-1.930,-2.700;2.775,1.999,1.027,0,-1.027,-1.999,-2.775];MX = [-0.035,-0.008,0.030,0,-0.030,0.008,0.035;0.027,0.006,0.020,0,-0.020,-0.006,-0.027;0.021,0.060,0.008,0,-0.008,-0.060,-0.021;0.000,0.000,0.000,0,0.000,0.000,0.000;-0.017,-0.034,-0.002,0,0.002,0.034,0.017;-0.032,-0.047,0.001,0,-0.001,0.047,0.032;-0.034,-0.012,0.037,0,-0.037,0.012,0.034;0.014,0.028,0.038,0,-0.038,-0.028,-0.014;0.022,0.095,0.025,0,-0.025,-0.095,-0.022;0.007,0.195,0.098,0,-0.098,-0.195,-0.007];MY = [2.096,1.498,0.750,0,-0.750,-1.498,-2.096;1.893,1.314,0.671,0,-0.671,-1.314,-1.893;1.658,1.126,0.612,0,-0.612,-1.126,-1.658;1.612,1.138,0.530,0,-0.530,-1.138,-1.612;1.763,1.224,0.564,0,-0.564,-1.224,-1.763;1.873,1.223,0.545,0,-0.545,-1.223,-1.873;2.010,1.291,0.612,0,-0.612,-1.291,-2.010;2.257,1.549,0.810,0,-0.810,-1.549,-2.257;2.398,1.838,0.988,0,-0.988,-1.838,-2.398;2.729,2.137,1.126,0,-1.126,-2.137,-2.729];MZ = [2.320,2.042,1.857,1.738,1.848,2.083,2.243;1.617,1.287,1.216,1.243,1.192,1.260,1.456;0.732,0.501,0.527,0.566,0.519,0.455,0.616;-0.164,-0.181,-0.141,-0.147,-0.132,-0.130,-0.182;-0.964,-0.898,-0.840,-0.751,-0.729,-0.787,-0.956;-1.366,-1.303,-1.186,-1.050,-1.094,-1.166,-1.322;-1.763,-1.647,-1.525,-1.334,-1.422,-1.579,-1.713;-2.525,-2.469,-2.077,-1.881,-2.011,-2.349,-2.498;-3.078,-3.052,-2.793,-2.608,-2.734,-2.994,-3.040;-3.690,-3.709,-3.563,-3.438,-3.493,-3.692,-3.699];%---------------------------------循环计算--------------------------------%end%-------------------------------绘图--------------------------------------%figure(1)plot(t/100,hthetat*K)title('俯仰角变化曲线')xlabel('时间')ylabel('俯仰角')grid onfigure(2)plot(t/100,psit*K)title('偏航角变化曲线')xlabel('时间')ylabel('偏航角')grid onfigure(3)plot(t/100,gammat*K)title('滚转角变化曲线')xlabel('时间')ylabel('滚转角')grid onfigure(4)plot(t/100,omegaxt*K)title('角速度变化曲线')xlabel('时间')ylabel('滚转角速度')grid onfigure(5)plot(t/100,omegayt*K)title('角速度变化曲线')xlabel('时间')ylabel('偏航角速度')grid onfigure(6)plot(t/100,omegazt*K)title('角速度变化曲线')xlabel('时间')ylabel('俯仰角速度')grid onfigure(7)plot3(zt,xt,yt)title('导弹运动轨迹')xlabel('Z')zlabel('Y')ylabel('X')grid onfigure(8)plot(t/100,Mxt)title('力矩变化曲线')xlabel('时间')ylabel('滚转力矩')grid onfigure(9)plot(t/100,Myt)title('力矩变化曲线')xlabel('时间')ylabel('偏航力矩')grid onfigure(10)plot(t/100,Mzt)title('力矩变化曲线')xlabel('时间')ylabel('俯仰力矩')grid onfigure(11)plot(t/100,deltazt)title('舵偏角变化曲线')xlabel('时间')ylabel('俯仰通道舵偏角')grid onfigure(12)plot(t/100,deltayt)title('舵偏角变化曲线')xlabel('时间')ylabel('偏航通道舵偏角')grid onfigure(13)plot(t/100,deltaxt)title('舵偏角变化曲线')xlabel('时间')ylabel('滚转通道舵偏角')grid on
3 仿真结果
4 参考文献
[1]姚红, 闫野, 周伯昭. 基于Matlab的弹道导弹姿态控制系统设计与仿真软件研究[J]. 系统仿真学报, 2004, 16(11):3.
博主简介：擅长智能优化算法、神经网络预测、信号处理、元胞自动机、图像处理、路径规划、无人机等多种领域的Matlab仿真，相关matlab代码问题可私信交流。
部分理论引用网络文献，若有侵权联系博主删除。
【控制】基于气动力的导弹姿态控制含Matlab源码附报告相关推荐
- 【图像去噪】基于最小二乘方滤波实现图像去噪含Matlab源码
1 简介 基于最小二乘方滤波实现图像去噪含Matlab源码 2 部分代码 function varargout = zuixiaoercheng(varargin)% ZUIXIAOERCHENG ...
- 【水果识别】基于计算机视觉实现水果识别含Matlab源码
1 简介 自"农业 4.0"时代的来临,以"互联网+"为驱动的农业技术已成为发展农业强有力的支撑.在果蔬业中,果蔬分类通常由经过训练的人员人工评估农产品或农作物 ...
- 【水果识别】基于形态学实现水果识别含Matlab源码
1 简介 数学形态学操作可以分为二值形态学和灰度形态学,灰度形态学由二值形态学扩展而来.数学形态学有2个基本的运算,即腐蚀和膨胀,而腐蚀和膨胀通过结合又形成了开运算和闭运算. 开运算就是先腐蚀再膨胀, ...
- 【图像去噪】基于小波变换实现图像去噪分析含Matlab源码
1 简介 在图像处理过程中,图像噪声对图像的后续处理和清晰度影响较大.因此,对图像的降噪至关重要.随着小波变换的不断优化,小波变换广泛应用在图像降噪方面.该文基于软阈值的小波图像增强方法,通过实验论述 ...
- 【图像分割】基于FLICM算法实现图像分割含Matlab源码
1 简介 聚类就是把具有相似性的事物区分开并加以分类.聚类分析是依据研究对象(样品 或指标)的特征,对其进行分类.其目标是:组内对象之间是相似的或是相关的,而不同组中的对象不相同或者是不相关的,聚类过 ...
- 【图像处理】基于分形插值算法实现换脸含Matlab源码
1 简介 2 部分代码 function result = skin(Y,Cb,Cr)a = 25.39;b = 14.15;ecx = 1.72;ecy = 2.43;sita = 2.64;cx ...
- 【条形码识别】基于计算机视觉实现二维条形码识别含Matlab源码
1 简介 在信息时代的今天,随着计算机技术的发展,条形码作为一种简单.方便.廉价.高速的信息保存和传输技术,在世界各地应用广泛,是商品进入国际市场的通行证. 本论文的研究基于一种全新的购物理念,即无需 ...
- 【邮政编码识别】基于计算机视觉实现邮政编码识别含Matlab源码
1 简介 邮政包裹的自动分拣可以使邮政部门节省大量的人力物力,有效地提高邮政部门的邮件分拣效率,具有广阔的应用前景.该文对邮政包裹地址标签上的邮政编码识别进行了比较深入的研究,在简化模型的基础之上,详 ...
- 【人脸识别】基于KL变换人脸识别含Matlab源码
1 简介 系统的设计是利用奇异值分解确定KL变换系数,并对人脸训练样本和待识别样本进行KL变换,对变换向量进行最小距离判别决策.对ORL人脸数据库的实验结果表明正确识别率随着变换系数维数的增加而增加, ...
最新文章
- 转 LIST INCARNATION OF DATABASE
- opencv鼠标画路径点
- CHM综述-建立因果关系,合成菌群在植物菌群研究中的机会
- C. Little Girl and Maximum Sum【差分 / 贪心】
- idea包名呈现层级显示
- TCP/IP的分层负载
- 使用bootstrap-table插件
- mysql死锁无法查询_MySQL死锁导致无法查询
- 腾讯、网易回应被约谈：严格落实未成年人防沉迷规定
- Qt_QDir_常见的操作
- python标准库——random模块
- http://www.cnblogs.com/peida/archive/2013/05/31/3070790.html深入理解Java：SimpleDateFormat安全的时间格式化...
- 运行c语言程序显示已停止运行程序,c – “此应用程序已请求运行时以不寻常的方式终止它.”...
- gambit多面整合
- 电脑键盘上的快捷建大全
- 使用github免费搭建个人博客后的写作及上传说明
- ERROR: torch-1.6.0+cu101-cp37-cp37m-win_amd64.whl is not a supported wheel on this platform.
- 喜欢花，喜欢海，喜欢日出和日落
- maven项目安装本地包实战演示
- 【创作赢红包】如何提高写作水平？让写作成为你的强项。