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

Check ceres rotation convention

release/4.3a0
Frank Dellaert 2015-07-04 15:25:18 -07:00
parent cb1672d292
commit 8ceaa8a3cc
1 changed files with 10 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
gtsam/nonlinear/tests/testAdaptAutoDiff.cpp
View File

@ -59,6 +59,16 @@ typedef PinholeCamera<Cal> Camera;
using namespace std;
using namespace gtsam;
/* ************************************************************************* */
// Make sure rotation convention is the same
TEST(AdaptAutoDiff, Rotation) {
Vector3 axisAngle(0.1,0.2,0.3);
Matrix3 expected = Rot3::rodriguez(axisAngle).matrix();
Matrix3 actual;
ceres::AngleAxisToRotationMatrix(axisAngle.data(), actual.data());
EXPECT(assert_equal(expected, actual));
}
/* ************************************************************************* */
// charts
TEST(AdaptAutoDiff, Canonical) {