RRT* (Rapidly-exploring Random Tree Star) path planning algorithm
An optimized version of RRT that rewires the tree to find shorter paths.