% loading flight 20
load('Fenrir_flight20_2015_5_27.mat')
figure;plot(time,ias,time,run_excitation)
legend('Airspeed (m/s)','Excitation Engage')
xlabel('Time (s)');
xlim([1240 1285]);
grid on

de_excite = de - pitch_cmd_pilot - pitch_cmd_damper;
l1_excite = l1;
l4_excite = l4 - pitch_cmd_pilot - roll_cmd_pilot;
figure;plot(time,l1_excite*180/pi,time,de_excite*180/pi,...
    time,l4_excite*180/pi,time,q*180/pi)
xlim([1240 1285]);
xlabel('Time (s)')
legend('L1/R1 Excitation','L3/R3 Excitation','L4/R4 Excitation','Pitch Rate');
ylabel('Deg / DPS')
grid on

figure;plot(time,pitch_cmd_pilot*180/pi,time,q*180/pi)
legend('Pilot Pitch Cmd','Pitch Rate');
ylabel('Deg / DPS')
xlim([1240 1285]);
xlabel('Time (s)')
grid on

% loading flight 21
load('Fenrir_flight21_2015_5_27.mat')
figure;plot(time,theta*180/pi,time,theta_cmd*180/pi,time,de*180/pi,time,mode)
legend('Theta (deg)','Theta Cmd (deg)', 'de Cmd (deg)','Mode')
xlim([951 955]);
xlabel('Time (s)')
grid on

figure;plot(time,phi*180/pi,time,phi_cmd*180/pi,time,da*180/pi,time,mode)
legend('Phi (deg)','Phi Cmd (deg)', 'da Cmd (deg)','Mode')
xlim([951 955]);
xlabel('Time (s)')
grid on

figure;plot(time,ias,time,ias_filt,time,ias_cmd,time,dthr*100)
legend('Airspeed (m/s)','Filtered Airspeed (m/s)','Airspeed Cmd (m/s)','Throttle Command (Percent)')
xlabel('Time (s)');
xlim([951 955]);
grid on

% loading flight 23
load('Fenrir_flight23_2015_5_27.mat')
figure;plot(time,h_filt-init_alt,time,h_cmd,time,mode,time,de*180/pi,time,theta*180/pi);
legend('Filtered Altitude (m)','Altitude Cmd (m)','de Cmd (deg)','Pitch Angle (deg)','Mode')
xlabel('Time (s)');
xlim([519 524])
grid on

vg = (navvn.^2 + navve.^2).^.5;
figure;plot(time,ias,time,ias_filt,time,ias_cmd,time,vg,time,dthr*100)
legend('Airspeed (m/s)','Filtered Airspeed (m/s)','Airspeed Cmd (m/s)','Ground Speed (m/s)','Throttle Command (Percent)')
xlabel('Time (s)');
xlim([519 524])
grid on

figure;plot(time,phi*180/pi,time,da*180/pi,time,mode);
legend('Roll Angle (deg)','da Cmd (deg)','Mode')
xlim([519 524])
grid on