Skip to content

Commit

Permalink
feat: tier4_debug-msgs changed to autoware_internal_debug_msgs in fil…
Browse files Browse the repository at this point in the history
…es perception/autoware_image_projection_based_fusion

Signed-off-by: vish0012 <[email protected]>
  • Loading branch information
vish0012 authored and mitsudome-r committed Jan 21, 2025
1 parent 96708f9 commit 2383abd
Show file tree
Hide file tree
Showing 2 changed files with 9 additions and 7 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -17,6 +17,7 @@
<buildtool_depend>autoware_cmake</buildtool_depend>

<depend>autoware_euclidean_cluster</depend>
<depend>autoware_internal_debug_msgs</depend>
<depend>autoware_lidar_centerpoint</depend>
<depend>autoware_object_recognition_utils</depend>
<depend>autoware_perception_msgs</depend>
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -19,6 +19,7 @@
#include <Eigen/Core>
#include <Eigen/Geometry>
#include <autoware/image_projection_based_fusion/utils/utils.hpp>
#include <autoware_internal_debug_msgs/msg/float64_stamped.hpp>

#include <tier4_perception_msgs/msg/detected_object_with_feature.hpp>

Expand Down Expand Up @@ -253,12 +254,12 @@ void FusionNode<Msg3D, Msg2D, ExportObj>::exportProcess()
std::chrono::nanoseconds(
(this->get_clock()->now() - cached_det3d_msg_ptr_->header.stamp).nanoseconds()))
.count();
debug_publisher_->publish<tier4_debug_msgs::msg::Float64Stamped>(
debug_publisher_->publish<autoware_internal_debug_msgs::msg::Float64Stamped>(
"debug/cyclic_time_ms", cyclic_time_ms);
debug_publisher_->publish<tier4_debug_msgs::msg::Float64Stamped>(
debug_publisher_->publish<autoware_internal_debug_msgs::msg::Float64Stamped>(
"debug/processing_time_ms",
processing_time_ms + stop_watch_ptr_->toc("processing_time", true));
debug_publisher_->publish<tier4_debug_msgs::msg::Float64Stamped>(
debug_publisher_->publish<autoware_internal_debug_msgs::msg::Float64Stamped>(
"debug/pipeline_latency_ms", pipeline_latency_ms);
processing_time_ms = 0;
}
Expand Down Expand Up @@ -353,9 +354,9 @@ void FusionNode<Msg3D, Msg2D, ExportObj>::subCallback(
// add timestamp interval for debug
if (debug_internal_pub_) {
double timestamp_interval_ms = (matched_stamp - timestamp_nsec) / 1e6;
debug_internal_pub_->publish<tier4_debug_msgs::msg::Float64Stamped>(
debug_internal_pub_->publish<autoware_internal_debug_msgs::msg::Float64Stamped>(
"debug/roi" + std::to_string(roi_i) + "/timestamp_interval_ms", timestamp_interval_ms);
debug_internal_pub_->publish<tier4_debug_msgs::msg::Float64Stamped>(
debug_internal_pub_->publish<autoware_internal_debug_msgs::msg::Float64Stamped>(
"debug/roi" + std::to_string(roi_i) + "/timestamp_interval_offset_ms",
timestamp_interval_ms - det2d.input_offset_ms);
}
Expand Down Expand Up @@ -418,9 +419,9 @@ void FusionNode<Msg3D, Msg2D, ExportObj>::roiCallback(

if (debug_internal_pub_) {
double timestamp_interval_ms = (timestamp_nsec - cached_det3d_msg_timestamp_) / 1e6;
debug_internal_pub_->publish<tier4_debug_msgs::msg::Float64Stamped>(
debug_internal_pub_->publish<autoware_internal_debug_msgs::msg::Float64Stamped>(
"debug/roi" + std::to_string(roi_i) + "/timestamp_interval_ms", timestamp_interval_ms);
debug_internal_pub_->publish<tier4_debug_msgs::msg::Float64Stamped>(
debug_internal_pub_->publish<autoware_internal_debug_msgs::msg::Float64Stamped>(
"debug/roi" + std::to_string(roi_i) + "/timestamp_interval_offset_ms",
timestamp_interval_ms - det2d.input_offset_ms);
}
Expand Down

0 comments on commit 2383abd

Please sign in to comment.