Home fix

This fixes the home position initialisation to depend on GPS only - which is the more reliable overall estimate.

@DrTon Please review and make sure it works with inav.