ellensohn/rmp220_middleware
1
0
Fork 0
mirror of https://github.com/bjoernellens1/rmp220_middleware.git synced 2024-11-21 15:33:47 +00:00
Code Issues Packages Projects Releases Wiki Activity

changes in operation: testing

Browse Source
This commit is contained in:
Björn Ellensohn 2023-08-22 10:23:48 +02:00
parent 1f2f0d7bf9
commit f588a72960
1 changed files with 5 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
rmp220_middleware/rmp220_middleware.py
View File

@ -115,7 +115,7 @@ class StateMachineNode(Node):
self.get_logger().info("State: ENABLED (Button 'start')")
self.enable_chassis()
if select_button == 1:
self.state = State.DISABLED
self.state = State.PAUSED
self.get_logger().info("State: DISABLED (Button 'select')")
self.disable_chassis()
@ -133,10 +133,12 @@ class StateMachineNode(Node):
def timer_callback(self):
# if self.chassis_mode == State.DISABLED or self.chassis_mode == State.STOPPED or self.chassis_mode == State.PASSIVE:
# return # Do nothing if chassis is disabled, stopped or passive --> should save processing power
if self.state == State.PAUSED:
return # Do nothing if state is paused --> should save processing power
if self.state == State.ENABLED:
if self.timeout <= 0:
self.state = State.PAUSED
self.get_logger().info("State: PAUSED (Timeout)")
self.state = State.DISABLED
self.get_logger().info("State: DISABLED (Timeout)")
self.disable_chassis()
else:
self.timeout -= 0.01