diff --git a/gtsam/slam/GeneralSFMFactor.h b/gtsam/slam/GeneralSFMFactor.h index 48c10e444..bd3e251ae 100644 --- a/gtsam/slam/GeneralSFMFactor.h +++ b/gtsam/slam/GeneralSFMFactor.h @@ -27,21 +27,21 @@ namespace gtsam { /** * Non-linear factor for a constraint derived from a 2D measurement. The calibration is unknown here compared to GenericProjectionFactor */ - template + template class GeneralSFMFactor: - public NonlinearFactor2 { + public NonlinearFactor2 { protected: Point2 z_; public: typedef typename CamK::Value Cam; - typedef GeneralSFMFactor Self ; - typedef NonlinearFactor2 Base; + typedef GeneralSFMFactor Self ; + typedef NonlinearFactor2 Base; typedef Point2 Measurement; // shorthand for a smart pointer to a factor - typedef boost::shared_ptr > shared_ptr; + typedef boost::shared_ptr > shared_ptr; /** * Constructor @@ -71,7 +71,7 @@ namespace gtsam { /** * equals */ - bool equals(const GeneralSFMFactor &p, double tol = 1e-9) const { + bool equals(const GeneralSFMFactor &p, double tol = 1e-9) const { return Base::equals(p, tol) && this->z_.equals(p.z_, tol) ; } diff --git a/gtsam/slam/ProjectionFactor.h b/gtsam/slam/ProjectionFactor.h index 6135bfc4b..5a0ad4f1f 100644 --- a/gtsam/slam/ProjectionFactor.h +++ b/gtsam/slam/ProjectionFactor.h @@ -29,8 +29,8 @@ namespace gtsam { * Non-linear factor for a constraint derived from a 2D measurement. The calibration is known here. * i.e. the main building block for visual SLAM. */ - template - class GenericProjectionFactor : public NonlinearFactor2, Testable > { + template + class GenericProjectionFactor : public NonlinearFactor2, Testable > { protected: // Keep a copy of measurement and calibration for I/O @@ -40,10 +40,10 @@ namespace gtsam { public: // shorthand for base class type - typedef NonlinearFactor2 Base; + typedef NonlinearFactor2 Base; // shorthand for a smart pointer to a factor - typedef boost::shared_ptr > shared_ptr; + typedef boost::shared_ptr > shared_ptr; /** * Default constructor @@ -76,7 +76,7 @@ namespace gtsam { /** * equals */ - bool equals(const GenericProjectionFactor& p, double tol = 1e-9) const { + bool equals(const GenericProjectionFactor& p, double tol = 1e-9) const { return Base::equals(p, tol) && this->z_.equals(p.z_, tol) && this->K_->equals(*p.K_, tol); } diff --git a/gtsam/slam/simulated2D.h b/gtsam/slam/simulated2D.h index 0442cbf9d..1f5b96150 100644 --- a/gtsam/slam/simulated2D.h +++ b/gtsam/slam/simulated2D.h @@ -111,18 +111,18 @@ namespace gtsam { /** * Unary factor encoding a soft prior on a vector */ - template - class GenericPrior: public NonlinearFactor1 { + template + class GenericPrior: public NonlinearFactor1 { public: - typedef NonlinearFactor1 Base; ///< base class - typedef boost::shared_ptr > shared_ptr; + typedef NonlinearFactor1 Base; ///< base class + typedef boost::shared_ptr > shared_ptr; typedef typename KEY::Value Pose; ///< shortcut to Pose type Pose z_; ///< prior mean /// Create generic prior GenericPrior(const Pose& z, const SharedNoiseModel& model, const KEY& key) : - NonlinearFactor1(model, key), z_(z) { + NonlinearFactor1(model, key), z_(z) { } /// Return error and optional derivative @@ -149,11 +149,11 @@ namespace gtsam { /** * Binary factor simulating "odometry" between two Vectors */ - template - class GenericOdometry: public NonlinearFactor2 { + template + class GenericOdometry: public NonlinearFactor2 { public: - typedef NonlinearFactor2 Base; ///< base class - typedef boost::shared_ptr > shared_ptr; + typedef NonlinearFactor2 Base; ///< base class + typedef boost::shared_ptr > shared_ptr; typedef typename KEY::Value Pose; ///< shortcut to Pose type Pose z_; ///< odometry measurement @@ -161,7 +161,7 @@ namespace gtsam { /// Create odometry GenericOdometry(const Pose& z, const SharedNoiseModel& model, const KEY& i1, const KEY& i2) : - NonlinearFactor2(model, i1, i2), z_(z) { + NonlinearFactor2(model, i1, i2), z_(z) { } /// Evaluate error and optionally return derivatives @@ -189,11 +189,11 @@ namespace gtsam { /** * Binary factor simulating "measurement" between two Vectors */ - template - class GenericMeasurement: public NonlinearFactor2 { + template + class GenericMeasurement: public NonlinearFactor2 { public: - typedef NonlinearFactor2 Base; ///< base class - typedef boost::shared_ptr > shared_ptr; + typedef NonlinearFactor2 Base; ///< base class + typedef boost::shared_ptr > shared_ptr; typedef typename XKEY::Value Pose; ///< shortcut to Pose type typedef typename LKEY::Value Point; ///< shortcut to Point type @@ -202,7 +202,7 @@ namespace gtsam { /// Create measurement factor GenericMeasurement(const Point& z, const SharedNoiseModel& model, const XKEY& i, const LKEY& j) : - NonlinearFactor2(model, i, j), z_(z) { + NonlinearFactor2(model, i, j), z_(z) { } /// Evaluate error and optionally return derivatives diff --git a/gtsam/slam/simulated2DConstraints.h b/gtsam/slam/simulated2DConstraints.h index 6dd05f14e..1d147fec3 100644 --- a/gtsam/slam/simulated2DConstraints.h +++ b/gtsam/slam/simulated2DConstraints.h @@ -51,10 +51,10 @@ namespace gtsam { * Unary inequality constraint forcing a coordinate to be greater/less than a fixed value (c) * Demo implementation: should be made more general using BoundingConstraint */ - template - struct ScalarCoordConstraint1: public BoundingConstraint1 { - typedef BoundingConstraint1 Base; - typedef boost::shared_ptr > shared_ptr; + template + struct ScalarCoordConstraint1: public BoundingConstraint1 { + typedef BoundingConstraint1 Base; + typedef boost::shared_ptr > shared_ptr; ScalarCoordConstraint1(const Key& key, double c, bool isGreaterThan, double mu = 1000.0) : @@ -85,9 +85,9 @@ namespace gtsam { * Binary inequality constraint forcing the range between points * to be less than or equal to a bound */ - template - struct MaxDistanceConstraint : public BoundingConstraint2 { - typedef BoundingConstraint2 Base; + template + struct MaxDistanceConstraint : public BoundingConstraint2 { + typedef BoundingConstraint2 Base; MaxDistanceConstraint(const Key& key1, const Key& key2, double range_bound, double mu = 1000.0) : Base(key1, key2, range_bound, false, mu) {} @@ -108,9 +108,9 @@ namespace gtsam { * Binary inequality constraint forcing a minimum range * NOTE: this is not a convex function! Be careful with initialization. */ - template - struct MinDistanceConstraint : public BoundingConstraint2 { - typedef BoundingConstraint2 Base; + template + struct MinDistanceConstraint : public BoundingConstraint2 { + typedef BoundingConstraint2 Base; MinDistanceConstraint(const XKey& key1, const PKey& key2, double range_bound, double mu = 1000.0) : Base(key1, key2, range_bound, true, mu) {} diff --git a/gtsam/slam/simulated2DOriented.h b/gtsam/slam/simulated2DOriented.h index cbbc23bfe..9e19a32bc 100644 --- a/gtsam/slam/simulated2DOriented.h +++ b/gtsam/slam/simulated2DOriented.h @@ -55,15 +55,15 @@ namespace gtsam { boost::none, boost::optional H2 = boost::none); /// Unary factor encoding a soft prior on a vector - template - struct GenericPosePrior: public NonlinearFactor1 { + template + struct GenericPosePrior: public NonlinearFactor1 { Pose2 z_; ///< measurement /// Create generic pose prior GenericPosePrior(const Pose2& z, const SharedNoiseModel& model, const Key& key) : - NonlinearFactor1(model, key), z_(z) { + NonlinearFactor1(model, key), z_(z) { } /// Evaluate error and optionally derivative @@ -77,14 +77,14 @@ namespace gtsam { /** * Binary factor simulating "odometry" between two Vectors */ - template - struct GenericOdometry: public NonlinearFactor2 { + template + struct GenericOdometry: public NonlinearFactor2 { Pose2 z_; /// Create generic odometry factor GenericOdometry(const Pose2& z, const SharedNoiseModel& model, const KEY& i1, const KEY& i2) : - NonlinearFactor2(model, i1, i2), z_(z) { + NonlinearFactor2(model, i1, i2), z_(z) { } /// Evaluate error and optionally derivative