diff --git a/include/core/factor/factor_distance_3d.h b/include/core/factor/factor_distance_3d.h
index 96f9dfb784576b07caebfdde9762fb77961ddb95..bbcb846f626ad98d4a89456157f50c7b996637c7 100644
--- a/include/core/factor/factor_distance_3d.h
+++ b/include/core/factor/factor_distance_3d.h
@@ -78,10 +78,6 @@ class FactorDistance3d : public FactorAutodiff<FactorDistance3d, 1, 3, 3>
                 norm_squared += (T)1e-8;
             }
             Matrix<T,1,1> dist_exp ( sqrt(norm_squared) );
-            // Matrix<T,1,1> dist_meas (getMeasurement().cast<T>());
-            // Matrix<T,1,1> sqrt_info_upper = getMeasurementSquareRootInformationUpper();
-
-            // res  = sqrt_info_upper * (dist_meas - dist_exp);
 
             res  = getMeasurementSquareRootInformationUpper() * (getMeasurement() - dist_exp);