浏览代码

[fix] 添加导航停障log显示

wangjh57 6 月之前
父节点
当前提交
321edc5a63
共有 1 个文件被更改,包括 3 次插入0 次删除
  1. 3 0
      saturn_controller/src/saturn_controller.cpp

+ 3 - 0
saturn_controller/src/saturn_controller.cpp

@@ -109,6 +109,9 @@ namespace saturn_ros2
         rc_direct.angular.x = vel_msg->angular.x;
         rc_direct.angular.y = vel_msg->angular.y;
         rc_direct.angular.z = vel_msg->angular.z;
+        if (std::fabs(guardian_velocity_decay_ratio_) < 1e-4) {
+            SPDLOG_INFO("Guardian triggered, ignoring cmd_vel.x... ");
+        }
         rcClientInterfaceDirectionMovement(robot_control::common::NAV_OR_JOY_MODE::nav_control,
                                            rc_direct, robot_heartbeat_);
     }