OctoMap display and other small changes
Improved performance of scripts from rgbd benchmark
Missing dependency