fixed a bug in octomap filtering for max_z
Merge branch 'develop' of https://github.com/ccny-ros-pkg/ccny_rgbd_tools into develop