diff --git a/gtsam.h b/gtsam.h index 9976cbf01..678e2a3d6 100644 --- a/gtsam.h +++ b/gtsam.h @@ -2179,27 +2179,6 @@ typedef gtsam::GenericProjectionFactor GenericProjectionFactorCal3DS2; -#include -template -virtual class TransformProjectionFactor : gtsam::NoiseModelFactor { - TransformProjectionFactor(const gtsam::Point2& measured, const gtsam::noiseModel::Base* noiseModel, - size_t poseKey, size_t transformKey, size_t pointKey, const CALIBRATION* k); - - TransformProjectionFactor(const gtsam::Point2& measured, const gtsam::noiseModel::Base* noiseModel, - size_t poseKey, size_t transformKey, size_t pointKey, const CALIBRATION* k, bool throwCheirality, bool verboseCheirality); - - gtsam::Point2 measured() const; - CALIBRATION* calibration() const; - bool verboseCheirality() const; - bool throwCheirality() const; - - // enabling serialization functionality - void serialize() const; -}; -typedef gtsam::TransformProjectionFactor TransformProjectionFactorCal3_S2; -typedef gtsam::TransformProjectionFactor TransformProjectionFactorCal3DS2; - - #include template virtual class GeneralSFMFactor : gtsam::NoiseModelFactor { diff --git a/gtsam_unstable/gtsam_unstable.h b/gtsam_unstable/gtsam_unstable.h index 06a41f5ec..4254368cd 100644 --- a/gtsam_unstable/gtsam_unstable.h +++ b/gtsam_unstable/gtsam_unstable.h @@ -24,6 +24,7 @@ virtual class gtsam::GaussianFactor; virtual class gtsam::HessianFactor; virtual class gtsam::JacobianFactor; virtual class gtsam::Cal3_S2; +virtual class gtsam::Cal3DS2; class gtsam::GaussianFactorGraph; class gtsam::NonlinearFactorGraph; class gtsam::Ordering; @@ -740,4 +741,45 @@ virtual class OdometryFactorBase : gtsam::NoiseModelFactor { void print(string s) const; }; +#include +#include +template +virtual class TransformProjectionFactor : gtsam::NoiseModelFactor { + TransformProjectionFactor(const gtsam::Point2& measured, const gtsam::noiseModel::Base* noiseModel, + size_t poseKey, size_t transformKey, size_t pointKey, const CALIBRATION* k); + + TransformProjectionFactor(const gtsam::Point2& measured, const gtsam::noiseModel::Base* noiseModel, + size_t poseKey, size_t transformKey, size_t pointKey, const CALIBRATION* k, bool throwCheirality, bool verboseCheirality); + + gtsam::Point2 measured() const; + CALIBRATION* calibration() const; + bool verboseCheirality() const; + bool throwCheirality() const; + + // enabling serialization functionality + void serialize() const; +}; +typedef gtsam::TransformProjectionFactor TransformProjectionFactorCal3_S2; +typedef gtsam::TransformProjectionFactor TransformProjectionFactorCal3DS2; + + +#include +template +virtual class TransformCalProjectionFactor : gtsam::NoiseModelFactor { + TransformCalProjectionFactor(const gtsam::Point2& measured, const gtsam::noiseModel::Base* noiseModel, + size_t poseKey, size_t transformKey, size_t pointKey, size_t calibKey); + + TransformCalProjectionFactor(const gtsam::Point2& measured, const gtsam::noiseModel::Base* noiseModel, + size_t poseKey, size_t transformKey, size_t pointKey, size_t calibKey, bool throwCheirality, bool verboseCheirality); + + gtsam::Point2 measured() const; + bool verboseCheirality() const; + bool throwCheirality() const; + + // enabling serialization functionality + void serialize() const; +}; +typedef gtsam::TransformCalProjectionFactor TransformCalProjectionFactorCal3_S2; +typedef gtsam::TransformCalProjectionFactor TransformCalProjectionFactorCal3DS2; + } //\namespace gtsam diff --git a/gtsam/slam/TransformProjectionFactor.h b/gtsam_unstable/slam/TransformProjectionFactor.h similarity index 100% rename from gtsam/slam/TransformProjectionFactor.h rename to gtsam_unstable/slam/TransformProjectionFactor.h diff --git a/gtsam/slam/tests/testTransformProjectionFactor.cpp b/gtsam_unstable/slam/tests/testTransformProjectionFactor.cpp similarity index 99% rename from gtsam/slam/tests/testTransformProjectionFactor.cpp rename to gtsam_unstable/slam/tests/testTransformProjectionFactor.cpp index d38376cb6..2dd44dfb5 100644 --- a/gtsam/slam/tests/testTransformProjectionFactor.cpp +++ b/gtsam_unstable/slam/tests/testTransformProjectionFactor.cpp @@ -18,7 +18,7 @@ #include #include -#include +#include #include #include #include