PlotData.m 679 B

12345678910111213141516171819202122232425262728
  1. %% calculate and plot tilt correction magnitude
  2. figure;
  3. plot(angErrLog(1,:)*0.001,angErrLog(2,:));
  4. grid on;
  5. ylabel('Tilt correction magnitude (deg)');
  6. xlabel('time (sec)');
  7. %% plot gyro bias estimates
  8. figure;
  9. plot(statesLog(1,:)*0.001,statesLog(8:10,:)/dt*180/pi);
  10. grid on;
  11. ylabel('Gyro Bias Estimate (deg/sec)');
  12. xlabel('time (sec)');
  13. %% plot Euler angle estimates
  14. figure;
  15. eulLog(4,:) = eulLog(4,:) + pi;
  16. plot(eulLog(1,:)*0.001,eulLog(2:4,:)*180/pi);
  17. grid on;
  18. ylabel('Euler Angle Estimates (deg)');
  19. xlabel('time (sec)');
  20. %% plot velocity innovations
  21. figure;
  22. plot(statesLog(1,:)*0.001,statesLog(5:7,:));
  23. grid on;
  24. ylabel('EKF velocity Innovations (m/s)');
  25. xlabel('time (sec)');