Prototype working.  rviz integrated, rotation? coordinates need to be transformed
Merge branch 'master' of https://github.com/hayesbh/Social-Hierarchical-Learning