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

Changed some printing details, prompted by MATLAB display

release/4.3a0
Frank Dellaert 2012-07-02 15:01:28 +00:00
parent 8da8b4dca2
commit 747342ffda
9 changed files with 26 additions and 16 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
gtsam.h
View File

@ -1267,10 +1267,10 @@ class ISAM {
class LevenbergMarquardtOptimizer {
double lambda() const;
void iterate();
visualSLAM::Values optimize();
visualSLAM::Values optimizeSafely();
double error() const;
size_t iterations() const;
visualSLAM::Values optimize();
visualSLAM::Values optimizeSafely();
visualSLAM::Values values() const;
};

5
gtsam/geometry/Pose3.cpp
View File

@ -55,8 +55,9 @@ namespace gtsam {
/* ************************************************************************* */
void Pose3::print(const string& s) const {
R_.print(s + ".R");
t_.print(s + ".t");
cout << s;
R_.print("R:\n");
t_.print("t: ");
}
/* ************************************************************************* */

4
gtsam/nonlinear/NonlinearEquality.h
View File

@ -109,8 +109,8 @@ namespace gtsam {
/// @{
virtual void print(const std::string& s = "", const KeyFormatter& keyFormatter = DefaultKeyFormatter) const {
std::cout << "Constraint: " << s << " on [" << keyFormatter(this->key()) << "]\n";
gtsam::print(feasible_,"Feasible Point");
std::cout << s << "Constraint: on [" << keyFormatter(this->key()) << "]\n";
gtsam::print(feasible_,"Feasible Point:\n");
std::cout << "Variable Dimension: " << feasible_.dim() << std::endl;
}

2
gtsam/nonlinear/NonlinearFactor.h
View File

@ -99,7 +99,7 @@ public:
/** print */
virtual void print(const std::string& s = "", const KeyFormatter& keyFormatter = DefaultKeyFormatter) const {
std::cout << s << "keys = { ";
std::cout << s << " keys = { ";
BOOST_FOREACH(Key key, this->keys()) { std::cout << keyFormatter(key) << " "; }
std::cout << "}" << std::endl;
}

2
gtsam/nonlinear/Values.cpp
View File

@ -43,7 +43,7 @@ namespace gtsam {
void Values::print(const string& str, const KeyFormatter& keyFormatter) const {
cout << str << "Values with " << size() << " values:" << endl;
for(const_iterator key_value = begin(); key_value != end(); ++key_value) {
cout << " " << keyFormatter(key_value->key) << ": ";
cout << "Value " << keyFormatter(key_value->key) << ": ";
key_value->value.print("");
}
}

7
gtsam/slam/BearingFactor.h
View File

@ -78,6 +78,13 @@ namespace gtsam {
return e != NULL && Base::equals(*e, tol) && this->measured_.equals(e->measured_, tol);
}
/** print contents */
void print(const std::string& s="", const KeyFormatter& keyFormatter = DefaultKeyFormatter) const {
std::cout << s << "BearingFactor, bearing = ";
measured_.print();
Base::print("", keyFormatter);
}
private:
/** Serialization function */

8
gtsam/slam/BearingRangeFactor.h
View File

@ -64,12 +64,12 @@ namespace gtsam {
/** Print */
virtual void print(const std::string& s = "", const KeyFormatter& keyFormatter = DefaultKeyFormatter) const {
std::cout << s << ": BearingRangeFactor("
std::cout << s << "BearingRangeFactor("
<< keyFormatter(this->key1()) << ","
<< keyFormatter(this->key2()) << ")\n";
measuredBearing_.print(" measured bearing");
std::cout << " measured range: " << measuredRange_ << std::endl;
this->noiseModel_->print(" noise model: ");
measuredBearing_.print("measured bearing:\n");
std::cout << "measured range: " << measuredRange_ << std::endl;
this->noiseModel_->print("noise model:\n");
}
/** equals */

7
gtsam/slam/ProjectionFactor.h
View File

@ -78,9 +78,10 @@ namespace gtsam {
* print
* @param s optional string naming the factor
*/
void print(const std::string& s = "ProjectionFactor", const KeyFormatter& keyFormatter = DefaultKeyFormatter) const {
Base::print(s, keyFormatter);
measured_.print(s + ".z");
void print(const std::string& s = "", const KeyFormatter& keyFormatter = DefaultKeyFormatter) const {
std::cout << s << "GenericProjectionFactor, z = ";
measured_.print();
Base::print("", keyFormatter);
}
/// equals

3
gtsam/slam/RangeFactor.h
View File

@ -75,7 +75,8 @@ namespace gtsam {
/** print contents */
void print(const std::string& s="", const KeyFormatter& keyFormatter = DefaultKeyFormatter) const {
Base::print(s + std::string(" range: ") + boost::lexical_cast<std::string>(measured_), keyFormatter);
std::cout << s << "RangeFactor, range = " << measured_ << std::endl;
Base::print("", keyFormatter);
}
private: