Made version using gyroGPS fusion work