Modified addSolutionPath() to include planner name for all OMPL algorithms