From db2a9151e5c35ca84c150852d4d6a8f5c29afe21 Mon Sep 17 00:00:00 2001 From: lcarlone Date: Tue, 24 Aug 2021 20:56:40 -0400 Subject: [PATCH] don't like it - going to create a different class --- gtsam/slam/SmartProjectionPoseFactor.h | 45 +++++-------------- .../slam/SmartStereoProjectionFactor.h | 2 +- 2 files changed, 13 insertions(+), 34 deletions(-) diff --git a/gtsam/slam/SmartProjectionPoseFactor.h b/gtsam/slam/SmartProjectionPoseFactor.h index 5abfcc312..8731eaec4 100644 --- a/gtsam/slam/SmartProjectionPoseFactor.h +++ b/gtsam/slam/SmartProjectionPoseFactor.h @@ -10,7 +10,7 @@ * -------------------------------------------------------------------------- */ /** - * @file SmartProjectionPoseFactorC.h + * @file SmartProjectionFactorP.h * @brief Smart factor on poses, assuming camera calibration is fixed * @author Luca Carlone * @author Chris Beall @@ -42,11 +42,11 @@ namespace gtsam { * @addtogroup SLAM */ template -class SmartProjectionPoseFactorC: public SmartProjectionFactor { +class SmartProjectionFactorP: public SmartProjectionFactor { private: typedef SmartProjectionFactor Base; - typedef SmartProjectionPoseFactorC This; + typedef SmartProjectionFactorP This; typedef CAMERA Camera; typedef typename CAMERA::CalibrationType CALIBRATION; @@ -62,7 +62,7 @@ public: /** * Default constructor, only for serialization */ - SmartProjectionPoseFactorC() {} + SmartProjectionFactorP() {} /** * Constructor @@ -70,7 +70,7 @@ public: * @param K (fixed) calibration, assumed to be the same for all cameras * @param params parameters for the smart projection factors */ - SmartProjectionPoseFactorC( + SmartProjectionFactorP( const SharedNoiseModel& sharedNoiseModel, const boost::shared_ptr K, const SmartProjectionParams& params = SmartProjectionParams()) @@ -84,17 +84,17 @@ public: * @param body_P_sensor pose of the camera in the body frame (optional) * @param params parameters for the smart projection factors */ - SmartProjectionPoseFactorC( + SmartProjectionFactorP( const SharedNoiseModel& sharedNoiseModel, const boost::shared_ptr K, const boost::optional body_P_sensor, const SmartProjectionParams& params = SmartProjectionParams()) - : SmartProjectionPoseFactorC(sharedNoiseModel, K, params) { + : SmartProjectionFactorP(sharedNoiseModel, K, params) { this->body_P_sensor_ = body_P_sensor; } /** Virtual destructor */ - ~SmartProjectionPoseFactorC() override { + ~SmartProjectionFactorP() override { } /** @@ -104,7 +104,7 @@ public: */ void print(const std::string& s = "", const KeyFormatter& keyFormatter = DefaultKeyFormatter) const override { - std::cout << s << "SmartProjectionPoseFactorC, z = \n "; + std::cout << s << "SmartProjectionFactorP, z = \n "; Base::print("", keyFormatter); } @@ -162,32 +162,11 @@ public: /// traits template -struct traits > : public Testable< - SmartProjectionPoseFactorC > { +struct traits > : public Testable< + SmartProjectionFactorP > { }; // legacy smart factor class, only templated on calibration and assuming pinhole -template using SmartProjectionPoseFactor = SmartProjectionPoseFactorC< PinholePose >; - -//template -//using SmartProjectionPoseFactor = SmartProjectionPoseFactorC< PinholePose >; - -//template -//struct SmartProjectionPoseFactor{ -// typedef SmartProjectionPoseFactorC< PinholePose >; -//}; - -//template -//class SmartProjectionPoseFactor{ -// typedef SmartProjectionPoseFactorC< PinholePose >; -//}; - -//typedef typename CAMERA::CalibrationType CALIBRATION; -//template -//class SmartProjectionPoseFactor: public SmartProjectionPoseFactorC< > { -// public: -// private: -//}; -// end +template using SmartProjectionPoseFactor = SmartProjectionFactorP< PinholePose >; } // \ namespace gtsam diff --git a/gtsam_unstable/slam/SmartStereoProjectionFactor.h b/gtsam_unstable/slam/SmartStereoProjectionFactor.h index 52fd99356..e361dddac 100644 --- a/gtsam_unstable/slam/SmartStereoProjectionFactor.h +++ b/gtsam_unstable/slam/SmartStereoProjectionFactor.h @@ -11,7 +11,7 @@ /** * @file SmartStereoProjectionFactor.h - * @brief Smart stereo factor on StereoCameras (pose + calibration) + * @brief Smart stereo factor on StereoCameras (pose) * @author Luca Carlone * @author Zsolt Kira * @author Frank Dellaert