diff --git a/test/engine/engine_support_test.cc b/test/engine/engine_support_test.cc index 1f95c660..36dd6e06 100644 --- a/test/engine/engine_support_test.cc +++ b/test/engine/engine_support_test.cc @@ -805,6 +805,9 @@ TEST_F(SupportTest, MulMIsland) { static constexpr char GeomDistanceTestingModel[] = R"( + @@ -853,25 +856,20 @@ TEST_F(SupportTest, GeomDistance) { EXPECT_THAT(fromto, Pointwise(DoubleNear(eps), std::vector{.7, 0, 1, .2, 0, 1})); - // TODO: b/339596989 - Improve the bounds below (mjc_Convex). - // mesh-sphere (close distmax) distmax = 0.701; - eps = 1e-5; + eps = model->opt.ccd_tolerance; EXPECT_THAT(mj_geomDistance(model, data, 3, 1, distmax, fromto), DoubleNear(0.7, eps)); - eps = 1e-3; EXPECT_THAT(fromto, Pointwise(DoubleNear(eps), - std::vector{0, 0, .1, 0, 0, .8})); + std::vector{0, 0, .8, 0, 0, .1})); // mesh-sphere (far distmax) distmax = 1.0; - eps = 1e-3; EXPECT_THAT(mj_geomDistance(model, data, 3, 1, distmax, fromto), DoubleNear(0.7, eps)); - eps = 2e-2; EXPECT_THAT(fromto, Pointwise(DoubleNear(eps), - std::vector{0, 0, .1, 0, 0, .8})); + std::vector{0, 0, .8, 0, 0, .1})); mj_deleteData(data); mj_deleteModel(model);