OMPL implementation of Erion Plaku's motion planner