|
21 | 21 | namespace route_handler::test
|
22 | 22 | {
|
23 | 23 | // Example YAML structure as a string for testing
|
24 |
| -const std::string g_complete_yaml = R"( |
| 24 | +const char g_complete_yaml[] = R"( |
25 | 25 | start_pose:
|
26 | 26 | position:
|
27 | 27 | x: 1.0
|
@@ -91,42 +91,44 @@ TEST(ParseFunctions, CompleteYAMLTest)
|
91 | 91 | EXPECT_EQ(segment0.primitives[1].primitive_type, "lane");
|
92 | 92 | }
|
93 | 93 |
|
94 |
| -TEST(ParseFunction, CompleteFromFilename){ |
95 |
| - const auto planning_test_utils_dir = |
96 |
| - ament_index_cpp::get_package_share_directory("route_handler"); |
97 |
| - const auto parser_test_route = planning_test_utils_dir + "/test_route/parser_test.route"; |
98 |
| - |
99 |
| - |
100 |
| - const auto lanelet_route = parse_route_file(parser_test_route); |
101 |
| - EXPECT_DOUBLE_EQ(lanelet_route.start_pose.position.x, 1.0); |
102 |
| - EXPECT_DOUBLE_EQ(lanelet_route.start_pose.position.y, 2.0); |
103 |
| - EXPECT_DOUBLE_EQ(lanelet_route.start_pose.position.z, 3.0); |
104 |
| - |
105 |
| - EXPECT_DOUBLE_EQ(lanelet_route.start_pose.orientation.x, 0.1); |
106 |
| - EXPECT_DOUBLE_EQ(lanelet_route.start_pose.orientation.y, 0.2); |
107 |
| - EXPECT_DOUBLE_EQ(lanelet_route.start_pose.orientation.z, 0.3); |
108 |
| - EXPECT_DOUBLE_EQ(lanelet_route.start_pose.orientation.w, 0.4); |
109 |
| - |
110 |
| - EXPECT_DOUBLE_EQ(lanelet_route.goal_pose.position.x, 4.0); |
111 |
| - EXPECT_DOUBLE_EQ(lanelet_route.goal_pose.position.y, 5.0); |
112 |
| - EXPECT_DOUBLE_EQ(lanelet_route.goal_pose.position.z, 6.0); |
113 |
| - EXPECT_DOUBLE_EQ(lanelet_route.goal_pose.orientation.x, 0.5); |
114 |
| - EXPECT_DOUBLE_EQ(lanelet_route.goal_pose.orientation.y, 0.6); |
115 |
| - EXPECT_DOUBLE_EQ(lanelet_route.goal_pose.orientation.z, 0.7); |
116 |
| - EXPECT_DOUBLE_EQ(lanelet_route.goal_pose.orientation.w, 0.8); |
117 |
| - |
118 |
| - ASSERT_EQ(lanelet_route.segments.size(), 2); // Assuming only one segment in the provided YAML for this test |
119 |
| - const auto & segment1 = lanelet_route.segments[1]; |
120 |
| - EXPECT_EQ(segment1.preferred_primitive.id, 44); |
121 |
| - EXPECT_EQ(segment1.primitives.size(), 4); |
122 |
| - EXPECT_EQ(segment1.primitives[0].id, 55); |
123 |
| - EXPECT_EQ(segment1.primitives[0].primitive_type, "lane"); |
124 |
| - EXPECT_EQ(segment1.primitives[1].id, 66); |
125 |
| - EXPECT_EQ(segment1.primitives[1].primitive_type, "lane"); |
126 |
| - EXPECT_EQ(segment1.primitives[2].id, 77); |
127 |
| - EXPECT_EQ(segment1.primitives[2].primitive_type, "lane"); |
128 |
| - EXPECT_EQ(segment1.primitives[3].id, 88); |
129 |
| - EXPECT_EQ(segment1.primitives[3].primitive_type, "lane"); |
| 94 | +TEST(ParseFunction, CompleteFromFilename) |
| 95 | +{ |
| 96 | + const auto planning_test_utils_dir = |
| 97 | + ament_index_cpp::get_package_share_directory("route_handler"); |
| 98 | + const auto parser_test_route = planning_test_utils_dir + "/test_route/parser_test.route"; |
| 99 | + |
| 100 | + const auto lanelet_route = parse_route_file(parser_test_route); |
| 101 | + EXPECT_DOUBLE_EQ(lanelet_route.start_pose.position.x, 1.0); |
| 102 | + EXPECT_DOUBLE_EQ(lanelet_route.start_pose.position.y, 2.0); |
| 103 | + EXPECT_DOUBLE_EQ(lanelet_route.start_pose.position.z, 3.0); |
| 104 | + |
| 105 | + EXPECT_DOUBLE_EQ(lanelet_route.start_pose.orientation.x, 0.1); |
| 106 | + EXPECT_DOUBLE_EQ(lanelet_route.start_pose.orientation.y, 0.2); |
| 107 | + EXPECT_DOUBLE_EQ(lanelet_route.start_pose.orientation.z, 0.3); |
| 108 | + EXPECT_DOUBLE_EQ(lanelet_route.start_pose.orientation.w, 0.4); |
| 109 | + |
| 110 | + EXPECT_DOUBLE_EQ(lanelet_route.goal_pose.position.x, 4.0); |
| 111 | + EXPECT_DOUBLE_EQ(lanelet_route.goal_pose.position.y, 5.0); |
| 112 | + EXPECT_DOUBLE_EQ(lanelet_route.goal_pose.position.z, 6.0); |
| 113 | + EXPECT_DOUBLE_EQ(lanelet_route.goal_pose.orientation.x, 0.5); |
| 114 | + EXPECT_DOUBLE_EQ(lanelet_route.goal_pose.orientation.y, 0.6); |
| 115 | + EXPECT_DOUBLE_EQ(lanelet_route.goal_pose.orientation.z, 0.7); |
| 116 | + EXPECT_DOUBLE_EQ(lanelet_route.goal_pose.orientation.w, 0.8); |
| 117 | + |
| 118 | + ASSERT_EQ( |
| 119 | + lanelet_route.segments.size(), |
| 120 | + 2); // Assuming only one segment in the provided YAML for this test |
| 121 | + const auto & segment1 = lanelet_route.segments[1]; |
| 122 | + EXPECT_EQ(segment1.preferred_primitive.id, 44); |
| 123 | + EXPECT_EQ(segment1.primitives.size(), 4); |
| 124 | + EXPECT_EQ(segment1.primitives[0].id, 55); |
| 125 | + EXPECT_EQ(segment1.primitives[0].primitive_type, "lane"); |
| 126 | + EXPECT_EQ(segment1.primitives[1].id, 66); |
| 127 | + EXPECT_EQ(segment1.primitives[1].primitive_type, "lane"); |
| 128 | + EXPECT_EQ(segment1.primitives[2].id, 77); |
| 129 | + EXPECT_EQ(segment1.primitives[2].primitive_type, "lane"); |
| 130 | + EXPECT_EQ(segment1.primitives[3].id, 88); |
| 131 | + EXPECT_EQ(segment1.primitives[3].primitive_type, "lane"); |
130 | 132 | }
|
131 | 133 | int main(int argc, char ** argv)
|
132 | 134 | {
|
|
0 commit comments