Added yaml file for map_server params and converted waypoints to have xy origin in lower-left corner.