diff --git a/autoware_lanelet2_extension/test/src/test_utilities.cpp b/autoware_lanelet2_extension/test/src/test_utilities.cpp index 9e35506..f1777bd 100644 --- a/autoware_lanelet2_extension/test/src/test_utilities.cpp +++ b/autoware_lanelet2_extension/test/src/test_utilities.cpp @@ -159,6 +159,15 @@ TEST_F(TestSuite, OverwriteLaneletsCenterline) // NOLINT for gtest } } +TEST_F(TestSuite, GetLaneletLength) // NOLINT for gtest +{ + double length_2d = lanelet::utils::getLaneletLength2d(road_lanelet); + double length_3d = lanelet::utils::getLaneletLength3d(road_lanelet); + + EXPECT_DOUBLE_EQ(length_2d, 1.0); + EXPECT_DOUBLE_EQ(length_3d, 1.0); +} + /* TEST(Utilities, copyZ) // NOLINT for gtest {