Removing last waypoint in path to make navigation slightly cleaner