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

works but needs improvement

Browse Source
This commit is contained in:
Björn Ellensohn 2023-08-14 12:54:38 +02:00
parent b5840c52e5
commit 6c5ca6144c
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
rmp220_middleware/rmp220_middleware.py
View File

@ -76,7 +76,7 @@ class StateMachineNode(Node):
self.disable_chassis() self.disable_chassis()
def cmd_vel_callback(self, msg): def cmd_vel_callback(self, msg):
if self.state == State.ENABLED and (msg.linear.x <= 0.03 or msg.angular.z <= 0.03): if self.state == State.ENABLED and (msg.linear.x >= 0.03 or msg.angular.z >= 0.03):
self.cmd_vel_pub.publish(msg) self.cmd_vel_pub.publish(msg)
self.timeout = 20.0 # Reset timeout when receiving commands self.timeout = 20.0 # Reset timeout when receiving commands
if msg.linear.x == 0.0 and msg.angular.z == 0.0: if msg.linear.x == 0.0 and msg.angular.z == 0.0:
@ -92,7 +92,7 @@ class StateMachineNode(Node):
self.cmd_vel_pub.publish(msg) self.cmd_vel_pub.publish(msg)
self.timeout = 10.0 # Reset timeout when receiving commands self.timeout = 10.0 # Reset timeout when receiving commands
if msg.linear.x < 0.03 or msg.angular.z < 0.03: if msg.linear.x > 0.03 or msg.angular.z > 0.03:
self.latest_cmd_vel = msg self.latest_cmd_vel = msg
else: else:
self.latest_cmd_vel = Twist() self.latest_cmd_vel = Twist()