Replace boost::math::isnan with check using pcl::isFinite