diff --git a/include/multigrid_pclomp/multigrid_ndt_omp.h b/include/multigrid_pclomp/multigrid_ndt_omp.h index d00deacd..66cdb6a6 100644 --- a/include/multigrid_pclomp/multigrid_ndt_omp.h +++ b/include/multigrid_pclomp/multigrid_ndt_omp.h @@ -302,7 +302,7 @@ class MultiGridNormalDistributionsTransform : public pcl::Registration - namespace pclomp { template @@ -542,8 +540,6 @@ double MultiGridNormalDistributionsTransform::updateDe c_inv4.topLeftCorner(3, 3) = c_inv; - double gauss_d2 = gauss_d2_; - // e^(-d_2/2 * (x_k - mu_k)^T Sigma_k^-1 (x_k - mu_k)) Equation 6.9 [Magnusson 2009] double e_x_cov_x = exp(-gauss_d2 * x_trans4.dot(x_trans4 * c_inv4) * 0.5f); // Calculate probability of transformed points existence, Equation 6.9 [Magnusson 2009]