% GUID_PLOT StopFcn plot script for Simulink model 'guidance'

%   J.Hodgson  
%   Copyright 1990-2000 The MathWorks, Inc.
%   $Revision: 1.5 $  $Date: 2000/09/01 19:26:48 $

%if ~isempty(findobj(0,'Tag','F3'));delete(findobj(0,'Tag','F3'));end;
%f3 = figure('Tag','F3');
%set(gcf,'pos',[408 61 596 569])
%subplot(221);plot(tout,latax.signals.values(:,1)/9.81,...
%                  tout,latax.signals.values(:,2)/9.81,'-.');grid;
%set(gca,'xlim',[0 max(tout)])
%xlabel('Time [Sec]');ylabel('Normal Acceleration [g]')
%legend('a_z','a_{zdemand}')
%subplot(222);plot(tout,Incid.signals.values/d2r);grid
%set(gca,'xlim',[0 max(tout)])
%xlabel('Time [Sec]');ylabel('Incidence \alpha [deg]')
%subplot(223);plot(tout,Mach.signals.values);grid
%set(gca,'xlim',[0 max(tout)])
%xlabel('Time [Sec]');ylabel('Mach Number')
%subplot(224);plot(tout,fin_dem.signals(1).values/d2r);grid;
%set(gca,'xlim',[0 max(tout)])
%xlabel('Time [Sec]');ylabel('Fin Demands [deg]')

if ~isempty(findobj(0,'Tag','F4'));delete(findobj(0,'Tag','F4'));end;
f4 = figure('Tag','F4');
set(gcf,'pos',[103 80 390 250])
I=find(diff(Mode.signals.values)~=0);
I2 = [];
for ii=1:length(I),
%     I2(ii) = find(Gimbal.time==round(100*tout(I(ii)))/100);
    I2(ii) = find(Gimbal.time==Mode.time(I(ii)));
end
plot(Gimbal.time,Gimbal.signals.values(:,2)/d2r,'--',...
     Gimbal.time,Gimbal.signals.values(:,1)/d2r,...
     Gimbal.time(I2),Gimbal.signals.values(I2,1)/d2r,'rx');grid;
set(gca,'xlim',[0 max(tout)],'ylim',[-30 30])
legend('True Look Angle','Gimbal Angle','Mode Changes')
xlabel('Time [Sec]');ylabel('Gimbal & Look Angles [deg]')

if ~isempty(findobj(0,'Tag','F5'));delete(findobj(0,'Tag','F5'));end;
f5 = figure('Tag','F5');
set(gcf,'pos',[103 405 390 244])
h=plot(Tgt_pos.signals.values(:,1),Tgt_pos.signals.values(:,2),'-',...
       Miss_pos.signals.values(:,1),Miss_pos.signals.values(:,2),...
       Miss_pos.signals.values(end,1),Miss_pos.signals.values(end,2),'x');
grid
set(gca,'ydir','reverse')
xlabel('X [m]');ylabel('Z [m]');title('Missile and Target Trajectories');
legend('Target','Missile',4)