12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Templated version of skewSymmetric to work with fixed-size matrices

release/4.3a0
Richard Roberts 2012-05-15 14:35:40 +00:00
parent 913029cc93
commit 0e0680d3c9
1 changed files with 2 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
gtsam/base/Matrix.h
View File

@ -398,7 +398,8 @@ Matrix vector_scale(const Matrix& A, const Vector& v, bool inf_mask = false); //
* @return a 3*3 skew symmetric matrix
*/
Matrix3 skewSymmetric(double wx, double wy, double wz);
inline Matrix3 skewSymmetric(const Vector& w) { return skewSymmetric(w(0),w(1),w(2));}
template<class Derived>
inline Matrix3 skewSymmetric(const Eigen::MatrixBase<Derived>& w) { return skewSymmetric(w(0),w(1),w(2));}
/** Use SVD to calculate inverse square root of a matrix */
Matrix inverse_square_root(const Matrix& A);