diff --git a/src/safe_cmd_alg_node.cpp b/src/safe_cmd_alg_node.cpp index fbf704fe97b1cbb8b4aee35d3fa5b69a53078f33..bb62b2adb35048173ca1753ff34261bedca6757e 100644 --- a/src/safe_cmd_alg_node.cpp +++ b/src/safe_cmd_alg_node.cpp @@ -48,12 +48,12 @@ void SafeCmdAlgNode::mainNodeThread(void) this->update_rear_laser_watchdog(); if(this->front_laser_watchdog_active()) { - ROS_FATAL("SafeCmdAlgNode::mainNodeThread: Front laser watchdog timeout!"); + ROS_FATAL_THROTTLE(1,"SafeCmdAlgNode::mainNodeThread: Front laser watchdog timeout!"); Twist_msg_.linear.x = 0.0; } else if(this->rear_laser_watchdog_active()) { - ROS_FATAL("SafeCmdAlgNode::mainNodeThread: Rear laser watchdog timeout!"); + ROS_FATAL_THROTTLE(1,"SafeCmdAlgNode::mainNodeThread: Rear laser watchdog timeout!"); Twist_msg_.linear.x = 0.0; } else