Remove all vestiges of my own configuration to make this as general as
possible
Add private access modifier
Add a table collision object so we can use an octomap for collision checking to the scene. Works but needs some refinements