parent
761987a14c
commit
bc1104c807
|
@ -204,19 +204,19 @@ TEST(Pose3, AdjointTranspose)
|
||||||
T.AdjointTranspose(xi, actualH1, actualH2);
|
T.AdjointTranspose(xi, actualH1, actualH2);
|
||||||
expectedH1 = numericalDerivative21(AdjointTranspose_proxy, T, xi);
|
expectedH1 = numericalDerivative21(AdjointTranspose_proxy, T, xi);
|
||||||
expectedH2 = numericalDerivative22(AdjointTranspose_proxy, T, xi);
|
expectedH2 = numericalDerivative22(AdjointTranspose_proxy, T, xi);
|
||||||
EXPECT(assert_equal(expectedH1, actualH1));
|
EXPECT(assert_equal(expectedH1, actualH1, 1e-8));
|
||||||
EXPECT(assert_equal(expectedH2, actualH2));
|
EXPECT(assert_equal(expectedH2, actualH2));
|
||||||
|
|
||||||
T2.AdjointTranspose(xi, actualH1, actualH2);
|
T2.AdjointTranspose(xi, actualH1, actualH2);
|
||||||
expectedH1 = numericalDerivative21(AdjointTranspose_proxy, T2, xi);
|
expectedH1 = numericalDerivative21(AdjointTranspose_proxy, T2, xi);
|
||||||
expectedH2 = numericalDerivative22(AdjointTranspose_proxy, T2, xi);
|
expectedH2 = numericalDerivative22(AdjointTranspose_proxy, T2, xi);
|
||||||
EXPECT(assert_equal(expectedH1, actualH1));
|
EXPECT(assert_equal(expectedH1, actualH1, 1e-8));
|
||||||
EXPECT(assert_equal(expectedH2, actualH2));
|
EXPECT(assert_equal(expectedH2, actualH2));
|
||||||
|
|
||||||
T3.AdjointTranspose(xi, actualH1, actualH2);
|
T3.AdjointTranspose(xi, actualH1, actualH2);
|
||||||
expectedH1 = numericalDerivative21(AdjointTranspose_proxy, T3, xi);
|
expectedH1 = numericalDerivative21(AdjointTranspose_proxy, T3, xi);
|
||||||
expectedH2 = numericalDerivative22(AdjointTranspose_proxy, T3, xi);
|
expectedH2 = numericalDerivative22(AdjointTranspose_proxy, T3, xi);
|
||||||
EXPECT(assert_equal(expectedH1, actualH1));
|
EXPECT(assert_equal(expectedH1, actualH1, 1e-8));
|
||||||
EXPECT(assert_equal(expectedH2, actualH2));
|
EXPECT(assert_equal(expectedH2, actualH2));
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue