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

% plot airspeed
figure;plot(time,ias,time,mode,time,h,time,dthr*100)
grid on
xlim([595 819])
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([650 683])
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([650 683])
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,theta*180/pi)
grid on
xlim([650 683])
xlabel('Time (s)')
legend('L1/R1 (deg)','L3/R3 (deg)','L4/R4 (deg)','theta (deg)')

% plot roll doublets
figure;plot(time,ias,time,run_excitation)
grid on
xlim([715 755])
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([715 755])
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,q*180/pi)
grid on
xlim([715 755])
xlabel('Time (s)')
legend('L1/R1 (deg)','L2/R2 (deg)','L4/R4 (deg)','q (deg/s)')

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

% plot theta and airspeed tracking
figure;plot(time,theta*180/pi,time,(theta_cmd+0.0698)*180/pi,time,phi*180/pi,time,ias,time,ias_cmd,time, dthr*100)
grid on
xlim([790 821])
xlabel('Time (s)')
legend('theta (deg)','theta cmd (deg)','phi (deg)','IAS (m/s)','IAS cmd (m/s)','Throttle (prcnt)')

figure;plot(time,ias,time,ias_cmd,time,h)
grid on
xlim([790 821])
ylim([0 100])
xlabel('Time (s)')
legend('IAS (m/s)','IAS cmd (m/s)','Altitude (m)')