diff --git a/gtsam_unstable/slam/PoseToPointFactor.h b/gtsam_unstable/slam/PoseToPointFactor.h index d691b7643..be73b9312 100644 --- a/gtsam_unstable/slam/PoseToPointFactor.h +++ b/gtsam_unstable/slam/PoseToPointFactor.h @@ -45,8 +45,9 @@ class PoseToPointFactor : public NoiseModelFactor2 { /** implement functions needed for Testable */ /** print */ - virtual void print(const std::string& s, const KeyFormatter& keyFormatter = - DefaultKeyFormatter) const { + virtual void print( + const std::string& s, + const KeyFormatter& keyFormatter = DefaultKeyFormatter) const override { std::cout << s << "PoseToPointFactor(" << keyFormatter(this->key1()) << "," << keyFormatter(this->key2()) << ")\n" << " measured: " << measured_.transpose() << std::endl; @@ -55,7 +56,7 @@ class PoseToPointFactor : public NoiseModelFactor2 { /** equals */ virtual bool equals(const NonlinearFactor& expected, - double tol = 1e-9) const { + double tol = 1e-9) const override { const This* e = dynamic_cast(&expected); return e != nullptr && Base::equals(*e, tol) && traits::Equals(this->measured_, e->measured_, tol); @@ -70,9 +71,10 @@ class PoseToPointFactor : public NoiseModelFactor2 { * * Note: measured_ and the error are in local coordiantes. */ - Vector evaluateError(const POSE& w_T_b, const POINT& w_P, - boost::optional H1 = boost::none, - boost::optional H2 = boost::none) const { + Vector evaluateError( + const POSE& w_T_b, const POINT& w_P, + boost::optional H1 = boost::none, + boost::optional H2 = boost::none) const override { return w_T_b.transformTo(w_P, H1, H2) - measured_; }