|
14 | 14 |
|
15 | 15 | #ifndef AUTOWARE_PLANNING_TEST_MANAGER__AUTOWARE_PLANNING_TEST_MANAGER_UTILS_HPP_
|
16 | 16 | #define AUTOWARE_PLANNING_TEST_MANAGER__AUTOWARE_PLANNING_TEST_MANAGER_UTILS_HPP_
|
| 17 | +#include <planning_test_utils/planning_test_utils.hpp> |
17 | 18 | #include <route_handler/route_handler.hpp>
|
18 |
| -#include <nav_msgs/msg/odometry.hpp> |
19 |
| -#include <geometry_msgs/msg/pose.hpp> |
| 19 | + |
20 | 20 | #include <autoware_planning_msgs/msg/lanelet_route.hpp>
|
21 |
| -#include <planning_test_utils/planning_test_utils.hpp> |
| 21 | +#include <geometry_msgs/msg/pose.hpp> |
| 22 | +#include <nav_msgs/msg/odometry.hpp> |
22 | 23 |
|
23 | 24 | namespace autoware_planning_test_manager::utils
|
24 | 25 | {
|
25 |
| -using route_handler::RouteHandler; |
26 |
| -using nav_msgs::msg::Odometry; |
27 |
| -using geometry_msgs::msg::Pose; |
28 | 26 | using autoware_planning_msgs::msg::LaneletRoute;
|
| 27 | +using geometry_msgs::msg::Pose; |
| 28 | +using nav_msgs::msg::Odometry; |
| 29 | +using route_handler::RouteHandler; |
29 | 30 | using RouteSections = std::vector<autoware_planning_msgs::msg::LaneletSegment>;
|
30 | 31 |
|
31 | 32 | Pose createPoseFromLaneID(const lanelet::Id & lane_id)
|
@@ -92,7 +93,8 @@ LaneletRoute makeBehaviorRouteFromLaneId(const int & start_lane_id, const int &
|
92 | 93 | // create local route sections
|
93 | 94 | route_handler->setRouteLanelets(path_lanelets);
|
94 | 95 | const auto local_route_sections = route_handler->createMapSegments(path_lanelets);
|
95 |
| - route_sections = test_utils::combineConsecutiveRouteSections(route_sections, local_route_sections); |
| 96 | + route_sections = |
| 97 | + test_utils::combineConsecutiveRouteSections(route_sections, local_route_sections); |
96 | 98 | for (const auto & route_section : route_sections) {
|
97 | 99 | for (const auto & primitive : route_section.primitives) {
|
98 | 100 | std::cerr << "primitive: " << primitive.id << std::endl;
|
|
0 commit comments