add waypoint

add waypoint