Octomap

Adds the functionality for inserting a point cloud into the tree. There is still the segfault issues that occasionally occur with the tree.updateNode and tree.insertPointCloud methods.