Fixed up monte carlo program. Running for GPS + Gyro