Corrected issue in remove point. Changing logging down to ROS_DEBUG in places.