【物理应用】基于matlab导弹跟踪【含Matlab源码 192期】

一、简介

基于matlab导弹跟踪

二、源代码

close all
clear all
 
Vt = 300;
alphaT = 170;
alphaT_rad = (alphaT/180)*pi;
 
R0 = 3000;
theta0 = 30;
theta0_rad = (theta0/180)*pi;
 
xt0 = R0*cos(theta0_rad);
yt0 = R0*sin(theta0_rad);
Vt_hor = Vt*cos(alphaT_rad);
Vt_ver = Vt*sin(alphaT_rad);
 
Mu = 0.9;
Vm = Mu*Vt;
 
xm0 = 0;
ym0 = 0;
 
xt = xt0;
yt = yt0;
xm = xm0;
ym = ym0;
 
delta = 0;
delta_rad = (delta*(pi/180));
alphaM_rad = atan3((yt-ym),(xt-xm)) + (delta/180)*pi;
Vm_hor = Vm*cos(alphaM_rad);
Vm_ver = Vm*sin(alphaM_rad);
delT = 0.1;
K = R0*(((1+cos(alphaT_rad - theta0_rad))^Mu)/...
    ((sin(alphaT_rad - theta0_rad))^(Mu-1)));
theta_rad = theta0_rad;
R = R0;
 
imgframe = 0;
figHandle = figure;
set(figHandle,'WindowStyle','docked');
hold on;
f1 = subplot(2,3,1);
l1 = plot(0,0,'*');
 
flag = 0;
 
for t = 0:delT:50
 
    xt = xt + Vt_hor*delT;
    yt = yt + Vt_ver*delT;
    
    del_R = (Vt*cos(alphaT_rad - theta_rad) - ...
            Vm*cos( delta_rad));%alphaM_rad - theta_rad +
    R2 = R + del_R * delT; 
%     R2 = sqrt((yt-ym)^2 + (xt-xm)^2);
    
    if abs(R2) > abs(R)
        flag = flag+1;
    end
    if flag == 2 
        break;
    end
    
    R = R2;
    del_theta_rad = (Vt*sin(alphaT_rad - theta_rad) - ...
                    Vm*sin(delta_rad))/R;%alphaM_rad - theta_rad + 
    theta_rad = theta_rad + del_theta_rad * delT; % atan3((yt-ym),(xt-xm));
    alphaM_rad = theta_rad + delta_rad;
    
    Vm_hor = Vm*cos(alphaM_rad);
    Vm_ver = Vm*sin(alphaM_rad);    
    xm = xm + Vm_hor*delT;
    ym = ym + Vm_ver*delT;
    
%     am_hor = (Vm_hor2 - Vm_hor)/delT;
%     am_ver = (Vm_ver2 - Vm_ver)/delT;
%     Vm_hor = Vm_hor2;
%     Vm_ver = Vm_ver2;
    
    am = ((Vm*Vt)*((sin(alphaT_rad - theta_rad))^2)...
        /(K*((tan((alphaT_rad - theta_rad)/2))^Mu))); 
%     am = norm([am_hor am_ver],2);
 
%     if t == 4
    pause(0.1);
%     end
 
%     f1 = figure(1);
%     set(f1,'WindowStyle','docked');
    f1 = subplot(2,3,1);
    box on;
    hold on;
    delete(l1);
    plot(xt,yt,'r*');    
    plot(xm,ym,'g*');
    l1 = plot([xm xt], [ym yt], 'b');
    xlabel('X-coordinate (meters)');
    ylabel('Y-coordinate (meters)');
        
%     f2 = figure(2);
%     set(f2,'WindowStyle','docked');
    f2 = subplot(2,3,2);
    box on;
    hold on;
    plot(t,R,'*b');
    xlabel('Time');
    ylabel('LOS Distance (meters)');
   
%     f3 = figure(3);
%     set(f3,'WindowStyle','docked');
    f3 = subplot(2,3,3);
    box on;
    hold on;
    plot(t,theta_rad*(180/pi),'+b');
%     plot(t,alphaT_rad - theta_rad,'*g');%alphaM_rad,
    xlabel('Time');
    ylabel('theta (degrees)');
     
%     f4 = figure(4);
%     set(f4,'WindowStyle','docked');   
    f4 = subplot(2,3,4);
    box on;
    hold on;
    plot(t,am,'*r');
    xlabel('Time');
    ylabel('Lateral Acceleration (m/s^{2})');
 
%     f5 = figure(5);
%     set(f5,'WindowStyle','docked');  
    f5 = subplot(2,3,5);
    box on;
    hold on;
    plot(t,Vt*sin(alphaT_rad - theta_rad) - Vm*sin((delta/180)*pi),'*r');%
    plot(t,Vt*cos(alphaT_rad - theta_rad) - Vm*cos((delta/180)*pi),'*b');% 
    xlabel('Time');
    ylabel(' V_{R}(blue) (m/s), V_{theta}(red) (m/s)');
    
%     f6 = figure(6);
%     set(f6,'WindowStyle','docked');  
    f6 = subplot(2,3,6);
    box on;
    hold on;
    plot(Vt*sin(alphaT_rad - theta_rad) - Vm*sin((delta/180)*pi),Vt*cos(alphaT_rad - theta_rad) - Vm*cos((delta/180)*pi),'k*'); % 
    xlabel('V_{theta} (m/s)');
    ylabel('V_R (m/s)');
    
    imgframe = imgframe+1;
    images1(imgframe) = getframe(figHandle);
end
 
filename = 'ppIA0_9';
mkdir(['newData\' filename]);
for i = 1:imgframe-1
[im, map] = frame2im(images1(i));
name = ['newData\' filename '\' filename '_plot' num2str(i) '.jpg'];
imwrite(im,name,'jpg');
end
save(['newData\' filename '\' filename]);
movie2avi(images1,['newData\' filename '\' filename '.avi'],'fps',4);
movie2avi(images1,['newData\' filename '\' filename '_medium.avi'],'fps',5);
movie2avi(images1,['newData\' filename '\' filename '_small.avi'],'fps',6);
% movie2avi(images1,[filename '_ffds.avi'],'Compression','FFDS','fps',4);
%{
syms theta_sim R t;
theta_sim = solve(theta_sim - alphaT_rad - acos((R0*(Vt*cos(alphaT_rad-theta0_rad)+Vm) - ((Vm^2)-(Vt^2))*t)/(R*Vt) - (Vm/Vt)),theta_sim);
R = solve(R - K*(((sin(alphaT_rad - theta_sim))^(Mu-1))/((1+cos(alphaT_rad - theta_sim)))^Mu),R);
double(theta_sim);
% thet
%}

三、运行结果

四、备注

版本：2014a