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:
@@ -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
|
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user