changes in operation: testing

This commit is contained in:
Björn Ellensohn 2023-08-22 10:25:57 +02:00
parent f588a72960
commit 1104c8024c

View File

@ -65,6 +65,9 @@ class StateMachineNode(Node):
self.get_logger().info('Got chassis_mode from chassis_mode_fb topic')
self.get_logger().info(str(msg.chassis_mode))
if self.state == State.PAUSED:
return
else:
if msg.chassis_mode == 0:
self.chassis_mode = State.DISABLED
self.state = State.DISABLED