% loading the data
load('skoll_flight03_2015_07_02.mat')

% plot airspeed
figure;plot(time,ias,time,mode,time,h,time,dthr*100)
grid on
xlim([480 550])
xlabel('Time (s)')
legend('IAS (m/s)','Mode','Altitude (m)','Throttle (prcnt)')

% plot pitch doublets
figure;plot(time,ias,time,run_excitation)
grid on
xlim([530 590])
xlabel('Time (s)')
legend('IAS (m/s)','Run Excitation')

figure;plot(time,l1*180/pi,time,de*180/pi,time,l4*180/pi,time,q*180/pi)
grid on
xlim([530 590])
xlabel('Time (s)')
legend('L1/R1 (deg)','L3/R3 (deg)','L4/R4 (deg)','q (deg/s)')

figure;plot(time,l1*180/pi,time,de*180/pi,time,l4*180/pi,time,q*180/pi)
grid on
xlim([543 548])
xlabel('Time (s)')
legend('L1/R1 (deg)','L3/R3 (deg)','L4/R4 (deg)','q (deg/s)')

% plot roll doublets
figure;plot(time,ias,time,run_excitation)
grid on
xlim([610 660])
xlabel('Time (s)')
legend('IAS (m/s)','Run Excitation')

figure;plot(time,l1*180/pi,time,da*180/pi,time,l4*180/pi,time,p*180/pi)
grid on
xlim([610 660])
xlabel('Time (s)')
legend('L1/R1 (deg)','L2/R2 (deg)','L4/R4 (deg)','p (deg/s)')

figure;plot(time,l1*180/pi,time,da*180/pi,time,l4*180/pi,time,p*180/pi)
grid on
xlim([618 622])
xlabel('Time (s)')
legend('L1/R1 (deg)','L2/R2 (deg)','L4/R4 (deg)','p (deg/s)')

% plot theta tracking
figure;plot(time,theta*180/pi,time,(theta_cmd+0.0698)*180/pi)
grid on
xlim([689 711])
xlabel('Time (s)')
legend('Theta (deg)','Theta Cmd (deg)')

% plot inertial drift
figure;plot(time,satVisible,time,ias,time,navvd)
grid on
xlim([500 900])
xlabel('Time (s)')
legend('Sat Visible','IAS (m/s)','Z dot (m/s)')