AutoTest: fix to copter getting stuck in Failsafe test