Skip to content

Commit b764c57

Browse files
authored
feat(behavior_path_planner): use autoware internal stamped messages (#9750)
* feat(behavior_path_planner): use autoware internal stamped messages Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix universe_utils Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> --------- Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
1 parent 3d53032 commit b764c57

File tree

4 files changed

+68
-2
lines changed

4 files changed

+68
-2
lines changed

common/autoware_universe_utils/include/autoware/universe_utils/ros/debug_traits.hpp

+62
Original file line numberDiff line numberDiff line change
@@ -15,6 +15,16 @@
1515
#ifndef AUTOWARE__UNIVERSE_UTILS__ROS__DEBUG_TRAITS_HPP_
1616
#define AUTOWARE__UNIVERSE_UTILS__ROS__DEBUG_TRAITS_HPP_
1717

18+
#include <autoware_internal_debug_msgs/msg/bool_stamped.hpp>
19+
#include <autoware_internal_debug_msgs/msg/float32_multi_array_stamped.hpp>
20+
#include <autoware_internal_debug_msgs/msg/float32_stamped.hpp>
21+
#include <autoware_internal_debug_msgs/msg/float64_multi_array_stamped.hpp>
22+
#include <autoware_internal_debug_msgs/msg/float64_stamped.hpp>
23+
#include <autoware_internal_debug_msgs/msg/int32_multi_array_stamped.hpp>
24+
#include <autoware_internal_debug_msgs/msg/int32_stamped.hpp>
25+
#include <autoware_internal_debug_msgs/msg/int64_multi_array_stamped.hpp>
26+
#include <autoware_internal_debug_msgs/msg/int64_stamped.hpp>
27+
#include <autoware_internal_debug_msgs/msg/string_stamped.hpp>
1828
#include <tier4_debug_msgs/msg/bool_stamped.hpp>
1929
#include <tier4_debug_msgs/msg/float32_multi_array_stamped.hpp>
2030
#include <tier4_debug_msgs/msg/float32_stamped.hpp>
@@ -84,6 +94,58 @@ template <>
8494
struct is_debug_message<tier4_debug_msgs::msg::StringStamped> : std::true_type
8595
{
8696
};
97+
98+
template <>
99+
struct is_debug_message<autoware_internal_debug_msgs::msg::BoolStamped> : std::true_type
100+
{
101+
};
102+
103+
template <>
104+
struct is_debug_message<autoware_internal_debug_msgs::msg::Float32MultiArrayStamped>
105+
: std::true_type
106+
{
107+
};
108+
109+
template <>
110+
struct is_debug_message<autoware_internal_debug_msgs::msg::Float32Stamped> : std::true_type
111+
{
112+
};
113+
114+
template <>
115+
struct is_debug_message<autoware_internal_debug_msgs::msg::Float64MultiArrayStamped>
116+
: std::true_type
117+
{
118+
};
119+
120+
template <>
121+
struct is_debug_message<autoware_internal_debug_msgs::msg::Float64Stamped> : std::true_type
122+
{
123+
};
124+
125+
template <>
126+
struct is_debug_message<autoware_internal_debug_msgs::msg::Int32MultiArrayStamped> : std::true_type
127+
{
128+
};
129+
130+
template <>
131+
struct is_debug_message<autoware_internal_debug_msgs::msg::Int32Stamped> : std::true_type
132+
{
133+
};
134+
135+
template <>
136+
struct is_debug_message<autoware_internal_debug_msgs::msg::Int64MultiArrayStamped> : std::true_type
137+
{
138+
};
139+
140+
template <>
141+
struct is_debug_message<autoware_internal_debug_msgs::msg::Int64Stamped> : std::true_type
142+
{
143+
};
144+
145+
template <>
146+
struct is_debug_message<autoware_internal_debug_msgs::msg::StringStamped> : std::true_type
147+
{
148+
};
87149
} // namespace autoware::universe_utils::debug_traits
88150

89151
#endif // AUTOWARE__UNIVERSE_UTILS__ROS__DEBUG_TRAITS_HPP_

common/autoware_universe_utils/package.xml

+1
Original file line numberDiff line numberDiff line change
@@ -12,6 +12,7 @@
1212
<buildtool_depend>ament_cmake_auto</buildtool_depend>
1313
<buildtool_depend>autoware_cmake</buildtool_depend>
1414

15+
<depend>autoware_internal_debug_msgs</depend>
1516
<depend>autoware_internal_msgs</depend>
1617
<depend>autoware_perception_msgs</depend>
1718
<depend>autoware_planning_msgs</depend>

planning/behavior_path_planner/autoware_behavior_path_planner/include/autoware/behavior_path_planner/planner_manager.hpp

+4-2
Original file line numberDiff line numberDiff line change
@@ -25,6 +25,8 @@
2525
#include <pluginlib/class_loader.hpp>
2626
#include <rclcpp/rclcpp.hpp>
2727

28+
#include <autoware_internal_debug_msgs/msg/float64_stamped.hpp>
29+
#include <autoware_internal_debug_msgs/msg/string_stamped.hpp>
2830
#include <tier4_planning_msgs/msg/path_with_lane_id.hpp>
2931

3032
#include <lanelet2_core/primitives/Lanelet.h>
@@ -44,8 +46,8 @@ using tier4_planning_msgs::msg::PathWithLaneId;
4446
using SceneModulePtr = std::shared_ptr<SceneModuleInterface>;
4547
using SceneModuleManagerPtr = std::shared_ptr<SceneModuleManagerInterface>;
4648
using DebugPublisher = autoware::universe_utils::DebugPublisher;
47-
using DebugDoubleMsg = tier4_debug_msgs::msg::Float64Stamped;
48-
using DebugStringMsg = tier4_debug_msgs::msg::StringStamped;
49+
using DebugDoubleMsg = autoware_internal_debug_msgs::msg::Float64Stamped;
50+
using DebugStringMsg = autoware_internal_debug_msgs::msg::StringStamped;
4951

5052
struct SceneModuleUpdateInfo
5153
{

planning/behavior_path_planner/autoware_behavior_path_planner/package.xml

+1
Original file line numberDiff line numberDiff line change
@@ -40,6 +40,7 @@
4040
<depend>autoware_behavior_path_planner_common</depend>
4141
<depend>autoware_freespace_planning_algorithms</depend>
4242
<depend>autoware_frenet_planner</depend>
43+
<depend>autoware_internal_debug_msgs</depend>
4344
<depend>autoware_interpolation</depend>
4445
<depend>autoware_lane_departure_checker</depend>
4546
<depend>autoware_lanelet2_extension</depend>

0 commit comments

Comments
 (0)