Gave up on saving ALL data. Now only saving RMS errors and displaying errors as histogram. Only MC test for GPS/IMU currently