add functionality for waypoint navigation