Sentry mode added

This commit is contained in:
Tomás L
2024-07-19 17:37:24 -04:00
parent 9b8f4d60c0
commit 133c16e474
4 changed files with 111 additions and 37 deletions

View File

@@ -61,12 +61,11 @@ camera_joystick.start()
joystick_scheduler = JoystickScheduler(joystick_queue)
joystick_scheduler.start()
ur.await_stop = True
ur.forward_position()
ur.initialize_pose()
while True:
try:
ur.move_robot_base(-current_joystick[0])
ur.control_robot(current_joystick)
#print("Setting robot base velocity to: ", current_joystick[0])
time.sleep(0.2)
except KeyboardInterrupt: