close all
clear all
clc

% Fenrir flight 18 2015-05-21
load('Fenrir_flight18_2015_5_21.mat')
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([795,820])
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_damper*180/pi,time,q*180/pi)
legend('Pitch Damper','Pitch Rate');
ylabel('Deg / DPS')
xlim([795,820])
xlabel('Time (s)')
grid on

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

figure;plot(time,ias,time,q*180/pi);
xlim([795,820])
legend('IAS (m/s)','Pitch Rate (dps)')
grid on;
xlabel('Time (s)')

% Fenrir flight 19 2015-05-21
load('Fenrir_flight19_2015_5_21.mat')
figure;[AX,H1,H2] = plotyy(time,thr_incp,time,ias);
set(AX,'xlim',[873,896]);
grid on;
set(get(AX(1),'Ylabel'),'String','Throttle Cmd GPT (ND)')
set(get(AX(2),'Ylabel'),'String','IAS (m/s)')
xlabel('Time (s)')

figure;[AX,H1,H2] = plotyy(time,thr_incp,time,ias_filt);
set(AX,'xlim',[873,896]);
grid on;
set(get(AX(1),'Ylabel'),'String','Throttle Cmd GPT (ND)')
set(get(AX(2),'Ylabel'),'String','IAS Filtered (m/s)') 
xlabel('Time (s)')