Added static dim() functions to remaining geometry types so that dimensions can be calculated on size alone.

cpp/Pose3.h

@@ -61,6 +61,9 @@ namespace gtsam {
 
     Pose3 transform_to(const Pose3& pose) const;
 
+    /** get the dimension by the type */
+    static inline size_t dim() { return 6; };
+
   private:
     /** Serialization function */
     friend class boost::serialization::access;

cpp/Rot2.h

@@ -75,6 +75,9 @@ namespace gtsam {
     /** rotate from world to rotated = R'*p */
     Point2 unrotate(const Point2& p) const;
 
+    /** get the dimension by the type */
+    static inline size_t dim() { return 1; };
+
   private:
     /** Serialization function */
     friend class boost::serialization::access;

cpp/Rot3.h

@@ -106,6 +106,9 @@ namespace gtsam {
      */
     Vector ypr() const;
 
+    /** get the dimension by the type */
+    static inline size_t dim() { return 3; };
+
   private:
     /** Serialization function */
     friend class boost::serialization::access;