diff --git a/src/autonomy/fu/src/fu_node.cpp b/src/autonomy/fu/src/fu_node.cpp index 8ecfb2c..e223260 100644 --- a/src/autonomy/fu/src/fu_node.cpp +++ b/src/autonomy/fu/src/fu_node.cpp @@ -289,6 +289,12 @@ class fu_node : public rclcpp::Node vehicle_max_y_ = -1; node_clock_ = this->get_clock(); + // 初始化栅格时间戳(使用 node_clock_ 确保时钟源一致) + { + std::lock_guard lock(grid_mutex_); + last_grid_time_ = node_clock_->now(); + } + front_stop_zone_ = {0, 0, 0, 0}; rear_stop_zone_ = {0, 0, 0, 0}; left_stop_zone_ = {0, 0, 0, 0};