ellensohn/rmp220_teleop_backup
Archived
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

retry with self.limit

Browse Source
This commit is contained in:
Björn Ellensohn 2023-04-18 14:19:21 +02:00
parent d149aedf4f
commit 6a6ba2953a
1 changed files with 11 additions and 10 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

21
rmp220_teleop/rmp220_teleop.py
View File

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