Some comments
parent
91ea8e3bd7
commit
a4aa7b9f45
|
@ -128,7 +128,8 @@ namespace gtsam {
|
|||
OptionalOrderingType orderingType = boost::none) const;
|
||||
|
||||
/** Do multifrontal elimination of all variables to produce a Bayes tree. If an ordering is not
|
||||
* provided, the ordering provided by COLAMD will be used.
|
||||
* provided, the ordering will be computed using either COLAMD or METIS, dependeing on
|
||||
* the parameter orderingType (Ordering::COLAMD or Ordering::METIS)
|
||||
*
|
||||
* <b> Example - Full Cholesky elimination in COLAMD order: </b>
|
||||
* \code
|
||||
|
|
|
@ -242,8 +242,10 @@ void LevenbergMarquardtOptimizer::iterate() {
|
|||
|
||||
bool systemSolvedSuccessfully;
|
||||
try {
|
||||
// ============ Solve is where most computation happens !! =================
|
||||
delta = solve(dampedSystem, state_.values, params_);
|
||||
systemSolvedSuccessfully = true;
|
||||
// =========================================================================
|
||||
} catch (IndeterminantLinearSystemException) {
|
||||
systemSolvedSuccessfully = false;
|
||||
}
|
||||
|
@ -267,7 +269,9 @@ void LevenbergMarquardtOptimizer::iterate() {
|
|||
if (linearizedCostChange >= 0) { // step is valid
|
||||
// update values
|
||||
gttic(retract);
|
||||
// ============ This is where the solution is updated ====================
|
||||
newValues = state_.values.retract(delta);
|
||||
// =======================================================================
|
||||
gttoc(retract);
|
||||
|
||||
// compute new error
|
||||
|
|
Loading…
Reference in New Issue