Use OMPL to find a solution for this motion planning task. It is equivalent to executing: simOMPL.setup(task) if simOMPL.solve(task, maxTime) then simOMPL.simplifyPath(task, maxSimplificationTime) simOMPL.interpolatePath(task, stateCnt) path = simOMPL.getPath(task) end