fix a crash when the destructor is called before onInitialize
Merge pull request #9 from wjwwood/fix_rviz_plugin

Fix octomap rviz plugin crash with new rviz feature