diff --git a/sm/csm/structprior/MeasurementsLikelihood.cpp b/sm/csm/structprior/MeasurementsLikelihood.cpp index c18303fef3f89cee9b361f705845d3135718388f..04f63d004e8efd1cc816b9cf428b1d493c3f3641 100644 --- a/sm/csm/structprior/MeasurementsLikelihood.cpp +++ b/sm/csm/structprior/MeasurementsLikelihood.cpp @@ -34,7 +34,7 @@ void MeasurementsLikelihood::ComputeAlphaLikelihoods(std::vector<double> x_vecto if (hess.size() != 0) hess.clear(); - // may be redundant, it's added in case some measurements are pre-discarded or something + // may be redundant, it's added in case some measurements are pre-discarded or something (measurements outside the model...) grad.resize(n); hess.resize(n); for (int i=0;i<n;i++) diff --git a/sm/csm/structprior/Optimizer.cpp b/sm/csm/structprior/Optimizer.cpp index 3310b20e801598e66f737327655ebbb940bd2632..f7c07cd564c27c91225d404c958293d0c08593c2 100644 --- a/sm/csm/structprior/Optimizer.cpp +++ b/sm/csm/structprior/Optimizer.cpp @@ -17,6 +17,15 @@ Optimizer::~Optimizer(void) } +/*void Optimizer::ScanLevelOptimization() +{ + OptimizeAlphas(); + OptimizeRanges(); + + + +}*/ + std::vector<double> Optimizer::OptimizeAlphas() { std::vector<double> x; diff --git a/sm/csm/structprior/Optimizer.h b/sm/csm/structprior/Optimizer.h index 8145b37097a0af3732329d334e72ed8e0209ffad..9814a2591c0ed484c8fe36a4f32162518fc464a7 100644 --- a/sm/csm/structprior/Optimizer.h +++ b/sm/csm/structprior/Optimizer.h @@ -21,6 +21,8 @@ public: std::vector<double> OptimizeRanges(); //std::vector<Pose> OptimizePoses(); + //void ScanLevelOptimization(); + std::vector<double> NewtonStep(std::vector<double> xv, double lambda_parameter, double &err); };