diabled auto-enable

This commit is contained in:
Björn Ellensohn 2023-08-16 09:22:54 +02:00
parent b0c31017a6
commit e74409a6f7

View File

@ -62,10 +62,10 @@ class StateMachineNode(Node):
self.get_logger().info('Disabling chassis...') self.get_logger().info('Disabling chassis...')
def joy_callback(self, msg): def joy_callback(self, msg):
if self.state == State.DISABLED and self.cmd_vel_sub is not None: # if self.state == State.DISABLED and self.cmd_vel_sub is not None:
self.state = State.ENABLED # self.state = State.ENABLED
self.get_logger().info("State: ENABLED (Joystick)") # self.get_logger().info("State: ENABLED (Joystick)")
self.enable_chassis() # self.enable_chassis()
if self.state == State.DISABLED and msg.buttons[7] == 1: # Joystick button 'start' if self.state == State.DISABLED and msg.buttons[7] == 1: # Joystick button 'start'
self.state = State.ENABLED self.state = State.ENABLED
self.get_logger().info("State: ENABLED (Button 'start')") self.get_logger().info("State: ENABLED (Button 'start')")