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

View File

@ -117,6 +117,7 @@ TEST( AHRSFactor, PreintegratedMeasurements ) {
TEST(AHRSFactor, Error) {
// Linearization point
Vector3 bias; // Bias
bias.setZero();
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));