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

update

Browse Source
This commit is contained in:
Björn Ellensohn 2023-04-18 13:51:42 +02:00
parent 192c685b29
commit ef964834fa
1 changed files with 5 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
rmp220_teleop/rmp220_teleop.py
View File

@ -14,17 +14,15 @@ class TeleopTwistJoy(Node):
self.timer = self.create_timer(0.01, self.timer_callback)
self.twist = Twist()
self.enable = False
self.limit = 0.5
def joy_callback(self, joy_msg):
if joy_msg.buttons[4]: #lb
self.twist.linear.x = 0.5 * joy_msg.axes[1]
self.twist.angular.z = 0.5 * joy_msg.axes[0]
self.limit -= 0.5
elif joy_msg.buttons[5]: #rb
self.twist.linear.x = 3 * joy_msg.axes[1]
self.twist.angular.z = 1.5 * joy_msg.axes[0]
else:
self.twist.linear.x = 1 * joy_msg.axes[1]
self.twist.angular.z = 1.0 * joy_msg.axes[0]
self.limit += 0.5
self.twist.linear.x = self.limit * joy_msg.axes[1]
self.twist.angular.z = self.limit * joy_msg.axes[0]
if joy_msg.buttons[7]: #start
self.enable = True
enable_chassis(self)