Fixed bug in dim (it should be #rows not #columns!) and moved to base class

gtsam/slam/SmartFactorBase.h

@@ -25,10 +25,8 @@
 #include <gtsam/slam/RegularHessianFactor.h>
 
 #include <gtsam/nonlinear/NonlinearFactor.h>
-#include <gtsam/geometry/PinholeCamera.h>  // for Cheirality exception
+#include <gtsam/geometry/Point3.h>
-#include <gtsam/geometry/StereoCamera.h>
+#include <gtsam/geometry/CalibratedCamera.h> // for Cheirality exception
-#include <gtsam/geometry/Pose3.h>
-#include <gtsam/inference/Symbol.h>
 
 #include <boost/optional.hpp>
 #include <boost/make_shared.hpp>
@@ -150,6 +148,11 @@ public:
     }
   }
 
+  /// get the dimension (number of rows!) of the factor
+  virtual size_t dim() const {
+    return ZDim * this->measured_.size();
+  }
+
   /** return the measurements */
   const std::vector<Z>& measured() const {
     return measured_;

gtsam/slam/SmartProjectionPoseFactor.h

@@ -141,11 +141,6 @@ public:
     return e && Base::equals(p, tol);
   }
 
-  /// get the dimension of the factor
-  virtual size_t dim() const {
-    return 6 * this->keys_.size();
-  }
-
   /**
    * Collect all cameras involved in this factor
    * @param values Values structure which must contain camera poses corresponding

gtsam_unstable/slam/SmartStereoProjectionPoseFactor.h

@@ -143,11 +143,6 @@ public:
     return e && Base::equals(p, tol);
   }
 
-  /// get the dimension of the factor
-  virtual size_t dim() const {
-    return 6 * this->keys_.size();
-  }
-
   /**
    * Collect all cameras involved in this factor
    * @param values Values structure which must contain camera poses corresponding