diff --git a/gtsam/base/Matrix.h b/gtsam/base/Matrix.h index 60126067d..d01d6598e 100644 --- a/gtsam/base/Matrix.h +++ b/gtsam/base/Matrix.h @@ -355,6 +355,7 @@ Vector backSubstituteLower(const Matrix& L, const Vector& d, bool unit=false); /** * create a matrix by stacking other matrices * Given a set of matrices: A1, A2, A3... + * @param ... pointers to matrices to be stacked * @return combined matrix [A1; A2; A3] */ Matrix stack(size_t nrMatrices, ...); diff --git a/gtsam/geometry/Pose3.h b/gtsam/geometry/Pose3.h index 9c4d46847..f4b7a6caa 100644 --- a/gtsam/geometry/Pose3.h +++ b/gtsam/geometry/Pose3.h @@ -102,7 +102,7 @@ namespace gtsam { boost::optional H1=boost::none, boost::optional H2=boost::none) const; /** syntactic sugar for transform */ - inline Point3 operator*(const Point3& p) { return transform_from(p); } + inline Point3 operator*(const Point3& p) const { return transform_from(p); } /** receives the point in world coordinates and transforms it to Pose coordinates */ Point3 transform_to(const Point3& p,