added waypoint test