test(autoware_lanelet2_utils): fix threshold to avoid precision-related failures (#506)

Author: sarun-hub

common/autoware_lanelet2_utils/test/geometry.cpp

@@ -122,8 +122,8 @@ TEST_F(ExtrapolatedLaneletTest, InterpolateLanelet)
   const auto ll = lanelet_map_ptr_->laneletLayer.get(2287);
   auto opt_pt = lanelet2_utils::interpolate_lanelet(ll, 3.0);
   ASSERT_TRUE(opt_pt.has_value());
-  EXPECT_NEAR(opt_pt->x(), 164.269030, 1e-6);
-  EXPECT_NEAR(opt_pt->y(), 181.097588, 1e-6);
+  EXPECT_NEAR(opt_pt->x(), 164.269030, 1e-5);
+  EXPECT_NEAR(opt_pt->y(), 181.097588, 1e-5);
   EXPECT_NEAR(opt_pt->z(), 100.000000, 1e-6);
 }
 
@@ -137,8 +137,8 @@ TEST_F(ExtrapolatedLaneletTest, InterpolateLaneletSequence)
   }
   auto opt_pt = lanelet2_utils::interpolate_lanelet_sequence(lanelets, 3.0);
   ASSERT_TRUE(opt_pt.has_value());
-  EXPECT_NEAR(opt_pt->x(), 164.269030, 1e-6);
-  EXPECT_NEAR(opt_pt->y(), 181.097588, 1e-6);
+  EXPECT_NEAR(opt_pt->x(), 164.269030, 1e-5);
+  EXPECT_NEAR(opt_pt->y(), 181.097588, 1e-5);
   EXPECT_NEAR(opt_pt->z(), 100.000000, 1e-6);
 }
 
@@ -257,8 +257,8 @@ TEST_F(ExtrapolatedLaneletTest, GetPoseFrom2dArcLength_OnRealMapLanelets)
   auto opt_pose = autoware::lanelet2_utils::get_pose_from_2d_arc_length(lanelets, 3.0);
   ASSERT_TRUE(opt_pose.has_value());
   const auto & p = *opt_pose;
-  EXPECT_NEAR(p.position.x, 164.269030, 1e-6);
-  EXPECT_NEAR(p.position.y, 181.097588, 1e-6);
+  EXPECT_NEAR(p.position.x, 164.269030, 1e-5);
+  EXPECT_NEAR(p.position.y, 181.097588, 1e-5);
   EXPECT_NEAR(p.position.z, 100.000000, 1e-6);
   auto pt1 = lanelet_map_ptr_->laneletLayer.get(2287).centerline().front().basicPoint();
   auto pt2 = lanelet_map_ptr_->laneletLayer.get(2287).centerline()[1].basicPoint();