added save_mesh to save the obstacle map