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

Fix alignment on SO<n>

release/4.3a0
Fan Jiang 2019-11-18 11:27:08 -05:00
parent 41902efc79
commit 78af8894f2
2 changed files with 5 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
gtsam/geometry/SOn.h
View File

@ -53,6 +53,9 @@ class SO : public LieGroup<SO<N>, internal::DimensionSO(N)> {
using VectorN2 = Eigen::Matrix<double, internal::NSquaredSO(N), 1>;
using MatrixDD = Eigen::Matrix<double, dimension, dimension>;
public:
EIGEN_MAKE_ALIGNED_OPERATOR_NEW
protected:
MatrixNN matrix_; ///< Rotation matrix

4
gtsam/linear/GaussianBayesNet.cpp
View File

@ -194,9 +194,9 @@ namespace gtsam {
if(cg->get_model()) {
Vector diag = cg->R().diagonal();
cg->get_model()->whitenInPlace(diag);
logDet += diag.unaryExpr(ptr_fun<double,double>(log)).sum();
logDet += diag.unaryExpr([](double c){return log(c);}).sum();
} else {
logDet += cg->R().diagonal().unaryExpr(ptr_fun<double,double>(log)).sum();
logDet += cg->R().diagonal().unaryExpr([](double c){return log(c);}).sum();
}
}
return logDet;