Tested the branch-and-bound on RRT* algorithm. Fixed from issues in pooled-adj-list. And found/fixed a bug in the get-vertex and erase function of the DVP-tree implementation.