of Advanced Robotic Systems RRT *-SMART : A Rapid Convergence Implementation of RRT * Regular Paper