Fixed Problem with Home location

Modified waypoints so that the first waypoint always redefines your home
location.