Add bubble tree. Needs to be tested.

Bubble tree allows simple forming of trees based on a bubble source.
Add skeleton of Bubble RRT.
Add initial bubble generation.
Revert last change.
Add basic logic to Bubble RRT.
Merge branch 'bubble-tree' into bubble-rrt
Add thread support to CMakeLists.
Merge branch 'bubble-rrt'