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

Added a print function for RangeFactor

release/4.3a0
Alex Cunningham 2011-03-31 03:14:21 +00:00
parent ce70480ae0
commit 53bb7584b6
1 changed files with 6 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
gtsam/slam/RangeFactor.h
View File

@ -16,8 +16,7 @@
#pragma once #pragma once
//#include <gtsam/geometry/Pose2.h> #include <boost/lexical_cast.hpp>
//#include <gtsam/geometry/Point2.h>
#include <gtsam/nonlinear/NonlinearFactor.h> #include <gtsam/nonlinear/NonlinearFactor.h>
namespace gtsam { namespace gtsam {
@ -63,6 +62,11 @@ namespace gtsam {
return e != NULL && Base::equals(*e, tol) && fabs(this->z_ - e->z_) < tol; return e != NULL && Base::equals(*e, tol) && fabs(this->z_ - e->z_) < tol;
} }
/** print contents */
void print(const std::string& s="") const {
Base::print(s + std::string(" range: ") + boost::lexical_cast<std::string>(z_));
}
private: private:
/** Serialization function */ /** Serialization function */