diff --git a/gtsam/geometry/tests/testSO3.cpp b/gtsam/geometry/tests/testSO3.cpp index 3d8e41af5..0fe699116 100644 --- a/gtsam/geometry/tests/testSO3.cpp +++ b/gtsam/geometry/tests/testSO3.cpp @@ -55,46 +55,6 @@ TEST(SO3 , Retract) { EXPECT(actual.isApprox(R2)); } -//****************************************************************************** -TEST(SO3 , Compose) { - SO3 expected = R1 * R2; - Matrix actualH1, actualH2; - SO3 actual = traits::Compose(R1, R2, actualH1, actualH2); - EXPECT(traits::Equals(expected,actual)); - - Matrix numericalH1 = numericalDerivative21(traits::Compose, R1, R2); - EXPECT(assert_equal(numericalH1,actualH1)); - - Matrix numericalH2 = numericalDerivative22(traits::Compose, R1, R2); - EXPECT(assert_equal(numericalH2,actualH2)); -} - -//****************************************************************************** -TEST(SO3 , Between) { - SO3 expected = R1.inverse() * R2; - Matrix actualH1, actualH2; - SO3 actual = traits::Between(R1, R2, actualH1, actualH2); - EXPECT(traits::Equals(expected,actual)); - - Matrix numericalH1 = numericalDerivative21(traits::Between, R1, R2); - EXPECT(assert_equal(numericalH1,actualH1)); - - Matrix numericalH2 = numericalDerivative22(traits::Between, R1, R2); - EXPECT(assert_equal(numericalH2,actualH2)); -} - -//****************************************************************************** -TEST(SO3 , Inverse) { - SO3 expected(Eigen::AngleAxisd(-0.1, z_axis)); - - Matrix actualH; - SO3 actual = traits::Inverse(R1, actualH); - EXPECT(traits::Equals(expected,actual)); - - Matrix numericalH = numericalDerivative11(traits::Inverse, R1); - EXPECT(assert_equal(numericalH,actualH)); -} - //****************************************************************************** TEST(SO3 , Invariants) { check_group_invariants(id,id);