Restructured the SBA* algorithms. Created the SBA*-RRT* algorithm.