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

fixed testAHRSFactor

release/4.3a0
Mike Bosse 2014-12-22 13:56:19 +01:00
parent 628c4fbdab
commit 749eeaebf8
1 changed files with 1 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

1
gtsam/navigation/tests/testAHRSFactor.cpp
View File

@ -117,6 +117,7 @@ TEST( AHRSFactor, PreintegratedMeasurements ) {
TEST(AHRSFactor, Error) { TEST(AHRSFactor, Error) {
// Linearization point // Linearization point
Vector3 bias; // Bias Vector3 bias; // Bias
bias.setZero();
Rot3 x1(Rot3::RzRyRx(M_PI / 12.0, M_PI / 6.0, M_PI / 4.0)); Rot3 x1(Rot3::RzRyRx(M_PI / 12.0, M_PI / 6.0, M_PI / 4.0));
Rot3 x2(Rot3::RzRyRx(M_PI / 12.0 + M_PI / 100.0, M_PI / 6.0, M_PI / 4.0)); Rot3 x2(Rot3::RzRyRx(M_PI / 12.0 + M_PI / 100.0, M_PI / 6.0, M_PI / 4.0));