[NavigationTest] Fix mission not ending when waiting for GPS position