12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

can pass debug flag as parameter.

release/4.3a0
krunalchande 2014-12-25 00:00:22 -05:00 committed by thduynguyen
parent 3e352f109e
commit 2476bbe8d7
2 changed files with 9 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
gtsam_unstable/nonlinear/LCNLPSolver.cpp
View File

@ -70,19 +70,21 @@ VectorValues LCNLPSolver::initializeDuals() const {
}
/* ************************************************************************* */
std::pair<Values, VectorValues> LCNLPSolver::optimize(const Values& initialValues) const {
std::pair<Values, VectorValues> LCNLPSolver::optimize(const Values& initialValues, bool debug) const {
LCNLPState state(initialValues);
state.duals = initializeDuals();
while (!state.converged && state.iterations < 100) {
state = iterate(state);
if (debug)
std::cout << "state: iteration " << state.iterations << std::endl;
state = iterate(state, debug);
}
if (debug)
std::cout << "Number of iterations: " << state.iterations << std::endl;
return std::make_pair(state.values, state.duals);
}
/* ************************************************************************* */
LCNLPState LCNLPSolver::iterate(const LCNLPState& state) const {
static const bool debug = true;
LCNLPState LCNLPSolver::iterate(const LCNLPState& state, bool debug) const {
// construct the qp subproblem
QP qp;

6
gtsam_unstable/nonlinear/LCNLPSolver.h
View File

@ -104,13 +104,13 @@ public:
/**
* Single iteration of SQP
*/
LCNLPState iterate(const LCNLPState& state) const;
LCNLPState iterate(const LCNLPState& state, bool debug = false) const;
VectorValues initializeDuals() const;
/**
* Main optimization function.
* Main optimization function. new
*/
std::pair<Values, VectorValues> optimize(const Values& initialValues) const;
std::pair<Values, VectorValues> optimize(const Values& initialValues, bool debug = false) const;
};
}