15 #ifndef BEHAVIOR_TREE_PLUGIN__ROUTE_PLANNER_HPP_
16 #define BEHAVIOR_TREE_PLUGIN__ROUTE_PLANNER_HPP_
36 auto setWaypoints(
const std::vector<CanonicalizedLaneletPose> & waypoints) -> void;
47 std::optional<lanelet::Ids> route_;
57 lanelet::Ids whole_lanelet_ids_;
Definition: route_planner.hpp:27
auto getGoalPoses() const -> std::vector< CanonicalizedLaneletPose >
Definition: route_planner.cpp:96
auto getGoalPosesInWorldFrame() const -> std::vector< geometry_msgs::msg::Pose >
Definition: route_planner.cpp:87
auto getRouteLanelets(const CanonicalizedLaneletPose &entity_lanelet_pose, double horizon=100) -> lanelet::Ids
Definition: route_planner.cpp:41
auto cancelRoute() -> void
Definition: route_planner.cpp:65
auto setWaypoints(const std::vector< CanonicalizedLaneletPose > &waypoints) -> void
Definition: route_planner.cpp:26
auto getWholeRouteLanelets() const -> lanelet::Ids
Definition: route_planner.hpp:32
RoutePlanner(const traffic_simulator::RoutingGraphType &, const std::shared_ptr< hdmap_utils::HdMapUtils > &)
Definition: route_planner.cpp:19
Definition: lanelet_pose.hpp:28
Definition: lanelet_wrapper.hpp:40
geometry_msgs::msg::Pose Pose
Definition: lanelet_map.hpp:30
RoutingGraphType
Definition: routing_graph_type.hpp:24