Skip to content
Snippets Groups Projects
Commit 732eb51e authored by Joan Solà Ortega's avatar Joan Solà Ortega
Browse files

Remove commented code

parent af46fcd3
No related branches found
No related tags found
3 merge requests!436Release to start wolf public,!433After 2nd RA-L submission,!431Resolve "Add time_tolerance field in Frame and remove PackKeyFrame"
Pipeline #7862 failed
...@@ -78,10 +78,6 @@ class FactorDistance3d : public FactorAutodiff<FactorDistance3d, 1, 3, 3> ...@@ -78,10 +78,6 @@ class FactorDistance3d : public FactorAutodiff<FactorDistance3d, 1, 3, 3>
norm_squared += (T)1e-8; norm_squared += (T)1e-8;
} }
Matrix<T,1,1> dist_exp ( sqrt(norm_squared) ); 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); res = getMeasurementSquareRootInformationUpper() * (getMeasurement() - dist_exp);
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment