Failsafe gps lost bug fix

if gps is lost before/when failsafe triggered - triggering of RTL would result in set_mode returning to STABILIZE.  This commit forces correct behaviour - e.g. LAND if no GPS.

Two commits - sorry got boolean operation around wrong way on first one.