Changed the way that GPS causes failsafe errors. Also set failsafe to hover mode