diff --git a/src/csm/math_utils_gsl.h b/src/csm/math_utils_gsl.h index df41637c9f76ba24afb3c44aca2ee658920e1819..8cd5e09249bcc2dcf7d6a8ee9300167505b2e07c 100644 --- a/src/csm/math_utils_gsl.h +++ b/src/csm/math_utils_gsl.h @@ -33,7 +33,7 @@ /** Returns Fisher's information matrix. You still have to multiply it by (1/sigma^2). */ -val ld_fisher0(LDP ld); +//val ld_fisher0(LDP ld); #endif diff --git a/src/icp/icp.cpp b/src/icp/icp.cpp index a305cee0d25ccec9a47202810596a38a8ccd78a3..66915c9c4939fb51a4d1219f04ee41ffe69d83aa 100644 --- a/src/icp/icp.cpp +++ b/src/icp/icp.cpp @@ -155,15 +155,15 @@ void sm_icp(struct sm_params*params, struct sm_result*res) { res->dx_dy1_m = egsl_v2gslm(dx_dy1); res->dx_dy2_m = egsl_v2gslm(dx_dy2); - if(0) { + //if(0) { //egsl_print("cov0_x", cov0_x); //egsl_print_spectrum("cov0_x", cov0_x); - val fim = ld_fisher0(laser_ref); - egsl_print("fim", fim); + //val fim = ld_fisher0(laser_ref); + //egsl_print("fim", fim); //val ifim = inv(fim); //egsl_print_spectrum("ifim", ifim); - } + //} } res->error = best_error;