Fixed waypoint lines

Fixed waypoint lines and home waypoint