|
@@ -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_);
|
|
|
}
|