[NavigationTest] Add GPS failsafe