diff --git a/gtsam/slam/RangeFactor.h b/gtsam/slam/RangeFactor.h index 5bbed45b2..1bda0b7bb 100644 --- a/gtsam/slam/RangeFactor.h +++ b/gtsam/slam/RangeFactor.h @@ -16,8 +16,7 @@ #pragma once -//#include -//#include +#include #include namespace gtsam { @@ -63,6 +62,11 @@ namespace gtsam { 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(z_)); + } + private: /** Serialization function */