diff --git a/planning/autoware_path_generator/src/node.cpp b/planning/autoware_path_generator/src/node.cpp index 8712e0f0f..4527c3a23 100644 --- a/planning/autoware_path_generator/src/node.cpp +++ b/planning/autoware_path_generator/src/node.cpp @@ -54,6 +54,8 @@ PathGenerator::PathGenerator(const rclcpp::NodeOptions & node_options) turn_signal_publisher_ = create_publisher("~/output/turn_indicators_cmd", 1); + hazard_signal_publisher_ = create_publisher("~/output/hazard_lights_cmd", 1); + vehicle_info_ = autoware::vehicle_info_utils::VehicleInfoUtils(*this).getVehicleInfo(); const auto params = param_listener_->get_params(); @@ -85,6 +87,11 @@ void PathGenerator::run() turn_signal.stamp = now(); turn_signal_publisher_->publish(turn_signal); + HazardLightsCommand hazard_signal; + hazard_signal.command = HazardLightsCommand::NO_COMMAND; + hazard_signal.stamp = now(); + hazard_signal_publisher_->publish(hazard_signal); + path_publisher_->publish(*path); } diff --git a/planning/autoware_path_generator/src/node.hpp b/planning/autoware_path_generator/src/node.hpp index 7f7fc4050..12a46844f 100644 --- a/planning/autoware_path_generator/src/node.hpp +++ b/planning/autoware_path_generator/src/node.hpp @@ -25,6 +25,7 @@ #include #include #include +#include #include #include @@ -36,6 +37,7 @@ using autoware_internal_planning_msgs::msg::PathPointWithLaneId; using autoware_internal_planning_msgs::msg::PathWithLaneId; using autoware_map_msgs::msg::LaneletMapBin; using autoware_planning_msgs::msg::LaneletRoute; +using autoware_vehicle_msgs::msg::HazardLightsCommand; using autoware_vehicle_msgs::msg::TurnIndicatorsCommand; using nav_msgs::msg::Odometry; using ::path_generator::Params; @@ -67,6 +69,7 @@ class PathGenerator : public rclcpp::Node // publisher rclcpp::Publisher::SharedPtr path_publisher_; rclcpp::Publisher::SharedPtr turn_signal_publisher_; + rclcpp::Publisher::SharedPtr hazard_signal_publisher_; rclcpp::TimerBase::SharedPtr timer_;