diff --git a/trajopt_ifopt/test/inverse_kinematics_constraint_unit.cpp b/trajopt_ifopt/test/inverse_kinematics_constraint_unit.cpp index 2a958553..0943a18f 100644 --- a/trajopt_ifopt/test/inverse_kinematics_constraint_unit.cpp +++ b/trajopt_ifopt/test/inverse_kinematics_constraint_unit.cpp @@ -35,6 +35,7 @@ TRAJOPT_IGNORE_WARNINGS_PUSH #include #include #include +#include TRAJOPT_IGNORE_WARNINGS_POP #include @@ -106,7 +107,7 @@ TEST_F(InverseKinematicsConstraintUnit, GetValue) // NOLINT // Get the value (distance from IK position) Eigen::VectorXd values = constraint->GetValues(); - EXPECT_TRUE(values.isApprox(Eigen::VectorXd::Zero(n_dof))); + EXPECT_TRUE(almostEqualRelativeAndAbs(values, Eigen::VectorXd::Zero(n_dof))); // Check that jac wrt constraint_var is identity {