fix: add check for external_emergency_stop_heartbeat_received_time to…

… isDataReady
autowarefoundation · Oct 24, 2022 · e4bea47 · e4bea47
1 parent cf91d1a
commit e4bea47
Showing 1 changed file with 7 additions and 0 deletions.
diff --git a/control/vehicle_cmd_gate/src/vehicle_cmd_gate.cpp b/control/vehicle_cmd_gate/src/vehicle_cmd_gate.cpp
@@ -223,6 +223,13 @@ bool VehicleCmdGate::isDataReady()
     }
   }
 
+  if (use_external_emergency_stop_) {
+    if (!external_emergency_stop_heartbeat_received_time_) {
+      RCLCPP_WARN(get_logger(), "external_emergency_stop_heartbeat_received_time_ is false");
+      return false;
+    }
+  }
+
   return true;
 }