optimized bi-rrt; try to connect to end ConnectedComponent even if failed to connect to first one
optimized bi-rrt; try to connect to end ConnectedComponent even if failed to connect to first one

humanoid-path-planner/hpp-core