diff --git a/gtsam/base/Matrix.h b/gtsam/base/Matrix.h index ad0e4df0f..77af3d058 100644 --- a/gtsam/base/Matrix.h +++ b/gtsam/base/Matrix.h @@ -479,7 +479,7 @@ GTSAM_EXPORT Matrix Cayley(const Matrix& A); template Eigen::Matrix Cayley(const Eigen::Matrix& A) { typedef Eigen::Matrix FMat; - return Eigen::Matrix = (FMat::Identity() - A)*(FMat::Identity() + A).inverse(); + return (FMat::Identity() - A)*(FMat::Identity() + A).inverse(); } } // namespace gtsam diff --git a/gtsam/geometry/Rot3M.cpp b/gtsam/geometry/Rot3M.cpp index 4720c1542..2e09fd3f9 100644 --- a/gtsam/geometry/Rot3M.cpp +++ b/gtsam/geometry/Rot3M.cpp @@ -167,7 +167,7 @@ Point3 Rot3::operator*(const Point3& p) const { return rotate(p); } /* ************************************************************************* */ Rot3 Rot3::inverse(boost::optional H1) const { if (H1) *H1 = -rot_; - return Rot3(rot_.transpose()); + return Rot3(Matrix3(rot_.transpose())); } /* ************************************************************************* */ @@ -175,13 +175,13 @@ Rot3 Rot3::between (const Rot3& R2, boost::optional H1, boost::optional H2) const { if (H1) *H1 = -(R2.transpose()*rot_); if (H2) *H2 = I3; - return Rot3(rot_.transpose()*R2.rot_); + return Rot3(Matrix3(rot_.transpose()*R2.rot_)); //return between_default(*this, R2); } /* ************************************************************************* */ Rot3 Rot3::operator*(const Rot3& R2) const { - return Rot3(rot_*R2.rot_); + return Rot3(Matrix3(rot_*R2.rot_)); } /* ************************************************************************* */