飞行器控制实验报告

-.z.HarbinInstituteofTechnology飞行器制导与控制实验报告专业：自动化班级：**：1120410333**：设计时间：2015/12/12上机实验1：使用四阶龙格库塔法求解微分方程先定义参数，初值条件可以自己任取。源程序：function[*,y]=M1(fun,*0,*t,y0,PointNum)ifnargin<4|PointNum<=0PointNum=100;endifnargin<3y0=0;endy(1,:)=y0(:)';h=(*t-*0)/(PointNum-1);*=*0+[0:(PointNum)]'*h;fork=1:(PointNum)f1=h*feval(fun,*(k),y(k,:));f1=f1(:)';f2=h*feval(fun,*(k)+h/2,y(k,:));f2=f2(:)';f3=h*feval(fun,*(k)+h/2,y(k,:));f3=f3(:)';f4=h*feval(fun,*(k)+h,y(k,:));f4=f4(:)';y(k+1,:)=y(k,:)+(f1+2*(f2+f3)+f4)/6;end2、运行文件：*0=0;*t=2;Num=100;h=(*t-*0)/(Num-1);*=*0+[0:Num]*h;a=1;yt=1-e*p(-a**);fun=inline('-y+1','*','y');y0=0;PointNum=100;[*r,yr]=M1(fun,*0,*t,y0,Num);M1_*=*r'M1_y=yr'plot(*,yt,'k',*r,yr,'r-')legend('jie*i','Runge-Kutta',2)3、实验结果：000.02020.02020.04040.04000.06060.05940.08080.07840.10100.09700.12120.11530.14140.13310.16160.15060.18180.16780.20200.18460.22220.20110.24240.21720.26260.23300.28280.24850.30300.26370.32320.27860.34340.29320.36360.30740.38380.32140.40400.33510.42420.34860.44440.36170.46460.37460.48480.38730.50510.39960.52530.41180.54550.42360.56570.43530.58590.44670.60610.45790.62630.46880.64650.47960.66670.49010.68690.50040.70710.51050.72730.52040.74750.53000.76770.53950.78790.54880.80810.55800.82830.56690.84850.57560.86870.58420.88890.59260.90910.60080.92930.60890.94950.61680.96970.62450.98990.63211.01010.63961.03030.64681.05050.65401.07070.66101.09090.66781.11110.67451.13130.68111.15150.68751.17170.69391.19190.70001.21210.70611.23230.71201.25250.71791.27270.72361.29290.72911.31310.73461.33330.74001.35350.74521.37370.75041.39390.75541.41410.76041.43430.76521.45450.76991.47470.77461.49490.77911.51520.78361.53540.78801.55560.79231.57580.79651.59600.80061.61620.80461.63640.80851.65660.81241.67680.81621.69700.81991.71720.82361.73740.82711.75760.83061.77780.83401.79800.83741.81820.84071.83840.84391.85860.84701.87880.85011.89900.85321.91920.85611.93940.85901.95960.86191.97980.86472.00000.86742.02020.8701上机实验2：假设飞行器恒速率飞行，飞行器的动力学方程可简化为：飞行器的运动学方程为：初始条件自己选取，为控制加速度，选择适宜的控制加速度变化规律，画出飞行轨迹。代码如下：

dt=0.01;%设置微小的时间量vm=400;%导弹的速度am=30;

ae=pi/180;%角度转换倍数*(1)=0;y(1)=0;z(1)=0;%导弹的初始位置pmr(:,1)=[*(1);y(1);z(1)];%导弹位置信息矩阵time=0;%初始化角度和时间信息sm=vm*dt;%导弹微小时间内飞行距离%ft=0.4*ae;

%st=0.2*ae;

%vm=vm+am*time;

ft=0;

st=0;

for(k=2:500)

time=time+dt;

vm=vm+am*time;

pmr(:,k)=[pmr(1,k-1)+vm*dt*cos(st)*cos(ft);pmr(2,k-1)+vm*dt*sin(st);

pmr(3,k-1)-vm*dt*cos(st)*sin(ft)];%目标位置信息的计算st=(980-9.8*cos(st))/vm*dt+st;%侧滑角的变化ft=(980/(-vm*cos(st)))*dt+ft;

end

plot3(pmr(1,:),pmr(2,:),pmr(3,:));

gridon;实验图如下：上机实验3：从升降舵舵偏角到弹体俯仰角速率和法向加速度的传函分别为：加速度指令指令跟踪控制系统设计为如下列图所示：其中，分别为陀螺与加速度计的传递函数，为待设计的控制器，请设计适宜的，使系统能够跟踪输入指令，具有较好的性能。系统性能指标及系统模型：实际系统模型如下系统性能指标设计内外环控制器，使控制系统到达预定的性能指标，上升时间小于0.2s，剪切频率大于3rad/s，幅值大于10dB，相角裕度大于50°。参数设计:内环局部：其中认为QUOTE则内环反应通道中传递函数为G1，前向通道上传递函数为1，QUOTE采用比例控制器，根据计算和试凑可知，有以下结果：比例QUOTE=1.82则开环Bode图如下：此时相角裕度90.8°，剪切频率116rad/s。满足内环设计需求。外环设计即设计C(s)的传递函数，根据内环设计完成后的传递函数，采用PID控制进展设计，其中传递函数如下：QUOTE开环传递函数波特图如下：剪切频率大于3rad/s，幅值大于10dB，相角裕度大于50°，满足性能指标需求。Simulink仿真图如下图：仿真结果如下:由图可知，实验结果根本满足要求参数。四、实验结果分析：实验设计采用比例控制器作为内环，通过计算和试凑可知，根本满足参数需求，之后设计外环设计，采用PID控制器作为外环设计出的双环控制系统可以满足系统的性能指标要求，最终俯仰轴稳定控制系统剪切频率大于3rad/s，幅值大于10dB，相角裕度大于50°，上升时间小于0.2s，符合要求。仿真实验到达设计目标。上机实验4：导弹的动力学和运动学方程同实验2，如式GOTOBUTTONZEqnNum986044REFZEqnNum986044\*Charformat\!(2)GOTOBUTTONZEqnNum442766REFZEqnNum442766\*Charformat\!(3)GOTOBUTTONZEqnNum764759REFZEqnNum764759\*Charformat\!(4)GOTOBUTTONZEqnNum363407REFZEqnNum363407\*Charformat\!(5)GOTOBUTTONZEqnNum948329REFZEqnNum948329\*Charformat\!(6)GOTOBUTTONZEqnNum686565REFZEqnNum686565\*Charformat\!(7)所示，目标的动力学方程为：目标的运动学方程为：比例导引律：其中，目标相对导弹的运动方程：其中，初始条件自己设定，目标的运动情况自己假定，选择适宜的比例导引系数，利用四阶龙格库塔求解出仿真结果，绘出导弹与目标的运动轨迹。clear

all;

close

all;

clc

dt=0.1;

alpha=pi/6;v_t=0.42;s_t=v_t*dt;

v_m=0.60;s_m=v_m*dt;

*(1)=0;y(1)=0;z(1)=0;

%导弹初始位置pmr(:,1)=[*(1);y(1);z(1)];

ptr(:,1)=[25;5;7];

K=3;

q(1)=0;

o(1)=0;

a(1)=0;

for(k=2:600)

ptr(:,k)=[ptr(1,1)-v_t*cos(alpha)*dt*k;ptr(2,1);ptr(3,1)+v_t*sin(alpha)*k*dt];

r(k-1)=sqrt((ptr(1,k-1)-pmr(1,k-1))^2+(ptr(2,k-1)-pmr(2,k-1))^2+(ptr(3,k-1)-pmr(3,k-1))^2);

c=sqrt((ptr(1,k)-pmr(1,k-1))^2+(ptr(2,k)-pmr(2,k-1))^2+(ptr(3,k)-pmr(3,k-1))^2);

b=acos((r(k-1)^2+s_t^2-c^2)/(2*r(k-1)*s_t));

dq=acos((r(k-1)^2-s_t^2+c^2)/(2*r(k-1)*c));

if

abs(imag(b))>0

b=0.0000001;

end

if

abs(imag(dq))>0

dq=0.0000001;

end

q(k)=q(k-1)+dq;

o(k)=o(k-1)+K*dq;

a(k)=o(k)-q(k);

c1=r(k-1)*sin(b)/sin(a(k)+b);

c2=r(k-1)*sin(a(k))/sin(a(k)+b);

c3=sqrt((c1-s_m)^2+(c2-s_t)^2+2*(c1-s_m)*(c2-s_t)*cos(a(k)+b));

dq=a(k)-acos(((c1-s_m)^2+c3^2-(c2-s_t)^2)/(2*(c1-s_m)*c3));

if

abs(imag(dq))>0

dq=0.0000001;

end

q(k)=q(k-1)+dq;

o(k)=o(k-1)+K*dq;

a(k)=o(k)-q(k);

c1=r(k-1)*sin(b)/sin(a(k)+b);

c2=r(k-1)*sin(a(k))/sin(a(k)+b);

c3=sqrt((c1-s_m)^2+(c2-s_t)^2+2*(c1-s_m)*(c2-s_t)*cos(a(k)+b));dq=a(k)-acos(((c1-s_m)^2+c3^2-(c2-s_t)^2)/(2*(c1-s_m)*c3));

if

abs(imag(dq))>0

dq=0.0000001;

end

q(k)=q(k-1)+dq;

o(k)=o(k-1)+K*dq;

a(k)=o(k)-q(k);

c1=r(k-1)*sin(b)/sin(a(k)+b);

c2=r(k-1)*sin(a(k))/sin(a(k)+b);

c3=sqrt((c1-s_m)^2+(c2-s_t)^2+2*(c1-s_m)*(c2-s_t)*cos(a(k)+b));

dq=a(k)-acos(((c1-s_m)^2+c3^2-(c2-s_t)^2)/(2*(c1-s_m)*c3));

if

abs(imag(dq))>0

dq=0.0000001;

end

q(k)=q(k-1)+dq;

o(k)=o(k