add waypoint functionality