GPS Tweaks

Increased Distance Check to <= 2 meters and fixed the distance to
waypoint bug which only measured from Africa to waypoint.