Add waypoints on map