Using the RViz Motion Planning plugin