Adding waypoints to a map