set timestamp to max_velocity topic

Signed-off-by: Autumn60 <[email protected]>
tier4 · Aug 21, 2024 · 59170e3 · 59170e3
1 parent d409b66
commit 59170e3
Show file tree

Hide file tree

Showing 2 changed files with 4 additions and 1 deletion.
diff --git a/awapi_awiv_adapter/include/awapi_awiv_adapter/awapi_max_velocity_publisher.hpp b/awapi_awiv_adapter/include/awapi_awiv_adapter/awapi_max_velocity_publisher.hpp
@@ -30,6 +30,8 @@ class AutowareIvMaxVelocityPublisher
   void statePublisher(const AutowareInfo & aw_info);
 
 private:
+  rclcpp::Clock::SharedPtr clock_;
+
   // publisher
   rclcpp::Publisher<tier4_planning_msgs::msg::VelocityLimit>::SharedPtr pub_state_;
 

diff --git a/awapi_awiv_adapter/src/awapi_max_velocity_publisher.cpp b/awapi_awiv_adapter/src/awapi_max_velocity_publisher.cpp
@@ -18,7 +18,7 @@ namespace autoware_api
 {
 AutowareIvMaxVelocityPublisher::AutowareIvMaxVelocityPublisher(
   rclcpp::Node & node, const double default_max_velocity)
-: default_max_velocity_(default_max_velocity)
+: default_max_velocity_(default_max_velocity), clock_(node.get_clock())
 {
   // publisher
   pub_state_ = node.create_publisher<tier4_planning_msgs::msg::VelocityLimit>(
@@ -32,6 +32,7 @@ void AutowareIvMaxVelocityPublisher::statePublisher(const AutowareInfo & aw_info
         aw_info.max_velocity_ptr, aw_info.temporary_stop_ptr,
         &max_velocity.max_velocity))  // publish info
   {
+    max_velocity.stamp = clock_->now();
     pub_state_->publish(max_velocity);
   }
 }