Incorporated bi-dir support in RRT* planner. Made dvp trees copyable / movable.