Added MSCKF and IMU data for plotting