Added Monte Carlo test with Ranger and IMU measurements