Got bidirectional rrt visualization working
Fixed a bug with the unidirectional rrt where we were only checking for goal if the target was goal
Added an example of 3D visualization and the authorship