diff --git a/gtsam/base/tests/testNumericalDerivative.cpp b/gtsam/base/tests/testNumericalDerivative.cpp index 7cdabbbe9..023bb1718 100644 --- a/gtsam/base/tests/testNumericalDerivative.cpp +++ b/gtsam/base/tests/testNumericalDerivative.cpp @@ -22,43 +22,43 @@ using namespace gtsam; -/* ************************************************************************* */ -double f(const LieVector& x) { - assert(x.size() == 2); - return sin(x(0)) + cos(x(1)); -} - -/* ************************************************************************* */ -TEST_UNSAFE(testNumericalDerivative, numericalHessian) { - LieVector center(2, 1.0, 1.0); - - Matrix expected = Matrix_(2,2, - -sin(center(0)), 0.0, - 0.0, -cos(center(1))); - - Matrix actual = numericalHessian(f, center); - - EXPECT(assert_equal(expected, actual, 1e-5)); -} - -/* ************************************************************************* */ -double f2(const LieVector& x) { - assert(x.size() == 2); - return sin(x(0)) * cos(x(1)); -} - -/* ************************************************************************* */ -TEST_UNSAFE(testNumericalDerivative, numericalHessian2) { - LieVector center(2, 0.5, 1.0); - - Matrix expected = Matrix_(2,2, - -cos(center(1))*sin(center(0)), -sin(center(1))*cos(center(0)), - -cos(center(0))*sin(center(1)), -sin(center(0))*cos(center(1))); - - Matrix actual = numericalHessian(f2, center); - - EXPECT(assert_equal(expected, actual, 1e-5)); -} +///* ************************************************************************* */ +//double f(const LieVector& x) { +// assert(x.size() == 2); +// return sin(x(0)) + cos(x(1)); +//} +// +///* ************************************************************************* */ +//TEST_UNSAFE(testNumericalDerivative, numericalHessian) { +// LieVector center(2, 1.0, 1.0); +// +// Matrix expected = Matrix_(2,2, +// -sin(center(0)), 0.0, +// 0.0, -cos(center(1))); +// +// Matrix actual = numericalHessian(f, center); +// +// EXPECT(assert_equal(expected, actual, 1e-5)); +//} +// +///* ************************************************************************* */ +//double f2(const LieVector& x) { +// assert(x.size() == 2); +// return sin(x(0)) * cos(x(1)); +//} +// +///* ************************************************************************* */ +//TEST_UNSAFE(testNumericalDerivative, numericalHessian2) { +// LieVector center(2, 0.5, 1.0); +// +// Matrix expected = Matrix_(2,2, +// -cos(center(1))*sin(center(0)), -sin(center(1))*cos(center(0)), +// -cos(center(0))*sin(center(1)), -sin(center(0))*cos(center(1))); +// +// Matrix actual = numericalHessian(f2, center); +// +// EXPECT(assert_equal(expected, actual, 1e-5)); +//} /* ************************************************************************* */ int main() { TestResult tr; return TestRegistry::runAllTests(tr); }