add showing of failsafe message in failsafe node

This commit is contained in:
Sem van der Hoeven
2023-06-05 16:57:13 +02:00
parent 561daf035c
commit 4916584e13

View File

@@ -18,7 +18,7 @@ class FailSafe(Node):
self.failsafe_msg = request.message
response.enabled = self.failsafe_enabled
response.message = self.failsafe_msg
self.get_logger().info("Failsafe triggered")
self.get_logger().info("Failsafe triggered! Message: " + self.failsafe_msg)
self.publish_failsafe()
return response