Add moveit plugin to just filter pointcloud which belongs to robot