PlotData.m 505 B

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