Add initial bubble generation.
Revert last change.
Merge branch 'bubble-tree' into bubble-rrt