robot_self_filter: some minor optimizations that avoid copying point clouds