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

fixed printing

release/4.3a0
Frank Dellaert 2012-06-10 04:24:12 +00:00
parent 44530b2291
commit 17a2793a38
1 changed files with 15 additions and 14 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

29
gtsam/nonlinear/NonlinearISAM.cpp
View File

@ -25,10 +25,12 @@
#include <iostream>
using namespace std;
namespace gtsam {
/* ************************************************************************* */
void NonlinearISAM::saveGraph(const std::string& s) const {
void NonlinearISAM::saveGraph(const string& s) const {
isam_.saveGraph(s);
}
@ -67,7 +69,7 @@ void NonlinearISAM::update(const NonlinearFactorGraph& newFactors,
/* ************************************************************************* */
void NonlinearISAM::reorder_relinearize() {
// std::cout << "Reordering, relinearizing..." << std::endl;
// cout << "Reordering, relinearizing..." << endl;
if(factors_.size() > 0) {
// Obtain the new linearization point
@ -104,24 +106,23 @@ Matrix NonlinearISAM::marginalCovariance(Key key) const {
}
/* ************************************************************************* */
void NonlinearISAM::print(const std::string& s) const {
std::cout << "ISAM - " << s << ":" << std::endl;
std::cout << " ReorderInterval: " << reorderInterval_ << " Current Count: " << reorderCounter_ << std::endl;
isam_.print("GaussianISAM");
linPoint_.print("Linearization Point");
ordering_.print("System Ordering");
factors_.print("Nonlinear Graph");
void NonlinearISAM::print(const string& s) const {
cout s << "ReorderInterval: " << reorderInterval_ << " Current Count: " << reorderCounter_ << endl;
isam_.print("GaussianISAM:\n");
linPoint_.print("Linearization Point:\n");
ordering_.print("System Ordering:\n");
factors_.print("Nonlinear Graph:\n");
}
/* ************************************************************************* */
void NonlinearISAM::printStats() const {
gtsam::GaussianISAM::CliqueData data = isam_.getCliqueData();
gtsam::GaussianISAM::CliqueStats stats = data.getStats();
std::cout << "\navg Conditional Size: " << stats.avgConditionalSize;
std::cout << "\nmax Conditional Size: " << stats.maxConditionalSize;
std::cout << "\navg Separator Size: " << stats.avgSeparatorSize;
std::cout << "\nmax Separator Size: " << stats.maxSeparatorSize;
std::cout << std::endl;
cout << "\navg Conditional Size: " << stats.avgConditionalSize;
cout << "\nmax Conditional Size: " << stats.maxConditionalSize;
cout << "\navg Separator Size: " << stats.avgSeparatorSize;
cout << "\nmax Separator Size: " << stats.maxSeparatorSize;
cout << endl;
}
/* ************************************************************************* */