1
0
mirror of https://gitlab.com/obbart/universal_robots_ros_driver.git synced 2026-04-10 10:00:48 +02:00

edited script for use in URCaps

This commit is contained in:
Tristan Schnell
2019-05-23 11:13:02 +02:00
parent a0ea50a031
commit 876d4a06f5

View File

@@ -1,14 +1,13 @@
def myProg():
global steptime = get_steptime() global steptime = get_steptime()
textmsg("steptime=", steptime) textmsg("steptime=", steptime)
MULT_jointstate = {{JOINT_STATE_REPLACE}} global MULT_jointstate = {{JOINT_STATE_REPLACE}}
SERVO_UNINITIALIZED = -1 global SERVO_UNINITIALIZED = -1
SERVO_IDLE = 0 global SERVO_IDLE = 0
SERVO_RUNNING = 1 global SERVO_RUNNING = 1
cmd_servo_state = SERVO_UNINITIALIZED global cmd_servo_state = SERVO_UNINITIALIZED
cmd_servo_q = get_actual_joint_positions() global cmd_servo_q = get_actual_joint_positions()
cmd_servo_q_last = get_actual_joint_positions() global cmd_servo_q_last = get_actual_joint_positions()
def set_servo_setpoint(q): def set_servo_setpoint(q):
enter_critical enter_critical
cmd_servo_state = SERVO_RUNNING cmd_servo_state = SERVO_RUNNING
@@ -72,5 +71,3 @@ def myProg():
sleep(.1) sleep(.1)
socket_close() socket_close()
kill thread_servo kill thread_servo
end