PSO plus RRT