Switched octomap plugin to pointcloud_filter